Added the first steps to move the robot from the gui