|
|
|
@ -575,6 +575,8 @@ uint8_t TURN_ParseCommand(const unsigned char *cmd, bool *handled, const McuShel |
|
|
|
if (McuUtility_xatoi(&p, &angle)==ERR_OK) { |
|
|
|
if (McuUtility_xatoi(&p, &angle)==ERR_OK) { |
|
|
|
TURN_TurnAngle((int16_t)angle, NULL); |
|
|
|
TURN_TurnAngle((int16_t)angle, NULL); |
|
|
|
TURN_Turn(TURN_STOP, NULL); |
|
|
|
TURN_Turn(TURN_STOP, NULL); |
|
|
|
|
|
|
|
DRV_SetSpeed(100, 100); |
|
|
|
|
|
|
|
DRV_SetMode(DRV_MODE_SPEED); |
|
|
|
*handled = TRUE; |
|
|
|
*handled = TRUE; |
|
|
|
} else { |
|
|
|
} else { |
|
|
|
McuShell_SendStr((unsigned char*)"Wrong argument\r\n", io->stdErr); |
|
|
|
McuShell_SendStr((unsigned char*)"Wrong argument\r\n", io->stdErr); |
|
|
|
|