[TASK] Waypoint Manager

[Aleksander Klund]

Description of task

Simply appending Waypoints to a numpy array does not work. We need a dedicated node for managing these.

Suggested Workflow

• Look at the old implementation of the Waypoint Manager
• Implement it in ROS2

Specifications

• Takes in list of waypoints from path planner
• Sends list of waypoints to guidance system
• Removes points from list when reached

Contacts

• @theBadMusician

Code Quality

• Every function in header files are documented (inputs/returns/exceptions)
• The project has automated tests that cover MOST of the functions and branches in functions (pytest/gtest)
• The code is documented on the wiki (provide link)