revert #50 in upstream

Signed-off-by: Autumn60 <[email protected]>
booars · Sep 18, 2024 · c68e7f6 · c68e7f6
1 parent 57951e7
commit c68e7f6
Showing 1 changed file with 4 additions and 4 deletions.
diff --git a/aichallenge/workspace/src/aichallenge_submit/imu_gnss_poser/src/imu_gnss_poser_node.cpp b/aichallenge/workspace/src/aichallenge_submit/imu_gnss_poser/src/imu_gnss_poser_node.cpp
@@ -26,10 +26,10 @@ class ImuGnssPoser : public rclcpp::Node
 private:
 
     void gnss_callback(const geometry_msgs::msg::PoseWithCovarianceStamped::SharedPtr msg) {
-        //msg->pose.pose.orientation.x = imu_msg_.orientation.x;
-        //msg->pose.pose.orientation.y = imu_msg_.orientation.y;
-        //msg->pose.pose.orientation.z = imu_msg_.orientation.z;
-        //msg->pose.pose.orientation.w = imu_msg_.orientation.w;
+        msg->pose.pose.orientation.x = imu_msg_.orientation.x;
+        msg->pose.pose.orientation.y = imu_msg_.orientation.y;
+        msg->pose.pose.orientation.z = imu_msg_.orientation.z;
+        msg->pose.pose.orientation.w = imu_msg_.orientation.w;
         msg->pose.covariance[7*0] = 0.1;
         msg->pose.covariance[7*1] = 0.1;
         msg->pose.covariance[7*2] = 0.1;