Moved Autonomous back to MyRobot.cpp

Cleaned up as well