add drive and steer methods

to control motor and servo based on range sensor