123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212 |
- #include <stdint.h>
- #include <stdbool.h>
- #include <util/atomic.h>
- #include <util/delay.h>
- #include "next_kbd.h"
- #include "debug.h"
- static inline void out_lo(void);
- static inline void out_hi(void);
- static inline void query(void);
- static inline void reset(void);
- static inline uint32_t response(void);
- #define out_hi_delay(intervals) do { out_hi(); _delay_us((NEXT_KBD_TIMING+1) * intervals); } while (0);
- #define out_lo_delay(intervals) do { out_lo(); _delay_us((NEXT_KBD_TIMING+1) * intervals); } while (0);
- #define query_delay(intervals) do { query(); _delay_us((NEXT_KBD_TIMING+1) * intervals); } while (0);
- #define reset_delay(intervals) do { reset(); _delay_us((NEXT_KBD_TIMING+1) * intervals); } while (0);
- void next_kbd_init(void)
- {
- out_hi();
- NEXT_KBD_IN_DDR &= ~(1<<NEXT_KBD_IN_BIT);
- NEXT_KBD_IN_PORT |= (1<<NEXT_KBD_IN_BIT);
-
- query_delay(5);
- reset_delay(8);
-
- query_delay(5);
- reset_delay(8);
- }
- void next_kbd_set_leds(bool left, bool right)
- {
- cli();
- out_lo_delay(9);
-
- out_hi_delay(3);
- out_lo_delay(1);
-
- if (left) {
- out_hi_delay(1);
- } else {
- out_lo_delay(1);
- }
-
- if (right) {
- out_hi_delay(1);
- } else {
- out_lo_delay(1);
- }
-
- out_lo_delay(7);
- out_hi();
- sei();
- }
- #define NEXT_KBD_READ (NEXT_KBD_IN_PIN&(1<<NEXT_KBD_IN_BIT))
- uint32_t next_kbd_recv(void)
- {
-
-
-
-
- if (!NEXT_KBD_READ) {
- sei();
- return 0;
- }
- query();
- uint32_t resp = response();
-
- return resp;
- }
- static inline uint32_t response(void)
- {
- cli();
-
-
-
-
- uint8_t i = 0;
- uint32_t data = 0;
- uint16_t reset_timeout = 50000;
- while (NEXT_KBD_READ && reset_timeout) {
- asm(""); _delay_us(1); reset_timeout--;
- }
- if (!reset_timeout) {
- reset();
- sei();
- return 0;
- }
- _delay_us(NEXT_KBD_TIMING / 2);
- for (; i < 22; i++)
- {
- if (NEXT_KBD_READ)
- {
- data |= ((uint32_t) 1 << i);
-
- if (i == 10)
- {
- i++;
- while (NEXT_KBD_READ) ;
- _delay_us(NEXT_KBD_TIMING / 2);
- }
- } else {
-
- data |= ((uint32_t) 0 << i);
- }
- _delay_us(NEXT_KBD_TIMING);
- }
-
- sei();
-
- return data;
- }
- static inline void out_lo(void)
- {
- NEXT_KBD_OUT_PORT &= ~(1<<NEXT_KBD_OUT_BIT);
- NEXT_KBD_OUT_DDR |= (1<<NEXT_KBD_OUT_BIT);
- }
- static inline void out_hi(void)
- {
-
- NEXT_KBD_OUT_DDR &= ~(1<<NEXT_KBD_OUT_BIT);
- NEXT_KBD_OUT_PORT |= (1<<NEXT_KBD_OUT_BIT);
- }
- static inline void query(void)
- {
- out_lo_delay(5);
- out_hi_delay(1);
- out_lo_delay(3);
- out_hi();
- }
- static inline void reset(void)
- {
- out_lo_delay(1);
- out_hi_delay(4);
- out_lo_delay(1);
- out_hi_delay(6);
- out_lo_delay(10);
- out_hi();
- }
|