X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fdrivers%2Fao_pad.c;h=b415355838ac657c4242bb08154aabc075e8cc77;hp=c08798ac795db6da1555e3a164d09b443397a14e;hb=c31db066e5ba7a6708ebe4bf350963697c611816;hpb=c417ab1de2a083b5fcff2e081e4feb2a65887903 diff --git a/src/drivers/ao_pad.c b/src/drivers/ao_pad.c index c08798ac..b4153558 100644 --- a/src/drivers/ao_pad.c +++ b/src/drivers/ao_pad.c @@ -50,7 +50,7 @@ static void ao_siren(uint8_t v) { #ifdef AO_SIREN - ao_gpio_set(AO_SIREN_PORT, AO_SIREN_PIN, AO_SIREN, v); + ao_gpio_set(AO_SIREN_PORT, AO_SIREN_PIN, v); #else #if HAS_BEEP ao_beep(v ? AO_BEEP_MID : 0); @@ -64,7 +64,7 @@ static void ao_strobe(uint8_t v) { #ifdef AO_STROBE - ao_gpio_set(AO_STROBE_PORT, AO_STROBE_PIN, AO_STROBE, v); + ao_gpio_set(AO_STROBE_PORT, AO_STROBE_PIN, v); #else (void) v; #endif @@ -176,7 +176,7 @@ ao_pad_run(void) * AO_PAD_R_IGNITER_SENSE_GND Resistors from igniter sense ADC inputs to ground */ -int16_t +static int16_t ao_pad_decivolt(int16_t adc, int16_t r_plus, int16_t r_minus) { int32_t mul = (int32_t) AO_ADC_REFERENCE_DV * (r_plus + r_minus); @@ -378,7 +378,7 @@ ao_pad(void) while (ao_pad_disabled) ao_sleep(&ao_pad_disabled); ret = ao_radio_cmac_recv(&command, sizeof (command), 0); - PRINTD ("cmac_recv %d %d\n", ret, ao_radio_cmac_rssi); + PRINTD ("cmac_recv status %d rssi %d\n", ret, ao_radio_cmac_rssi); if (ret != AO_RADIO_CMAC_OK) continue; ao_pad_packet_time = ao_time(); @@ -406,6 +406,10 @@ ao_pad(void) PRINTD ("time difference too large %d\n", time_difference); break; } + if (query.arm_status != AO_PAD_ARM_STATUS_ARMED) { + PRINTD ("box not armed locally\n"); + break; + } PRINTD ("armed\n"); ao_pad_armed = command.channels; ao_pad_arm_time = ao_time(); @@ -472,7 +476,7 @@ ao_pad(void) } } -void +static void ao_pad_test(void) { uint8_t c; @@ -501,7 +505,7 @@ ao_pad_test(void) } } -void +static void ao_pad_manual(void) { uint8_t ignite; @@ -529,7 +533,7 @@ static struct ao_task ao_pad_ignite_task; static struct ao_task ao_pad_monitor_task; #if DEBUG -void +static void ao_pad_set_debug(void) { uint16_t r = ao_cmd_decimal(); @@ -589,34 +593,34 @@ ao_pad_init(void) } #endif #if AO_PAD_NUM > 0 - ao_enable_output(AO_PAD_0_PORT, AO_PAD_PIN_0, AO_PAD_0, 0); + ao_enable_output(AO_PAD_0_PORT, AO_PAD_PIN_0, 0); #endif #if AO_PAD_NUM > 1 - ao_enable_output(AO_PAD_1_PORT, AO_PAD_PIN_1, AO_PAD_1, 0); + ao_enable_output(AO_PAD_1_PORT, AO_PAD_PIN_1, 0); #endif #if AO_PAD_NUM > 2 - ao_enable_output(AO_PAD_2_PORT, AO_PAD_PIN_2, AO_PAD_2, 0); + ao_enable_output(AO_PAD_2_PORT, AO_PAD_PIN_2, 0); #endif #if AO_PAD_NUM > 3 - ao_enable_output(AO_PAD_3_PORT, AO_PAD_PIN_3, AO_PAD_3, 0); + ao_enable_output(AO_PAD_3_PORT, AO_PAD_PIN_3, 0); #endif #if AO_PAD_NUM > 4 - ao_enable_output(AO_PAD_4_PORT, AO_PAD_PIN_4, AO_PAD_4, 0); + ao_enable_output(AO_PAD_4_PORT, AO_PAD_PIN_4, 0); #endif #if AO_PAD_NUM > 5 - ao_enable_output(AO_PAD_5_PORT, AO_PAD_PIN_5, AO_PAD_5, 0); + ao_enable_output(AO_PAD_5_PORT, AO_PAD_PIN_5, 0); #endif #if AO_PAD_NUM > 5 - ao_enable_output(AO_PAD_6_PORT, AO_PAD_PIN_6, AO_PAD_6, 0); + ao_enable_output(AO_PAD_6_PORT, AO_PAD_PIN_6, 0); #endif #if AO_PAD_NUM > 7 - ao_enable_output(AO_PAD_7_PORT, AO_PAD_PIN_7, AO_PAD_7, 0); + ao_enable_output(AO_PAD_7_PORT, AO_PAD_PIN_7, 0); #endif #ifdef AO_STROBE - ao_enable_output(AO_STROBE_PORT, AO_STROBE_PIN, AO_STROBE, 0); + ao_enable_output(AO_STROBE_PORT, AO_STROBE_PIN, 0); #endif #ifdef AO_SIREN - ao_enable_output(AO_SIREN_PORT, AO_SIREN_PIN, AO_SIREN, 0); + ao_enable_output(AO_SIREN_PORT, AO_SIREN_PIN, 0); #endif ao_cmd_register(&ao_pad_cmds[0]); ao_add_task(&ao_pad_task, ao_pad, "pad listener");