/*
- * Copyright © 2011 Keith Packard <keithp@keithp.com>
+ * Copyright © 2017 Keith Packard <keithp@keithp.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
#include <ao.h>
#include <ao_exti.h>
+static void
+ao_check_recovery(void)
+{
+ int i;
+ ao_enable_input(AO_RECOVERY_PORT, AO_RECOVERY_PIN, AO_RECOVERY_MODE);
+ for (i = 0; i < 100; i++)
+ ao_arch_nop();
+ if (ao_gpio_get(AO_RECOVERY_PORT, AO_RECOVERY_PIN) == AO_RECOVERY_VALUE) {
+ ao_flight_force_idle = 1;
+ ao_force_freq = 1;
+ }
+ ao_gpio_set_mode(AO_RECOVERY_PORT, AO_RECOVERY_PIN, 0);
+ ao_disable_port(AO_RECOVERY_PORT);
+}
+
void
main(void)
{
+ ao_check_recovery();
+
ao_clock_init();
ao_task_init();
- ao_led_init(LEDS_AVAILABLE);
- ao_led_on(AO_LED_GREEN);
ao_timer_init();
ao_dma_init();
#endif
#if HAS_SERIAL_1
ao_serial_init();
+#endif
+#if HAS_USB
+ ao_usb_init();
#endif
ao_cmd_init();
ao_report_init();
ao_telemetry_init();
ao_radio_init();
- ao_packet_slave_init(TRUE);
+ ao_packet_slave_init(true);
ao_igniter_init();
ao_config_init();