Initial Setup

- Doesn't do any movements
- Set up managers for each RobotType