Revert "[aerial_robot_estimation] normalize quaternions before conver…

…ting to message to suppress warning message" This reverts commit 47e6c27.
sugikazu75 · Nov 4, 2024 · 7f1c4b9 · 7f1c4b9
1 parent 32db881
commit 7f1c4b9
Show file tree

Hide file tree

Showing 2 changed files with 0 additions and 3 deletions.
diff --git a/aerial_robot_estimation/src/sensor/imu.cpp b/aerial_robot_estimation/src/sensor/imu.cpp
@@ -441,7 +441,6 @@ namespace sensor_plugin
     imu_data.header.stamp = imu_stamp_;
     tf::Quaternion q;
     base_rot_.at(0).getRotation(q);
-    q.normalize();
     tf::quaternionTFToMsg(q, imu_data.orientation);
     tf::vector3TFToMsg(omega_, imu_data.angular_velocity);
     tf::vector3TFToMsg(acc_b_, imu_data.linear_acceleration);

diff --git a/aerial_robot_estimation/src/state_estimation.cpp b/aerial_robot_estimation/src/state_estimation.cpp
@@ -142,7 +142,6 @@ void StateEstimator::statePublish(const ros::TimerEvent & e)
   /* Baselink */
   /* Rotation */
   tf::Quaternion q; getOrientation(Frame::BASELINK, estimate_mode_).getRotation(q);
-  q.normalize();
   tf::quaternionTFToMsg(q, odom_state.pose.pose.orientation);
   tf::vector3TFToMsg(getAngularVel(Frame::BASELINK, estimate_mode_), odom_state.twist.twist.angular);
 
@@ -172,7 +171,6 @@ void StateEstimator::statePublish(const ros::TimerEvent & e)
   /* COG */
   /* Rotation */
   getOrientation(Frame::COG, estimate_mode_).getRotation(q);
-  q.normalize();
   tf::quaternionTFToMsg(q, odom_state.pose.pose.orientation);
   tf::vector3TFToMsg(getAngularVel(Frame::COG, estimate_mode_), odom_state.twist.twist.angular);
   /* Translation */