Fix problem 2: Program the robot, after it detects the lever has been