Completed Waypoint Updater Node (Partial):

[chris-ferone]

I believe Waypoint Update Node (Partial) is complete and working correctly. I confirmed that waypoints are being broadcast over the /final_waypoints topic using the command: rostopic echo /final_waypoints. I also confirmed that the waypoint_follower node is publishing messages to the/twist_cmd topic. This should occur only if /final_waypoints is being published.

[borisdayma]

I added a few comments, mainly:

• the first waypoint should be ahead of us
• we need to loop back to the start of the list when we finish it