Copy comments over from Java version
Move method implementations out of SimpleRobot.h to SimpleRobot.cpp

Also added more comments to RobotMode.h