2012-04-30 04:17:14 -03:00
|
|
|
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
|
|
|
|
|
|
|
|
|
|
|
static void failsafe_long_on_event(int fstype)
|
|
|
|
{
|
|
|
|
// This is how to handle a long loss of control signal failsafe.
|
|
|
|
gcs_send_text_P(SEVERITY_LOW, PSTR("Failsafe - Long event on, "));
|
2012-12-18 07:44:12 -04:00
|
|
|
hal.rcin->clear_overrides();
|
2012-04-30 04:17:14 -03:00
|
|
|
failsafe = fstype;
|
|
|
|
switch(control_mode)
|
|
|
|
{
|
|
|
|
case MANUAL:
|
2012-05-14 16:21:29 -03:00
|
|
|
case LEARNING:
|
2012-04-30 04:17:14 -03:00
|
|
|
set_mode(RTL);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case AUTO:
|
|
|
|
case GUIDED:
|
|
|
|
if(g.long_fs_action == 1) {
|
|
|
|
set_mode(RTL);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case RTL:
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
gcs_send_text_fmt(PSTR("flight mode = %u"), (unsigned)control_mode);
|
|
|
|
}
|
|
|
|
|
|
|
|
#if BATTERY_EVENT == ENABLED
|
|
|
|
static void low_battery_event(void)
|
|
|
|
{
|
|
|
|
gcs_send_text_P(SEVERITY_HIGH,PSTR("Low Battery!"));
|
|
|
|
set_mode(RTL);
|
|
|
|
g.throttle_cruise = THROTTLE_CRUISE;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static void update_events(void) // Used for MAV_CMD_DO_REPEAT_SERVO and MAV_CMD_DO_REPEAT_RELAY
|
|
|
|
{
|
|
|
|
if(event_repeat == 0 || (millis() - event_timer) < event_delay)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (event_repeat > 0){
|
|
|
|
event_repeat --;
|
|
|
|
}
|
|
|
|
|
|
|
|
if(event_repeat != 0) { // event_repeat = -1 means repeat forever
|
|
|
|
event_timer = millis();
|
|
|
|
|
|
|
|
if (event_id >= CH_5 && event_id <= CH_8) {
|
|
|
|
if(event_repeat%2) {
|
2012-12-18 07:44:12 -04:00
|
|
|
hal.rcout->write(event_id, event_value); // send to Servos
|
2012-04-30 04:17:14 -03:00
|
|
|
} else {
|
2012-12-18 07:44:12 -04:00
|
|
|
hal.rcout->write(event_id, event_undo_value);
|
2012-04-30 04:17:14 -03:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (event_id == RELAY_TOGGLE) {
|
|
|
|
relay.toggle();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|