diff options
Diffstat (limited to 'protocol')
| -rw-r--r-- | protocol/ibm4704.c | 150 | ||||
| -rw-r--r-- | protocol/ibm4704.h | 111 |
2 files changed, 261 insertions, 0 deletions
diff --git a/protocol/ibm4704.c b/protocol/ibm4704.c new file mode 100644 index 000000000..26441ed52 --- /dev/null +++ b/protocol/ibm4704.c @@ -0,0 +1,150 @@ +/* +Copyright 2010,2011,2012,2013 Jun WAKO <wakojun@gmail.com> +*/ +#include <stdbool.h> +#include <util/delay.h> +#include "debug.h" +#include "ibm4704.h" + + +#define WAIT(stat, us, err) do { \ + if (!wait_##stat(us)) { \ + ibm4704_error = err; \ + goto ERROR; \ + } \ +} while (0) + + +uint8_t ibm4704_error = 0; + + +void ibm4704_init(void) +{ + // POR + //_delay_ms(2500); + //while ( 0xA3 != ibm4704_recv() ) ; + + inhibit(); + DDRD |= 1<<3; + PORTD &= ~(1<<3); +} + +uint8_t ibm4704_send(uint8_t data) +{ + bool parity = true; // odd parity + ibm4704_error = 0; + + /* Request to send */ + idle(); + clock_lo(); +PIND |= 1<<3; + + /* wait for Start bit(Clock:lo/Data:hi) */ + WAIT(data_hi, 300, 0x30); + + /* Data bit */ + for (uint8_t i = 0; i < 8; i++) { + WAIT(clock_hi, 100, 0x31); + //_delay_us(5); +PIND |= 1<<3; + if (data&(1<<i)) { + parity = !parity; + data_hi(); + } else { + data_lo(); + } + WAIT(clock_lo, 100, 0x32); + } + + /* Parity bit */ + WAIT(clock_hi, 100, 4); +PIND |= 1<<3; + if (parity) { data_hi(); } else { data_lo(); } + WAIT(clock_lo, 100, 5); + + /* Stop bit */ + WAIT(clock_hi, 100, 4); + data_hi(); + + /* End */ + WAIT(data_lo, 100, 6); + + inhibit(); + _delay_us(200); // wait to recover clock to hi + return 0; +ERROR: + inhibit(); +xprintf("x%02X ", ibm4704_error); + _delay_us(200); // wait to recover clock to hi + return -1; +} + +/* receive data when host want else inhibit communication */ +uint8_t ibm4704_recv_response(void) +{ + // 250 * 100us(wait start bit in ibm4704_recv) + uint8_t data = 0; + uint8_t try = 250; + do { + data = ibm4704_recv(); + } while (try-- && ibm4704_error); + return data; +} + +/* +Keyboard to Host: +Clock ~~~~___~~_~~_~~_~~_~~_~~_~~_~~_~~_~~~~~~~~ H:60us/L:30us + +Data ____~~X==X==X==X==X==X==X==X==X==X________ + | 0 1 2 3 4 5 6 7 P(odd) + | LSB MSB + Start bit(80us) +*/ +uint8_t ibm4704_recv(void) +{ + uint8_t data = 0; + bool parity = true; // odd parity + ibm4704_error = IBM4704_ERR_NONE; + + idle(); + _delay_us(5); // wait for line settles + + /* start bit */ + WAIT(clock_lo, 100, 1); // wait for keyboard to send + WAIT(data_hi, 100, 2); // can be delayed that long + + WAIT(clock_hi, 100, 3); // first rising edge which can take longer + /* data */ + for (uint8_t i = 0; i < 8; i++) { + WAIT(clock_hi, 100, 0x20+i); + //_delay_us(5); + if (data_in()) { + parity = !parity; + data |= (1<<i); + } + WAIT(clock_lo, 150, 0x28+i); + } + + /* parity */ + WAIT(clock_hi, 100, 7); + if (data_in() != parity) { + ibm4704_error = IBM4704_ERR_PARITY; + goto ERROR; + } + WAIT(clock_lo, 150, 8); + + /* stop bit */ + WAIT(clock_hi, 100, 9); + WAIT(data_lo, 1, 9); + + inhibit(); + _delay_us(200); // wait to recover clock to hi + return data; +ERROR: + if (ibm4704_error > 2) { + xprintf("x%02X ", ibm4704_error); + } + inhibit(); + _delay_us(200); // wait to recover clock to hi + return -1; +} diff --git a/protocol/ibm4704.h b/protocol/ibm4704.h new file mode 100644 index 000000000..ff8a5b771 --- /dev/null +++ b/protocol/ibm4704.h @@ -0,0 +1,111 @@ +/* +Copyright 2014 Jun WAKO <wakojun@gmail.com> +*/ +#ifndef IBM4704_H +#define IBM4704_H + +#define IBM4704_ERR_NONE 0 +#define IBM4704_ERR_STARTBIT 1 +#define IBM4704_ERR_PARITY 0x70 + + +void ibm4704_init(void); +uint8_t ibm4704_send(uint8_t data); +uint8_t ibm4704_recv_response(void); +uint8_t ibm4704_recv(void); + + +/* Check pin configuration */ +#if !(defined(IBM4704_CLOCK_PORT) && \ + defined(IBM4704_CLOCK_PIN) && \ + defined(IBM4704_CLOCK_DDR) && \ + defined(IBM4704_CLOCK_BIT)) +# error "ibm4704 clock pin configuration is required in config.h" +#endif + +#if !(defined(IBM4704_DATA_PORT) && \ + defined(IBM4704_DATA_PIN) && \ + defined(IBM4704_DATA_DDR) && \ + defined(IBM4704_DATA_BIT)) +# error "ibm4704 data pin configuration is required in config.h" +#endif + + +/*-------------------------------------------------------------------- + * static functions + *------------------------------------------------------------------*/ +static inline void clock_lo(void) +{ + IBM4704_CLOCK_PORT &= ~(1<<IBM4704_CLOCK_BIT); + IBM4704_CLOCK_DDR |= (1<<IBM4704_CLOCK_BIT); +} +static inline void clock_hi(void) +{ + /* input with pull up */ + IBM4704_CLOCK_DDR &= ~(1<<IBM4704_CLOCK_BIT); + IBM4704_CLOCK_PORT |= (1<<IBM4704_CLOCK_BIT); +} +static inline bool clock_in(void) +{ + IBM4704_CLOCK_DDR &= ~(1<<IBM4704_CLOCK_BIT); + IBM4704_CLOCK_PORT |= (1<<IBM4704_CLOCK_BIT); + _delay_us(1); + return IBM4704_CLOCK_PIN&(1<<IBM4704_CLOCK_BIT); +} +static inline void data_lo(void) +{ + IBM4704_DATA_PORT &= ~(1<<IBM4704_DATA_BIT); + IBM4704_DATA_DDR |= (1<<IBM4704_DATA_BIT); +} +static inline void data_hi(void) +{ + /* input with pull up */ + IBM4704_DATA_DDR &= ~(1<<IBM4704_DATA_BIT); + IBM4704_DATA_PORT |= (1<<IBM4704_DATA_BIT); +} +static inline bool data_in(void) +{ + IBM4704_DATA_DDR &= ~(1<<IBM4704_DATA_BIT); + IBM4704_DATA_PORT |= (1<<IBM4704_DATA_BIT); + _delay_us(1); + return IBM4704_DATA_PIN&(1<<IBM4704_DATA_BIT); +} + +static inline uint16_t wait_clock_lo(uint16_t us) +{ + while (clock_in() && us) { asm(""); _delay_us(1); us--; } + return us; +} +static inline uint16_t wait_clock_hi(uint16_t us) +{ + while (!clock_in() && us) { asm(""); _delay_us(1); us--; } + return us; +} +static inline uint16_t wait_data_lo(uint16_t us) +{ + while (data_in() && us) { asm(""); _delay_us(1); us--; } + return us; +} +static inline uint16_t wait_data_hi(uint16_t us) +{ + while (!data_in() && us) { asm(""); _delay_us(1); us--; } + return us; +} + +/* idle state that device can send */ +static inline void idle(void) +{ + clock_hi(); + data_hi(); +} + +/* inhibit device to send + * keyboard checks Data line on start bit(Data:hi) and it stops sending if Data line is low. + */ +static inline void inhibit(void) +{ + clock_hi(); + data_lo(); +} + +#endif |