Added motors & adjust speed based on rotation

Added code to drive the motors.
Count the rotations & adjust the motor speeds to maintain going
straight.