Compleated the robot simulation code.