From c79808e7d8b4e2c593df3de347de30e7fccfedfd Mon Sep 17 00:00:00 2001 From: TinyO Date: Fri, 25 Oct 2019 15:37:10 +0800 Subject: [PATCH] fix(ros): camera info D display. --- wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc b/wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc index 5b66537..d6a5714 100644 --- a/wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc +++ b/wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc @@ -1423,7 +1423,7 @@ class ROSWrapperNodelet : public nodelet::Nodelet { stream == Stream::RIGHT_RECTIFIED) { if (info_pair->right.distortion_model == "KANNALA_BRANDT") { camera_info->distortion_model = "KANNALA_BRANDT"; - for (size_t i = 0; i < 4; i++) { + for (size_t i = 0; i < 5; i++) { camera_info->D.push_back(info_pair->right.D[i]); } } else if (info_pair->right.distortion_model == "PINHOLE") { @@ -1448,7 +1448,7 @@ class ROSWrapperNodelet : public nodelet::Nodelet { private_nh_.getParamCached("is_laserscan", is_laserscan); if (!is_laserscan) { camera_info->distortion_model = "KANNALA_BRANDT"; - for (size_t i = 0; i < 4; i++) { + for (size_t i = 0; i < 5; i++) { camera_info->D.push_back(info_pair->left.D[i]); } } else {