simpleadditions to RobotMain.cpp. Added comments and TODO stubs