Fix Auto_Trim to allow it to actually be called when setup on Ch7 pulldown menu in MP.

This commit is contained in:
Robert Lefebvre 2012-03-23 09:17:58 -04:00
parent ee4803c12d
commit 84d8414a2e

View File

@ -72,11 +72,6 @@ static void read_trim_switch()
}
}
#elif CH7_OPTION == CH7_AUTO_TRIM
if (g.rc_7.radio_in > CH_7_PWM_TRIGGER){
auto_level_counter = 10;
}
#else
// this is the normal operation set by the mission planner
@ -152,6 +147,10 @@ static void read_trim_switch()
// 3 = command total
}
}
}else if (g.ch7_option == CH7_AUTO_TRIM){
if (g.rc_7.radio_in > CH_7_PWM_TRIGGER){
auto_level_counter = 10;
}
}
#endif
@ -212,7 +211,7 @@ static void trim_accel()
trim_roll = constrain(trim_roll, -1.5, 1.5);
trim_pitch = constrain(trim_pitch, -1.5, 1.5);
if(g.rc_1.control_in > 200){ // Roll RIght
if(g.rc_1.control_in > 200){ // Roll Right
imu.ay(imu.ay() - trim_roll);
}else if (g.rc_1.control_in < -200){
imu.ay(imu.ay() - trim_roll);