projects
/
fw
/
altos
/ blobdiff
commit
grep
author
committer
pickaxe
?
search:
re
summary
|
shortlog
|
log
|
commit
|
commitdiff
|
tree
raw
|
inline
| side by side
name change from MegaMetrum to TeleMega
[fw/altos]
/
src
/
drivers
/
ao_packet.c
diff --git
a/src/drivers/ao_packet.c
b/src/drivers/ao_packet.c
index d813b25f27448c43c3707dc0f46d689b4024f94b..5a50747888a01225da2a8bc7cbe0f6dd247f7334 100644
(file)
--- a/
src/drivers/ao_packet.c
+++ b/
src/drivers/ao_packet.c
@@
-21,12
+21,13
@@
__xdata struct ao_packet_recv ao_rx_packet;
__xdata struct ao_packet ao_tx_packet;
__pdata uint8_t ao_packet_rx_len, ao_packet_rx_used, ao_packet_tx_used;
__xdata struct ao_packet ao_tx_packet;
__pdata uint8_t ao_packet_rx_len, ao_packet_rx_used, ao_packet_tx_used;
-static __xdata
char
tx_data[AO_PACKET_MAX];
-static __xdata
char
rx_data[AO_PACKET_MAX];
+static __xdata
uint8_t
tx_data[AO_PACKET_MAX];
+static __xdata
uint8_t
rx_data[AO_PACKET_MAX];
static __pdata uint8_t rx_seq;
__xdata struct ao_task ao_packet_task;
__xdata uint8_t ao_packet_enable;
static __pdata uint8_t rx_seq;
__xdata struct ao_task ao_packet_task;
__xdata uint8_t ao_packet_enable;
+__xdata uint8_t ao_packet_restart;
#if PACKET_HAS_MASTER
__xdata uint8_t ao_packet_master_sleeping;
#if PACKET_HAS_MASTER
__xdata uint8_t ao_packet_master_sleeping;
@@
-106,7
+107,8
@@
ao_packet_recv(void)
/* Check for incoming data at the next sequence and
* for an empty data buffer
*/
/* Check for incoming data at the next sequence and
* for an empty data buffer
*/
- if (ao_rx_packet.packet.seq == (uint8_t) (rx_seq + (uint8_t) 1) &&
+ if ((ao_rx_packet.packet.seq == (uint8_t) (rx_seq + (uint8_t) 1) ||
+ ao_packet_restart) &&
ao_packet_rx_used == ao_packet_rx_len) {
/* Copy data to the receive data buffer and set up the
ao_packet_rx_used == ao_packet_rx_len) {
/* Copy data to the receive data buffer and set up the
@@
-126,6
+128,7
@@
ao_packet_recv(void)
ao_wakeup(&ao_stdin_ready);
}
}
ao_wakeup(&ao_stdin_ready);
}
}
+ ao_packet_restart = 0;
/* If the other side has seen the latest data we queued,
* wake up any task waiting to send data and let them go again
/* If the other side has seen the latest data we queued,
* wake up any task waiting to send data and let them go again
@@
-152,6
+155,9
@@
ao_packet_flush(void)
void
ao_packet_putchar(char c) __reentrant
{
void
ao_packet_putchar(char c) __reentrant
{
+ /* No need to block interrupts, all variables here
+ * are only manipulated in task context
+ */
while (ao_packet_tx_used == AO_PACKET_MAX && ao_packet_enable) {
#if PACKET_HAS_MASTER
ao_packet_flush();
while (ao_packet_tx_used == AO_PACKET_MAX && ao_packet_enable) {
#if PACKET_HAS_MASTER
ao_packet_flush();
@@
-163,8
+169,9
@@
ao_packet_putchar(char c) __reentrant
tx_data[ao_packet_tx_used++] = c;
}
tx_data[ao_packet_tx_used++] = c;
}
-char
-ao_packet_pollchar(void) __critical
+/* May be called with interrupts blocked */
+int
+_ao_packet_pollchar(void)
{
if (!ao_packet_enable)
return AO_READ_AGAIN;
{
if (!ao_packet_enable)
return AO_READ_AGAIN;