[Autonomy] [High Priority] High Level Controller

[SwapnilPande]

Which section of robot code is this for?
High Level Controller

Description of feature

• Build a controller to make decisions about which tasks need to be executed. This controller will determine what the robot does (including switching between human controlled and autonomous modes).
• Build ROS Node to interface with all other necessary nodes to send commands

Additional Notes
Potentially approach this by developing a finite state machine (HFSM).

[SwapnilPande]

https://github.com/finger563/webgme-hfsm - @partlygloudy Check this out. We might be able to use this to build a finite state machine for the high level controller