hubero_ros - NavigationRos: goal's orientation also logged in the…

… `computePlan` method
rayvburn · Oct 3, 2023 · f4c7555 · f4c7555
1 parent e14fead
commit f4c7555
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/hubero_ros/src/navigation_ros.cpp b/hubero_ros/src/navigation_ros.cpp
@@ -724,12 +724,13 @@ nav_msgs::Path NavigationRos::computePlan(
 	}
 
 	HUBERO_LOG(
-		"[%s].[NavigationRos] Computed plan with %lu poses (goal: {%2.2f, %2.2f}, "
+		"[%s].[NavigationRos] Computed plan with %lu poses (goal: {%2.2f, %2.2f, %2.2f}, "
 		"lastElem: {%2.2f, %2.2f}, secToLastElem: {%2.2f, %2.2f}\r\n",
 		actor_name_.c_str(),
 		resp.plan.poses.size(),
 		pose_goal_global_ref_plane.Pos().X(),
 		pose_goal_global_ref_plane.Pos().Y(),
+		pose_goal_global_ref_plane.Rot().Yaw(),
 		resp.plan.poses.back().pose.position.x,
 		resp.plan.poses.back().pose.position.y,
 		resp.plan.poses.end()[-2].pose.position.x,