start work on new servomotor control