Added Motor position control, and encoder offset.