After turn (angle) move automaticly forward with speed 100

main
Simon Frei 4 years ago
parent 3b9c76db34
commit c51c0d8007
  1. 2
      ADIS_Sumo_Styger/Sumo/Turn.c

@ -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);

Loading…
Cancel
Save