MotorDriver: fixed bug