123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478 |
- #include <stdbool.h>
- #include <util/delay.h>
- #include <avr/io.h>
- #include <avr/interrupt.h>
- #include "adb.h"
- #define data_lo() (ADB_DDR |= (1<<ADB_DATA_BIT))
- #define data_hi() (ADB_DDR &= ~(1<<ADB_DATA_BIT))
- #define data_in() (ADB_PIN & (1<<ADB_DATA_BIT))
- #ifdef ADB_PSW_BIT
- static inline void psw_lo(void);
- static inline void psw_hi(void);
- static inline bool psw_in(void);
- #endif
- static inline void attention(void);
- static inline void place_bit0(void);
- static inline void place_bit1(void);
- static inline void send_byte(uint8_t data);
- static inline uint16_t wait_data_lo(uint16_t us);
- static inline uint16_t wait_data_hi(uint16_t us);
- static inline uint16_t adb_host_dev_recv(uint8_t device);
- void adb_host_init(void)
- {
- ADB_PORT &= ~(1<<ADB_DATA_BIT);
- data_hi();
- #ifdef ADB_PSW_BIT
- psw_hi();
- #endif
- }
- #ifdef ADB_PSW_BIT
- bool adb_host_psw(void)
- {
- return psw_in();
- }
- #endif
- enum {
- ADDR_KEYB = 0x20,
- ADDR_MOUSE = 0x30
- };
- uint16_t adb_host_kbd_recv(void)
- {
- return adb_host_dev_recv(ADDR_KEYB);
- }
- #ifdef ADB_MOUSE_ENABLE
- void adb_mouse_init(void) {
- return;
- }
- uint16_t adb_host_mouse_recv(void)
- {
- return adb_host_dev_recv(ADDR_MOUSE);
- }
- #endif
- static inline uint16_t adb_host_dev_recv(uint8_t device)
- {
- uint16_t data = 0;
- cli();
- attention();
- send_byte(device|0x0C);
- place_bit0();
- if (!wait_data_hi(500)) {
- sei();
- return -30;
- }
- if (!wait_data_lo(500)) {
- sei();
- return 0;
- }
-
- uint8_t n = 17;
- do {
- uint8_t lo = (uint8_t) wait_data_hi(130);
- if (!lo)
- goto error;
-
- uint8_t hi = (uint8_t) wait_data_lo(lo);
- if (!hi)
- goto error;
-
- hi = lo - hi;
- lo = 130 - lo;
-
- data <<= 1;
- if (lo < hi) {
- data |= 1;
- }
- else if (n == 17) {
- sei();
- return -20;
- }
- }
- while ( --n );
-
-
- if (!wait_data_hi(351) || wait_data_lo(91)) {
- sei();
- return -21;
- }
- sei();
- return data;
- error:
- sei();
- return -n;
- }
- void adb_host_listen(uint8_t cmd, uint8_t data_h, uint8_t data_l)
- {
- cli();
- attention();
- send_byte(cmd);
- place_bit0();
- _delay_us(200);
- place_bit1();
- send_byte(data_h);
- send_byte(data_l);
- place_bit0();
- sei();
- }
- void adb_host_kbd_led(uint8_t led)
- {
-
-
-
- adb_host_listen(0x2A,0,led&0x07);
- }
- #ifdef ADB_PSW_BIT
- static inline void psw_lo()
- {
- ADB_DDR |= (1<<ADB_PSW_BIT);
- ADB_PORT &= ~(1<<ADB_PSW_BIT);
- }
- static inline void psw_hi()
- {
- ADB_PORT |= (1<<ADB_PSW_BIT);
- ADB_DDR &= ~(1<<ADB_PSW_BIT);
- }
- static inline bool psw_in()
- {
- ADB_PORT |= (1<<ADB_PSW_BIT);
- ADB_DDR &= ~(1<<ADB_PSW_BIT);
- return ADB_PIN&(1<<ADB_PSW_BIT);
- }
- #endif
- static inline void attention(void)
- {
- data_lo();
- _delay_us(800-35);
- place_bit1();
- }
- static inline void place_bit0(void)
- {
- data_lo();
- _delay_us(65);
- data_hi();
- _delay_us(35);
- }
- static inline void place_bit1(void)
- {
- data_lo();
- _delay_us(35);
- data_hi();
- _delay_us(65);
- }
- static inline void send_byte(uint8_t data)
- {
- for (int i = 0; i < 8; i++) {
- if (data&(0x80>>i))
- place_bit1();
- else
- place_bit0();
- }
- }
- static inline uint16_t wait_data_lo(uint16_t us)
- {
- do {
- if ( !data_in() )
- break;
- _delay_us(1 - (6 * 1000000.0 / F_CPU));
- }
- while ( --us );
- return us;
- }
- static inline uint16_t wait_data_hi(uint16_t us)
- {
- do {
- if ( data_in() )
- break;
- _delay_us(1 - (6 * 1000000.0 / F_CPU));
- }
- while ( --us );
- return us;
- }
|