Thank you for the comment :smiley:. I will refer to the Waypoint follower at the Wiki page as a better way for waypoint navigation for ROS2 users, and probably not consider moving this package to ROS2, this is a much better implementation.