|
|
|
@ -43,15 +43,15 @@ void Copter::set_simple_mode(uint8_t b)
@@ -43,15 +43,15 @@ void Copter::set_simple_mode(uint8_t b)
|
|
|
|
|
if(ap.simple_mode != b){ |
|
|
|
|
if(b == 0){ |
|
|
|
|
Log_Write_Event(DATA_SET_SIMPLE_OFF); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_LOW, PSTR("Simple:OFF")); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, PSTR("Simple:OFF")); |
|
|
|
|
}else if(b == 1){ |
|
|
|
|
Log_Write_Event(DATA_SET_SIMPLE_ON); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_LOW, PSTR("Simple:ON")); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, PSTR("Simple:ON")); |
|
|
|
|
}else{ |
|
|
|
|
// initialise super simple heading
|
|
|
|
|
update_super_simple_bearing(true); |
|
|
|
|
Log_Write_Event(DATA_SET_SUPERSIMPLE_ON); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_LOW, PSTR("SuperSimple:ON")); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, PSTR("SuperSimple:ON")); |
|
|
|
|
} |
|
|
|
|
ap.simple_mode = b; |
|
|
|
|
} |
|
|
|
|