From e1c1c7680c77629b763205ea8e0a96f50e94b0a8 Mon Sep 17 00:00:00 2001 From: Pradheep Date: Mon, 9 Jan 2023 17:42:57 +0100 Subject: [PATCH] fixing pose orientations while loading --- nav2_rviz_plugins/src/nav2_panel.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/nav2_rviz_plugins/src/nav2_panel.cpp b/nav2_rviz_plugins/src/nav2_panel.cpp index 0ff30ac5ce1..478bd109d16 100644 --- 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; }