i/OrbbecSDK_ROS2
1
0
Fork 0
mirror of https://github.com/orbbec/OrbbecSDK_ROS2.git synced 2026-10-04 12:07:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

Merge commit 'bc7b958218829b7d2c544a08bf3307a5d81f6fe7' into merge/sdk_2.8.2

Browse Source
This commit is contained in:
ob-yalian
2026-04-15 09:20:45 +08:00
parent 1b4658e3a6 bc7b958218
commit 6894dbeffa
1 changed files with 8 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
orbbec_camera/src/utils.cpp
+8 -7
View File
@@ -941,16 +941,17 @@ UndistortedImageResult undistortImage(const cv::Mat &image, const OBCameraIntrin
cv::Mat dist_coeffs = (cv::Mat_<float>(8, 1) << distortion.k1, distortion.k2, distortion.p1, cv::Mat dist_coeffs = (cv::Mat_<float>(8, 1) << distortion.k1, distortion.k2, distortion.p1,
distortion.p2, distortion.k3, distortion.k4, distortion.k5, distortion.k6); distortion.p2, distortion.k3, distortion.k4, distortion.k5, distortion.k6);
cv::Size image_size(image.cols, image.rows); cv::Size image_size(image.cols, image.rows);
cv::Mat new_camera_matrix = // cv::Mat new_camera_matrix =
cv::getOptimalNewCameraMatrix(camera_matrix, dist_coeffs, image_size, 0.0, image_size); // cv::getOptimalNewCameraMatrix(camera_matrix, dist_coeffs, image_size, 0.0, image_size);
// Undistort the image using the new camera matrix // Undistort the image using the new camera matrix
cv::undistort(image, result.image, camera_matrix, dist_coeffs, new_camera_matrix); // cv::undistort(image, result.image, camera_matrix, dist_coeffs, new_camera_matrix);
cv::undistort(image, result.image, camera_matrix, dist_coeffs);
// Update the intrinsic parameters with the new camera matrix // Update the intrinsic parameters with the new camera matrix
result.new_intrinsic = intrinsic; // Copy original values first result.new_intrinsic = intrinsic; // Copy original values first
result.new_intrinsic.fx = new_camera_matrix.at<double>(0, 0); // result.new_intrinsic.fx = new_camera_matrix.at<double>(0, 0);
result.new_intrinsic.fy = new_camera_matrix.at<double>(1, 1); // result.new_intrinsic.fy = new_camera_matrix.at<double>(1, 1);
result.new_intrinsic.cx = new_camera_matrix.at<double>(0, 2); // result.new_intrinsic.cx = new_camera_matrix.at<double>(0, 2);
result.new_intrinsic.cy = new_camera_matrix.at<double>(1, 2); // result.new_intrinsic.cy = new_camera_matrix.at<double>(1, 2);
result.new_intrinsic.width = image.cols; result.new_intrinsic.width = image.cols;
result.new_intrinsic.height = image.rows; result.new_intrinsic.height = image.rows;
return result; return result;