Add Initial files of 4704_usb

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