tami/MYNT-EYE-S-SDK
6
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fix(*): rviz imu location.

Browse Source
This commit is contained in:
TinyO 2019-08-09 15:07:46 +08:00
parent d041f22d7e
commit 4a250f5ab5
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc
View File

@ -1491,9 +1491,9 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
l2i_msg.header.stamp = tf_stamp; l2i_msg.header.stamp = tf_stamp;
l2i_msg.header.frame_id = frame_ids_[Stream::LEFT]; l2i_msg.header.frame_id = frame_ids_[Stream::LEFT];
l2i_msg.child_frame_id = imu_frame_id_; l2i_msg.child_frame_id = imu_frame_id_;
l2i_msg.transform.translation.x = l2i_ex.translation[0]; l2i_msg.transform.translation.x = 0;
l2i_msg.transform.translation.y = l2i_ex.translation[1]; l2i_msg.transform.translation.y = 0;
l2i_msg.transform.translation.z = l2i_ex.translation[2]; l2i_msg.transform.translation.z = 0;
if (l2i_ex.rotation[0][0] == 0 && l2i_ex.rotation[2][2] == 0) { if (l2i_ex.rotation[0][0] == 0 && l2i_ex.rotation[2][2] == 0) {
l2i_msg.transform.rotation.x = 0; l2i_msg.transform.rotation.x = 0;
l2i_msg.transform.rotation.y = 0; l2i_msg.transform.rotation.y = 0;