X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fdrivers%2Fao_lco_cmd.c;h=6f195e550cfc909063984a0115a9163807038da5;hp=8de21fb6702075e25317dfb891e50223fa517122;hb=HEAD;hpb=d75351c5a07241bcbb951758796b4f639ace6b1f diff --git a/src/drivers/ao_lco_cmd.c b/src/drivers/ao_lco_cmd.c index 8de21fb6..391b4547 100644 --- a/src/drivers/ao_lco_cmd.c +++ b/src/drivers/ao_lco_cmd.c @@ -22,17 +22,18 @@ #include #include -static __pdata uint16_t lco_box; -static __pdata uint8_t lco_channels; -static __pdata uint16_t tick_offset; +#ifndef HAS_STATIC_TEST +#define HAS_STATIC_TEST 1 +#endif + +static uint16_t lco_box; +static uint8_t lco_channels; static void -lco_args(void) __reentrant +lco_args(void) { - ao_cmd_decimal(); - lco_box = ao_cmd_lex_i; - ao_cmd_hex(); - lco_channels = ao_cmd_lex_i; + lco_box = (uint16_t) ao_cmd_decimal(); + lco_channels = (uint8_t) ao_cmd_hex(); } static struct ao_pad_query ao_pad_query; @@ -67,7 +68,7 @@ lco_ignite(uint8_t cmd) } static void -lco_report_cmd(void) __reentrant +lco_report_cmd(void) { int8_t r; uint8_t c; @@ -118,15 +119,14 @@ lco_report_cmd(void) __reentrant } static void -lco_fire_cmd(void) __reentrant +lco_fire_cmd(void) { uint8_t secs; uint8_t i; int8_t r; lco_args(); - ao_cmd_decimal(); - secs = ao_cmd_lex_i; + secs = (uint8_t) ao_cmd_decimal(); if (ao_cmd_status != ao_cmd_success) return; r = lco_query(); @@ -140,7 +140,7 @@ lco_fire_cmd(void) __reentrant lco_arm(); } - secs = secs * 10 - 5; + secs = (uint8_t) (secs * 10 - 5); if (secs > 100) secs = 100; for (i = 0; i < secs; i++) { @@ -150,16 +150,16 @@ lco_fire_cmd(void) __reentrant } } +#if HAS_STATIC_TEST static void -lco_static_cmd(void) __reentrant +lco_static_cmd(void) { uint8_t secs; uint8_t i; int8_t r; lco_args(); - ao_cmd_decimal(); - secs = ao_cmd_lex_i; + secs = (uint8_t) ao_cmd_decimal(); if (ao_cmd_status != ao_cmd_success) return; r = lco_query(); @@ -173,7 +173,7 @@ lco_static_cmd(void) __reentrant lco_arm(); } - secs = secs * 10 - 5; + secs = (uint8_t) (secs * 10 - 5); if (secs > 100) secs = 100; for (i = 0; i < secs; i++) { @@ -182,9 +182,10 @@ lco_static_cmd(void) __reentrant ao_delay(AO_MS_TO_TICKS(100)); } } +#endif static void -lco_arm_cmd(void) __reentrant +lco_arm_cmd(void) { uint8_t i; int8_t r; @@ -199,7 +200,7 @@ lco_arm_cmd(void) __reentrant } static void -lco_ignite_cmd(void) __reentrant +lco_ignite_cmd(void) { uint8_t i; lco_args(); @@ -208,18 +209,21 @@ lco_ignite_cmd(void) __reentrant } +#if HAS_STATIC_TEST static void -lco_endstatic_cmd(void) __reentrant +lco_endstatic_cmd(void) { lco_ignite(AO_PAD_ENDSTATIC); } +#endif -static __code struct ao_cmds ao_lco_cmds[] = { +static const struct ao_cmds ao_lco_cmds[] = { { lco_report_cmd, "l \0Get remote status" }, { lco_fire_cmd, "F \0Fire remote igniters" }, - { lco_fire_cmd, "F \0Fire remote igniters" }, +#if HAS_STATIC_TEST { lco_static_cmd, "S \0Initiate static test" }, { lco_endstatic_cmd, "D\0End static test (and download someday)" }, +#endif { lco_arm_cmd, "a \0Arm remote igniter" }, { lco_ignite_cmd, "i \0Pulse remote igniter" }, { 0, NULL },