[Behaviours/Navigator] Implement for-loop control flow as SubTree to handle loop of MoveTo commands

Feature Request

Summary

In our BT system, handle a vector/deque of MoveTo commands created by the PathPlanner::GetPath command

Acceptance Criteria

  • Creates BT that issues MoveTo command for each Hexagon in deque
  • Simple unit test is written to test MoveTo looping logic

Design / Technical Approach

To extend the stub of #399 (closed)

Good idea to use the LoopNode from the BT.CPP library.

Dependencies

Testing Plan

  • Write unit tests for feat
Edited by David Pham