Driving controls done (hopefully)

Controls for steering and moving the robot done. Might need to be
tweaked and refined