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