Migrate mk1 main.py to mk2

[Iacobacci]

Migrate the mk1 main.py functionality to mk2 main.py. This will require:

• [ ] - Getting Serial out of the Docker Container
• [ ] - Utilizing the controller inputs
• [ ] - Getting it all working with ROS and Docker (more detailed steps to come)