X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Ftelemini-v3.0%2Fao_telemini.c;h=d571d340f38919ee46f9ed6dd2f8ab1dd013b903;hb=HEAD;hp=a50268b9001ffd0247495460f469554d99343794;hpb=178d7c0aa32267ea71be2ccff146ea6ff990d7dc;p=fw%2Faltos diff --git a/src/telemini-v3.0/ao_telemini.c b/src/telemini-v3.0/ao_telemini.c index a50268b9..d571d340 100644 --- a/src/telemini-v3.0/ao_telemini.c +++ b/src/telemini-v3.0/ao_telemini.c @@ -19,6 +19,7 @@ #include #include +#if HAS_FORCE_FREQ static void ao_check_recovery(void) { @@ -26,18 +27,21 @@ ao_check_recovery(void) 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) == AO_RECOVERY_VALUE) { + 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); } +#endif -void +int main(void) { +#if HAS_FORCE_FREQ ao_check_recovery(); +#endif ao_clock_init(); ao_task_init(); @@ -68,7 +72,7 @@ main(void) 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();