Fixed more bugs

Defined variables and added movement to the robot.