added projection into feature observations camera states

This commit is contained in:
2019-04-16 17:40:33 +02:00
parent abd343f576
commit 010d36d216
5 changed files with 277 additions and 10 deletions

View File

@ -622,6 +622,7 @@ void ImageProcessor::stereoMatch(
image_handler::undistortPoints(cam0_points, cam0_intrinsics, cam0_distortion_model,
cam0_distortion_coeffs, cam0_points_undistorted,
R_cam0_cam1);
cam1_points = image_handler::distortPoints(cam0_points_undistorted, cam1_intrinsics,
cam1_distortion_model, cam1_distortion_coeffs);
}