[Behaviors/PathPlanningManagerIntegration] NavTo subtree

Feature Request

Summary

This node will receive a list of points from the path planner. This will move robot to destination.

Acceptance Criteria

• Criterion

Design / Technical Approach

Either looping through an async node or having it loop from inside the node.

Dependencies

Might need slots from #525 (closed) and #526

Testing Plan

Boost unit tests and simulation testing.