Changed a few things in Robot Code. Added JavaDoc for commands, renamed RobotTemplate to RobotMain.