Added code for driving the robot in a simple way from cmd line