modified cmdSetMotor for test_sma