Darkangeel_hd
/
hover-programs
mirror of https://github.com/a-garcia-alvarez/hover-programs.git
1
0
Fork 0
Code Issues Releases Wiki Activity

fix silly errors motors

This commit is contained in:
Angel Garcia 2019-06-04 10:33:17 +02:00
parent f56262b195
commit 23a1d2e19c
1 changed files with 9 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
hover-controller/motors.cpp
View File

@ -29,19 +29,19 @@ void all_motors_start() {
}
int map_esc_per(unsigned int pin, int lv) {
int lv_new
int lv_new;
switch(pin) {
case MAIN_PROP_GPIO:
lv = map(*lv, 0, 100, MAIN_PROP_IDLE_PPM, MAIN_PROP_MAX_PPM);
blv_newreak;
lv_new = map(lv, 0, 100, MAIN_PROP_IDLE_PPM, MAIN_PROP_MAX_PPM);
break;
case LEFT_PROP_GPIO:
lv_new = map(*lv, 0, 100, LEFT_PROP_IDLE_PPM, LEFT_PROP_MAX_PPM);
lv_new = map(lv, 0, 100, LEFT_PROP_IDLE_PPM, LEFT_PROP_MAX_PPM);
break;
case RIGHT_PROP_GPIO:
lv_new = map(*lv, 0, 100, RIGHT_PROP_IDLE_PPM, RIGHT_PROP_MAX_PPM);
lv_new = map(lv, 0, 100, RIGHT_PROP_IDLE_PPM, RIGHT_PROP_MAX_PPM);
break;
default:
lv_new = map(*lv, 0, 100, ESC_MIN, ESC_MAX);
lv_new = map(lv, 0, 100, ESC_MIN, ESC_MAX);
}
return lv_new;
}
@ -117,9 +117,10 @@ void motor_process(char*msg){
if (servo_index == 'R')
pin = RIGHT_PROP_GPIO;
else
if (servo_index == 'P')
advance_both(&msg, &lv, offset);
if (servo_index == 'P') {
advance_both(msg, &lv, offset);
return;
}
else {
eprintf("[motors] index not valid (%c)\n", servo_index);
strcpy(msg, "ESC_INDX_NOK");