summaryrefslogtreecommitdiffstats
path: root/protocol/serial_soft.c
diff options
context:
space:
mode:
Diffstat (limited to 'protocol/serial_soft.c')
-rw-r--r--protocol/serial_soft.c18
1 files changed, 17 insertions, 1 deletions
diff --git a/protocol/serial_soft.c b/protocol/serial_soft.c
index beddc353c0..e0661c3aa1 100644
--- a/protocol/serial_soft.c
+++ b/protocol/serial_soft.c
@@ -106,11 +106,19 @@ ISR(SERIAL_RXD_VECT)
SERIAL_RXD_INT_ENTER()
uint8_t data = 0;
+
#ifdef SERIAL_BIT_ORDER_MSB
uint8_t mask = 0x80;
#else
uint8_t mask = 0x01;
#endif
+
+#ifdef SERIAL_PARITY_ODD
+ uint8_t parity = 0;
+#else
+ uint8_t parity = 1;
+#endif
+
/* to center of start bit */
_delay_us(WAIT_US/2);
do {
@@ -119,6 +127,7 @@ ISR(SERIAL_RXD_VECT)
if (SERIAL_RXD_READ()) {
data |= mask;
+ parity ^= 1;
}
#ifdef SERIAL_BIT_ORDER_MSB
mask >>= 1;
@@ -126,11 +135,18 @@ ISR(SERIAL_RXD_VECT)
mask <<= 1;
#endif
} while (mask);
+
+ /* to center of parity bit */
+ _delay_us(WAIT_US);
+ parity ^= SERIAL_RXD_READ();
+
/* to center of stop bit */
_delay_us(WAIT_US);
+ _delay_us(WAIT_US/2);
+ parity = 1;
uint8_t next = (rbuf_head + 1) % RBUF_SIZE;
- if (next != rbuf_tail) {
+ if (parity && next != rbuf_tail) {
rbuf[rbuf_head] = data;
rbuf_head = next;
}