diff --git a/modules/3d/src/rgbd/odometry.cpp b/modules/3d/src/rgbd/odometry.cpp index ba9fcd57c5..4cba5debc3 100644 --- a/modules/3d/src/rgbd/odometry.cpp +++ b/modules/3d/src/rgbd/odometry.cpp @@ -477,7 +477,7 @@ void warpFrame(InputArray depth, InputArray image, InputArray mask, const double infinity = std::numeric_limits::max(); Mat zBuffer(sz, CV_32FC1, infinity); - + const Rect rect = Rect(Point(), sz); for (int y = 0; y < sz.height; y++) diff --git a/modules/3d/src/rgbd/odometry_functions.cpp b/modules/3d/src/rgbd/odometry_functions.cpp index f6d9649c78..6baea1b2bd 100644 --- a/modules/3d/src/rgbd/odometry_functions.cpp +++ b/modules/3d/src/rgbd/odometry_functions.cpp @@ -778,7 +778,7 @@ bool RGBDICPOdometryImpl(OutputArray _Rt, const Mat& initRt, Mat tmp61(6, 1, CV_64FC1, Scalar(0)); if(transformType == OdometryTransformType::ROTATION) - { + { ksi.copyTo(tmp61.rowRange(0,3)); ksi = tmp61; } @@ -834,7 +834,7 @@ void computeCorresps(const Matx33f& _K, const Mat& rt, diffs = Mat(depthDst.size(), CV_32F, Scalar::all(-1)); // src_2d = K * src_3d, src_3d = K_inv * [src_2d | z] - // + // Matx33d K(_K); Matx33d K_inv = K.inv(DECOMP_SVD);