ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
To compute your yaw
in radians I think it should be yaw = atan2(goal.y - start.y, goal.x - start.x)
instead of yaw = (goal.y - start.y) / (goal.x - start.x)
Otherwise, here is a tutorial for a plugin that plans a straight line. While the wrapping code is for ROS2 the core logic to compute the straight line is fully described: https://navigation.ros.org/plugin_tutorials/docs/writing_new_nav2planner_plugin.html