This commit is contained in:
James Goppert 2011-10-18 22:01:25 -04:00
commit c98c287901
2 changed files with 17 additions and 0 deletions

View File

@ -92,6 +92,22 @@ static void read_trim_switch()
}
}
#elif CH7_OPTION == CH7_SAVE_WP
if (g.rc_7.control_in > 800){
trim_flag = true;
}else{ // switch is disengaged
if(trim_flag){
// set the next_WP
CH7_wp_index++;
current_loc.id = MAV_CMD_NAV_WAYPOINT;
g.waypoint_total.set_and_save(CH7_wp_index);
set_command_with_index(current_loc, CH7_wp_index);
}
}
#elif CH7_OPTION == CH7_ADC_FILTER
if (g.rc_7.control_in > 800){
adc.filter_result = true;

View File

@ -37,6 +37,7 @@
#define CH7_RTL 4
#define CH7_AUTO_TRIM 5
#define CH7_ADC_FILTER 6
#define CH7_SAVE_WP 7
// Frame types
#define QUAD_FRAME 0