Updated version of the program (a bit simplified), updated presentation, and added a video of the robot.