add first pass of motor control