X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_lco_func.c;h=1960683fa6b214a56cd7fd87800cd1a7c6e7562d;hb=54e98a498db0d7026ce16c3ad53bc60986c68253;hp=08d454670acb0bd881da59385e6e2ac265a3e038;hpb=55c1be449ef7ce389a3d94686051d272c858bee4;p=fw%2Faltos diff --git a/src/drivers/ao_lco_func.c b/src/drivers/ao_lco_func.c index 08d45467..1960683f 100644 --- a/src/drivers/ao_lco_func.c +++ b/src/drivers/ao_lco_func.c @@ -3,7 +3,8 @@ * * 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 @@ -20,15 +21,15 @@ #include #include -static __xdata struct ao_pad_command command; -static __xdata uint8_t ao_lco_mutex; +static struct ao_pad_command command; +static uint8_t ao_lco_mutex; int8_t ao_lco_query(uint16_t box, struct ao_pad_query *query, uint16_t *tick_offset) { int8_t r; - uint16_t sent_time; - uint16_t timeout = AO_MS_TO_TICKS(10); + AO_TICK_TYPE sent_time; + AO_TICK_TYPE timeout = AO_MS_TO_TICKS(10); #if HAS_RADIO_RATE switch (ao_config.radio_rate) { @@ -46,7 +47,7 @@ ao_lco_query(uint16_t box, struct ao_pad_query *query, uint16_t *tick_offset) ao_mutex_get(&ao_lco_mutex); command.tick = ao_time(); command.box = box; - command.cmd = AO_LAUNCH_QUERY; + command.cmd = AO_PAD_QUERY; command.channels = 0; ao_radio_cmac_send(&command, sizeof (command)); sent_time = ao_time(); @@ -61,21 +62,21 @@ void ao_lco_arm(uint16_t box, uint8_t channels, uint16_t tick_offset) { ao_mutex_get(&ao_lco_mutex); - command.tick = ao_time() - tick_offset; + command.tick = (uint16_t) ao_time() - tick_offset; command.box = box; - command.cmd = AO_LAUNCH_ARM; + command.cmd = AO_PAD_ARM; command.channels = channels; ao_radio_cmac_send(&command, sizeof (command)); ao_mutex_put(&ao_lco_mutex); } void -ao_lco_ignite(void) +ao_lco_ignite(uint8_t cmd) { ao_mutex_get(&ao_lco_mutex); command.tick = 0; command.box = 0; - command.cmd = AO_LAUNCH_FIRE; + command.cmd = cmd; command.channels = 0; ao_radio_cmac_send(&command, sizeof (command)); ao_mutex_put(&ao_lco_mutex);