123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406 |
- #include <stdbool.h>
- #include <util/delay.h>
- #include <avr/io.h>
- #include "adb.h"
- static inline void data_lo(void);
- static inline void data_hi(void);
- static inline bool data_in(void);
- #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 bool read_bit(void);
- static inline uint8_t read_byte(void);
- static inline uint8_t wait_data_lo(uint8_t us);
- static inline uint8_t wait_data_hi(uint8_t us);
- void adb_host_init(void)
- {
- data_hi();
- #ifdef ADB_PSW_BIT
- psw_hi();
- #endif
- }
- #ifdef ADB_PSW_BIT
- bool adb_host_psw(void)
- {
- return psw_in();
- }
- #endif
- uint16_t adb_host_kbd_recv(void)
- {
- uint16_t data = 0;
- attention();
- send_byte(0x2C);
- place_bit0();
- if (!wait_data_lo(0xFF))
- return 0;
- if (!read_bit())
- return -2;
- data = read_byte();
- data = (data<<8) | read_byte();
- if (read_bit())
- return -3;
- return data;
- }
- void adb_host_kbd_led(uint8_t led)
- {
- attention();
- send_byte(0x2A);
- place_bit0();
- _delay_us(200);
- place_bit1();
- send_byte(0);
- send_byte(led&0x07);
- place_bit0();
- }
- static inline void data_lo()
- {
- ADB_DDR |= (1<<ADB_DATA_BIT);
- ADB_PORT &= ~(1<<ADB_DATA_BIT);
- }
- static inline void data_hi()
- {
- ADB_PORT |= (1<<ADB_DATA_BIT);
- ADB_DDR &= ~(1<<ADB_DATA_BIT);
- }
- static inline bool data_in()
- {
- ADB_PORT |= (1<<ADB_DATA_BIT);
- ADB_DDR &= ~(1<<ADB_DATA_BIT);
- return ADB_PIN&(1<<ADB_DATA_BIT);
- }
- #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(700);
- 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 bool read_bit(void)
- {
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- bool bit;
- wait_data_lo(75);
- _delay_us(55);
- bit = data_in();
- wait_data_hi(36);
- return bit;
- }
- static inline uint8_t read_byte(void)
- {
- uint8_t data = 0;
- for (int i = 0; i < 8; i++) {
- data <<= 1;
- if (read_bit())
- data = data | 1;
- }
- return data;
- }
- static inline uint8_t wait_data_lo(uint8_t us)
- {
- while (data_in() && us) {
- _delay_us(1);
- us--;
- }
- return us;
- }
- static inline uint8_t wait_data_hi(uint8_t us)
- {
- while (!data_in() && us) {
- _delay_us(1);
- us--;
- }
- return us;
- }
|