linear + rotational loop
Multiple changes

Fixed some formatting issues
Reinforced const nature of certain variables
Wrote basic implementation of RobotController
Added comments for documentation
Finalized code structure

Cubeception library has everything integrated
Merge branch 'working'