blob: 1ccb156b5fa9e4a28423348c31a9d45c6d4e9b73 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
|
#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>
#include <stdbool.h>
#include <stdint.h>
static volatile uint8_t kbd_state = 0;
static volatile uint8_t kbd_input = 0;
static volatile uint8_t kbd_flags = 0;
#define KBD_FLAG_ERROR (_BV(0))
#define KBD_FLAG_BREAK (_BV(1))
#define KBD_FLAG_EXT (_BV(2))
#define KBD_CODE_UP 0xe075
#define KBD_CODE_LEFT 0xe06b
#define KBD_CODE_DOWN 0xe072
#define KBD_CODE_RIGHT 0xe074
static inline bool kbd_data() {
return (PINC & (1 << 0));
}
static inline bool kbd_clock() {
return (PINC & (1 << 1));
}
ISR(PCINT1_vect) {
if (kbd_clock())
return;
bool data = kbd_data();
if (kbd_state == 0) {
if (!data) { /* start bit */
kbd_input = 0;
kbd_state++;
}
return;
}
if (kbd_state <= 8) {
kbd_input |= (data << (kbd_state-1));
kbd_state++;
return;
}
if (kbd_state == 9) {
if ((__builtin_popcount(kbd_input) & 1) == data)
kbd_flags |= KBD_FLAG_ERROR;
kbd_state++;
return;
}
kbd_state = 0;
if (kbd_flags & KBD_FLAG_ERROR) {
/* Retry */
return;
}
if (kbd_input == 0xe0) {
kbd_flags |= KBD_FLAG_EXT;
return;
}
if (kbd_input == 0xf0) {
kbd_flags |= KBD_FLAG_BREAK;
return;
}
uint16_t code = kbd_input;
if (kbd_flags & KBD_FLAG_EXT)
code |= 0xe000;
if (!(kbd_flags & KBD_FLAG_BREAK)) {
switch (code) {
case KBD_CODE_UP:
PORTB = 0x20;
break;
case KBD_CODE_DOWN:
PORTB = 0;
break;
}
}
kbd_flags = 0;
}
int main(void) {
DDRB = 0xff;
PORTB = 0;
DDRC = 0x00;
PORTC = 0x03;
PCMSK1 = (1 << PCINT9);
PCICR = (1 << PCIE1);
sei();
while(true) {
}
return 0;
}
|