Fix errors on motors

This commit is contained in:
Angel Garcia 2019-06-03 18:53:44 +02:00
parent cf352780d8
commit c054dbed85
1 changed files with 3 additions and 2 deletions

View File

@ -103,16 +103,17 @@ void motor_process(char*msg){
case ' ':
if (lv < 500)
servo_mode = '%';
else
else {
servo_mode = 'R';
break;
}
case '%':
map_esc_per(pin, &lv);
break;
case 'R':
break;
default:
eprintf("[motors] mode not valid (%c)\n", *mode);
eprintf("[motors] mode not valid (%c)\n", *servo_mode);
strcpy(msg, "ESC_MODE_NOK");
return;
}