fixing pose orientations while loading (ros-navigation#3354)

padhupradheep · web-flow · commit 9fda8e65bd53 · 2023-01-09T10:21:01.000-08:00
diff --git a/nav2_rviz_plugins/src/nav2_panel.cpp b/nav2_rviz_plugins/src/nav2_panel.cpp
@@ -717,9 +717,9 @@ geometry_msgs::msg::PoseStamped Nav2Panel::convert_to_msg(
   msg.pose.position.z = pose[2];
 
   msg.pose.orientation.w = orientation[0];
-  msg.pose.orientation.w = orientation[1];
-  msg.pose.orientation.w = orientation[2];
-  msg.pose.orientation.w = orientation[3];
+  msg.pose.orientation.x = orientation[1];
+  msg.pose.orientation.y = orientation[2];
+  msg.pose.orientation.z = orientation[3];
 
   return msg;
 }
