changed the driving equations to a point where the robot drives as expected