123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169 |
- #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)
- {
- inhibit();
- }
- uint8_t ibm4704_send(uint8_t data)
- {
- bool parity = true;
- ibm4704_error = 0;
-
- idle();
- clock_lo();
-
- WAIT(data_hi, 300, 0x30);
-
- for (uint8_t i = 0; i < 8; i++) {
- WAIT(clock_hi, 100, 0x40+i);
-
- if (data&(1<<i)) {
- parity = !parity;
- data_hi();
- } else {
- data_lo();
- }
- WAIT(clock_lo, 100, 0x48+i);
- }
-
- WAIT(clock_hi, 100, 0x34);
- if (parity) { data_hi(); } else { data_lo(); }
- WAIT(clock_lo, 100, 0x35);
-
- WAIT(clock_hi, 100, 0x34);
- data_hi();
-
- WAIT(data_lo, 100, 0x36);
- inhibit();
- _delay_us(200);
- return 0;
- ERROR:
- inhibit();
- if (ibm4704_error >= 0x30) {
- xprintf("x%02X ", ibm4704_error);
- }
- _delay_us(200);
- return -1;
- }
- uint8_t ibm4704_recv_response(void)
- {
-
- uint8_t data = 0;
- uint8_t try = 250;
- do {
- data = ibm4704_recv();
- } while (try-- && ibm4704_error);
- return data;
- }
- uint8_t ibm4704_recv(void)
- {
- uint8_t data = 0;
- bool parity = true;
- ibm4704_error = IBM4704_ERR_NONE;
- idle();
- _delay_us(5);
-
- WAIT(clock_lo, 100, 0x11);
- WAIT(data_hi, 100, 0x12);
- WAIT(clock_hi, 100, 0x13);
-
- for (uint8_t i = 0; i < 8; i++) {
- WAIT(clock_hi, 100, 0x20+i);
-
- if (data_in()) {
- parity = !parity;
- data |= (1<<i);
- }
- WAIT(clock_lo, 150, 0x28+i);
- }
-
- WAIT(clock_hi, 100, 0x17);
- if (data_in() != parity) {
- ibm4704_error = IBM4704_ERR_PARITY;
- goto ERROR;
- }
- WAIT(clock_lo, 150, 0x18);
-
- WAIT(clock_hi, 100, 0x19);
- WAIT(data_lo, 1, 0x19);
- inhibit();
- _delay_us(200);
- return data;
- ERROR:
- if (ibm4704_error > 0x12) {
- xprintf("x%02X ", ibm4704_error);
- }
- inhibit();
- _delay_us(200);
- return -1;
- }
|