diff options
| author |  tmk <nobody@nowhere> | 2014-08-26 17:39:04 +0900 |
|---|---|---|
| committer | tmk <nobody@nowhere> | 2014-08-26 17:39:04 +0900 |
| commit | c672cbc31c67335050dc3ba9d54acb97e5d3da0c (patch) | |
| tree | b4fbcfc7f7c58781ee503e3e98ae31fce78de133 /protocol | |
| parent | c4530ab0a8d7cf09ec37b082695f8f17f02c2b00 (diff) | |
| download | qmk_firmware-c672cbc31c67335050dc3ba9d54acb97e5d3da0c.tar.gz | |
Add option 7bit data to serial_soft.c
Diffstat (limited to 'protocol')
| -rw-r--r-- | protocol/serial_soft.c | 20 |
1 files changed, 18 insertions, 2 deletions
diff --git a/protocol/serial_soft.c b/protocol/serial_soft.c index e8870bcd7..44822b7e4 100644 --- a/protocol/serial_soft.c +++ b/protocol/serial_soft.c @@ -122,7 +122,11 @@ void serial_send(uint8_t data) /* signal state: IDLE: ON, START: OFF, STOP: ON, DATA0: OFF, DATA1: ON */ #ifdef SERIAL_SOFT_BIT_ORDER_MSB + #ifdef SERIAL_SOFT_DATA_7BIT + uint8_t mask = 0x40; + #else uint8_t mask = 0x80; + #endif #else uint8_t mask = 0x01; #endif @@ -133,7 +137,11 @@ void serial_send(uint8_t data) SERIAL_SOFT_TXD_OFF(); _delay_us(WAIT_US); - while (mask) { +#ifdef SERIAL_SOFT_DATA_7BIT + while (mask&0x7F) { +#else + while (mask&0xFF) { +#endif if (data&mask) { SERIAL_SOFT_TXD_ON(); parity ^= 1; @@ -173,7 +181,11 @@ ISR(SERIAL_SOFT_RXD_VECT) uint8_t data = 0; #ifdef SERIAL_SOFT_BIT_ORDER_MSB + #ifdef SERIAL_SOFT_DATA_7BIT + uint8_t mask = 0x40; + #else uint8_t mask = 0x80; + #endif #else uint8_t mask = 0x01; #endif @@ -197,7 +209,11 @@ ISR(SERIAL_SOFT_RXD_VECT) #else mask <<= 1; #endif - } while (mask); +#ifdef SERIAL_SOFT_DATA_7BIT + } while (mask&0x7F); +#else + } while (mask&0xFF); +#endif #if defined(SERIAL_SOFT_PARITY_EVEN) || defined(SERIAL_SOFT_PARITY_ODD) /* to center of parity bit */ |