Cleaned up RobotInit.h and RobotIO.h/.cpp which were absorbed into the controller class