Fixed HAL set_motor STOP