Added processing and testing the robot movement.