Working on the ScaraRobot Class