RobotMapper:
Added Internal Autonomous and Debugging mode.
Fixed Robot (needed to convert heading to radians)