root / hw / pxa2xx_keypad.c @ 4487fd34
History | View | Annotate | Download (9.6 kB)
1 |
/*
|
---|---|
2 |
* Intel PXA27X Keypad Controller emulation.
|
3 |
*
|
4 |
* Copyright (c) 2007 MontaVista Software, Inc
|
5 |
* Written by Armin Kuster <akuster@kama-aina.net>
|
6 |
* or <Akuster@mvista.com>
|
7 |
*
|
8 |
* This code is licensed under the GPLv2.
|
9 |
*/
|
10 |
|
11 |
#include "hw.h" |
12 |
#include "pxa.h" |
13 |
#include "console.h" |
14 |
|
15 |
/*
|
16 |
* Keypad
|
17 |
*/
|
18 |
#define KPC 0x00 /* Keypad Interface Control register */ |
19 |
#define KPDK 0x08 /* Keypad Interface Direct Key register */ |
20 |
#define KPREC 0x10 /* Keypad Interface Rotary Encoder register */ |
21 |
#define KPMK 0x18 /* Keypad Interface Matrix Key register */ |
22 |
#define KPAS 0x20 /* Keypad Interface Automatic Scan register */ |
23 |
#define KPASMKP0 0x28 /* Keypad Interface Automatic Scan Multiple |
24 |
Key Presser register 0 */
|
25 |
#define KPASMKP1 0x30 /* Keypad Interface Automatic Scan Multiple |
26 |
Key Presser register 1 */
|
27 |
#define KPASMKP2 0x38 /* Keypad Interface Automatic Scan Multiple |
28 |
Key Presser register 2 */
|
29 |
#define KPASMKP3 0x40 /* Keypad Interface Automatic Scan Multiple |
30 |
Key Presser register 3 */
|
31 |
#define KPKDI 0x48 /* Keypad Interface Key Debounce Interval |
32 |
register */
|
33 |
|
34 |
/* Keypad defines */
|
35 |
#define KPC_AS (0x1 << 30) /* Automatic Scan bit */ |
36 |
#define KPC_ASACT (0x1 << 29) /* Automatic Scan on Activity */ |
37 |
#define KPC_MI (0x1 << 22) /* Matrix interrupt bit */ |
38 |
#define KPC_IMKP (0x1 << 21) /* Ignore Multiple Key Press */ |
39 |
#define KPC_MS7 (0x1 << 20) /* Matrix scan line 7 */ |
40 |
#define KPC_MS6 (0x1 << 19) /* Matrix scan line 6 */ |
41 |
#define KPC_MS5 (0x1 << 18) /* Matrix scan line 5 */ |
42 |
#define KPC_MS4 (0x1 << 17) /* Matrix scan line 4 */ |
43 |
#define KPC_MS3 (0x1 << 16) /* Matrix scan line 3 */ |
44 |
#define KPC_MS2 (0x1 << 15) /* Matrix scan line 2 */ |
45 |
#define KPC_MS1 (0x1 << 14) /* Matrix scan line 1 */ |
46 |
#define KPC_MS0 (0x1 << 13) /* Matrix scan line 0 */ |
47 |
#define KPC_ME (0x1 << 12) /* Matrix Keypad Enable */ |
48 |
#define KPC_MIE (0x1 << 11) /* Matrix Interrupt Enable */ |
49 |
#define KPC_DK_DEB_SEL (0x1 << 9) /* Direct Keypad Debounce Select */ |
50 |
#define KPC_DI (0x1 << 5) /* Direct key interrupt bit */ |
51 |
#define KPC_RE_ZERO_DEB (0x1 << 4) /* Rotary Encoder Zero Debounce */ |
52 |
#define KPC_REE1 (0x1 << 3) /* Rotary Encoder1 Enable */ |
53 |
#define KPC_REE0 (0x1 << 2) /* Rotary Encoder0 Enable */ |
54 |
#define KPC_DE (0x1 << 1) /* Direct Keypad Enable */ |
55 |
#define KPC_DIE (0x1 << 0) /* Direct Keypad interrupt Enable */ |
56 |
|
57 |
#define KPDK_DKP (0x1 << 31) |
58 |
#define KPDK_DK7 (0x1 << 7) |
59 |
#define KPDK_DK6 (0x1 << 6) |
60 |
#define KPDK_DK5 (0x1 << 5) |
61 |
#define KPDK_DK4 (0x1 << 4) |
62 |
#define KPDK_DK3 (0x1 << 3) |
63 |
#define KPDK_DK2 (0x1 << 2) |
64 |
#define KPDK_DK1 (0x1 << 1) |
65 |
#define KPDK_DK0 (0x1 << 0) |
66 |
|
67 |
#define KPREC_OF1 (0x1 << 31) |
68 |
#define KPREC_UF1 (0x1 << 30) |
69 |
#define KPREC_OF0 (0x1 << 15) |
70 |
#define KPREC_UF0 (0x1 << 14) |
71 |
|
72 |
#define KPMK_MKP (0x1 << 31) |
73 |
#define KPAS_SO (0x1 << 31) |
74 |
#define KPASMKPx_SO (0x1 << 31) |
75 |
|
76 |
|
77 |
#define KPASMKPx_MKC(row, col) (1 << (row + 16 * (col % 2))) |
78 |
|
79 |
#define PXAKBD_MAXROW 8 |
80 |
#define PXAKBD_MAXCOL 8 |
81 |
|
82 |
struct pxa2xx_keypad_s{
|
83 |
target_phys_addr_t base; |
84 |
qemu_irq irq; |
85 |
struct keymap *map;
|
86 |
|
87 |
uint32_t kpc; |
88 |
uint32_t kpdk; |
89 |
uint32_t kprec; |
90 |
uint32_t kpmk; |
91 |
uint32_t kpas; |
92 |
uint32_t kpasmkp0; |
93 |
uint32_t kpasmkp1; |
94 |
uint32_t kpasmkp2; |
95 |
uint32_t kpasmkp3; |
96 |
uint32_t kpkdi; |
97 |
}; |
98 |
|
99 |
static void pxa27x_keyboard_event (struct pxa2xx_keypad_s *kp, int keycode) |
100 |
{ |
101 |
int row, col,rel;
|
102 |
|
103 |
if(!(kp->kpc & KPC_ME)) /* skip if not enabled */ |
104 |
return;
|
105 |
|
106 |
if(kp->kpc & KPC_AS || kp->kpc & KPC_ASACT) {
|
107 |
if(kp->kpc & KPC_AS)
|
108 |
kp->kpc &= ~(KPC_AS); |
109 |
|
110 |
rel = (keycode & 0x80) ? 1 : 0; /* key release from qemu */ |
111 |
keycode &= ~(0x80); /* strip qemu key release bit */ |
112 |
row = kp->map[keycode].row; |
113 |
col = kp->map[keycode].column; |
114 |
if(row == -1 || col == -1) |
115 |
return;
|
116 |
switch (col) {
|
117 |
case 0: |
118 |
case 1: |
119 |
if(rel)
|
120 |
kp->kpasmkp0 = ~(0xffffffff);
|
121 |
else
|
122 |
kp->kpasmkp0 |= KPASMKPx_MKC(row,col); |
123 |
break;
|
124 |
case 2: |
125 |
case 3: |
126 |
if(rel)
|
127 |
kp->kpasmkp1 = ~(0xffffffff);
|
128 |
else
|
129 |
kp->kpasmkp1 |= KPASMKPx_MKC(row,col); |
130 |
break;
|
131 |
case 4: |
132 |
case 5: |
133 |
if(rel)
|
134 |
kp->kpasmkp2 = ~(0xffffffff);
|
135 |
else
|
136 |
kp->kpasmkp2 |= KPASMKPx_MKC(row,col); |
137 |
break;
|
138 |
case 6: |
139 |
case 7: |
140 |
if(rel)
|
141 |
kp->kpasmkp3 = ~(0xffffffff);
|
142 |
else
|
143 |
kp->kpasmkp3 |= KPASMKPx_MKC(row,col); |
144 |
break;
|
145 |
} /* switch */
|
146 |
goto out;
|
147 |
} |
148 |
return;
|
149 |
|
150 |
out:
|
151 |
if(kp->kpc & KPC_MIE) {
|
152 |
kp->kpc |= KPC_MI; |
153 |
qemu_irq_raise(kp->irq); |
154 |
} |
155 |
return;
|
156 |
} |
157 |
|
158 |
static uint32_t pxa2xx_keypad_read(void *opaque, target_phys_addr_t offset) |
159 |
{ |
160 |
struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; |
161 |
uint32_t tmp; |
162 |
offset -= s->base; |
163 |
|
164 |
switch (offset) {
|
165 |
case KPC:
|
166 |
tmp = s->kpc; |
167 |
if(tmp & KPC_MI)
|
168 |
s->kpc &= ~(KPC_MI); |
169 |
if(tmp & KPC_DI)
|
170 |
s->kpc &= ~(KPC_DI); |
171 |
qemu_irq_lower(s->irq); |
172 |
return tmp;
|
173 |
break;
|
174 |
case KPDK:
|
175 |
return s->kpdk;
|
176 |
break;
|
177 |
case KPREC:
|
178 |
tmp = s->kprec; |
179 |
if(tmp & KPREC_OF1)
|
180 |
s->kprec &= ~(KPREC_OF1); |
181 |
if(tmp & KPREC_UF1)
|
182 |
s->kprec &= ~(KPREC_UF1); |
183 |
if(tmp & KPREC_OF0)
|
184 |
s->kprec &= ~(KPREC_OF0); |
185 |
if(tmp & KPREC_UF0)
|
186 |
s->kprec &= ~(KPREC_UF0); |
187 |
return tmp;
|
188 |
break;
|
189 |
case KPMK:
|
190 |
tmp = s->kpmk; |
191 |
if(tmp & KPMK_MKP)
|
192 |
s->kpmk &= ~(KPMK_MKP); |
193 |
return tmp;
|
194 |
break;
|
195 |
case KPAS:
|
196 |
return s->kpas;
|
197 |
break;
|
198 |
case KPASMKP0:
|
199 |
return s->kpasmkp0;
|
200 |
break;
|
201 |
case KPASMKP1:
|
202 |
return s->kpasmkp1;
|
203 |
break;
|
204 |
case KPASMKP2:
|
205 |
return s->kpasmkp2;
|
206 |
break;
|
207 |
case KPASMKP3:
|
208 |
return s->kpasmkp3;
|
209 |
break;
|
210 |
case KPKDI:
|
211 |
return s->kpkdi;
|
212 |
break;
|
213 |
default:
|
214 |
cpu_abort(cpu_single_env, "%s: Bad offset " REG_FMT "\n", |
215 |
__FUNCTION__, offset); |
216 |
} |
217 |
|
218 |
return 0; |
219 |
} |
220 |
|
221 |
static void pxa2xx_keypad_write(void *opaque, |
222 |
target_phys_addr_t offset, uint32_t value) |
223 |
{ |
224 |
struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; |
225 |
offset -= s->base; |
226 |
|
227 |
switch (offset) {
|
228 |
case KPC:
|
229 |
s->kpc = value; |
230 |
break;
|
231 |
case KPDK:
|
232 |
s->kpdk = value; |
233 |
break;
|
234 |
case KPREC:
|
235 |
s->kprec = value; |
236 |
break;
|
237 |
case KPMK:
|
238 |
s->kpmk = value; |
239 |
break;
|
240 |
case KPAS:
|
241 |
s->kpas = value; |
242 |
break;
|
243 |
case KPASMKP0:
|
244 |
s->kpasmkp0 = value; |
245 |
break;
|
246 |
case KPASMKP1:
|
247 |
s->kpasmkp1 = value; |
248 |
break;
|
249 |
case KPASMKP2:
|
250 |
s->kpasmkp2 = value; |
251 |
break;
|
252 |
case KPASMKP3:
|
253 |
s->kpasmkp3 = value; |
254 |
break;
|
255 |
case KPKDI:
|
256 |
s->kpkdi = value; |
257 |
break;
|
258 |
|
259 |
default:
|
260 |
cpu_abort(cpu_single_env, "%s: Bad offset " REG_FMT "\n", |
261 |
__FUNCTION__, offset); |
262 |
} |
263 |
} |
264 |
|
265 |
static CPUReadMemoryFunc *pxa2xx_keypad_readfn[] = {
|
266 |
pxa2xx_keypad_read, |
267 |
pxa2xx_keypad_read, |
268 |
pxa2xx_keypad_read |
269 |
}; |
270 |
|
271 |
static CPUWriteMemoryFunc *pxa2xx_keypad_writefn[] = {
|
272 |
pxa2xx_keypad_write, |
273 |
pxa2xx_keypad_write, |
274 |
pxa2xx_keypad_write |
275 |
}; |
276 |
|
277 |
static void pxa2xx_keypad_save(QEMUFile *f, void *opaque) |
278 |
{ |
279 |
struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; |
280 |
|
281 |
qemu_put_be32s(f, &s->kpc); |
282 |
qemu_put_be32s(f, &s->kpdk); |
283 |
qemu_put_be32s(f, &s->kprec); |
284 |
qemu_put_be32s(f, &s->kpmk); |
285 |
qemu_put_be32s(f, &s->kpas); |
286 |
qemu_put_be32s(f, &s->kpasmkp0); |
287 |
qemu_put_be32s(f, &s->kpasmkp1); |
288 |
qemu_put_be32s(f, &s->kpasmkp2); |
289 |
qemu_put_be32s(f, &s->kpasmkp3); |
290 |
qemu_put_be32s(f, &s->kpkdi); |
291 |
|
292 |
} |
293 |
|
294 |
static int pxa2xx_keypad_load(QEMUFile *f, void *opaque, int version_id) |
295 |
{ |
296 |
struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; |
297 |
|
298 |
qemu_get_be32s(f, &s->kpc); |
299 |
qemu_get_be32s(f, &s->kpdk); |
300 |
qemu_get_be32s(f, &s->kprec); |
301 |
qemu_get_be32s(f, &s->kpmk); |
302 |
qemu_get_be32s(f, &s->kpas); |
303 |
qemu_get_be32s(f, &s->kpasmkp0); |
304 |
qemu_get_be32s(f, &s->kpasmkp1); |
305 |
qemu_get_be32s(f, &s->kpasmkp2); |
306 |
qemu_get_be32s(f, &s->kpasmkp3); |
307 |
qemu_get_be32s(f, &s->kpkdi); |
308 |
|
309 |
return 0; |
310 |
} |
311 |
|
312 |
struct pxa2xx_keypad_s *pxa27x_keypad_init(target_phys_addr_t base,
|
313 |
qemu_irq irq) |
314 |
{ |
315 |
int iomemtype;
|
316 |
struct pxa2xx_keypad_s *s;
|
317 |
|
318 |
s = (struct pxa2xx_keypad_s *) qemu_mallocz(sizeof(struct pxa2xx_keypad_s)); |
319 |
s->base = base; |
320 |
s->irq = irq; |
321 |
|
322 |
iomemtype = cpu_register_io_memory(0, pxa2xx_keypad_readfn,
|
323 |
pxa2xx_keypad_writefn, s); |
324 |
cpu_register_physical_memory(base, 0x00100000, iomemtype);
|
325 |
|
326 |
register_savevm("pxa2xx_keypad", 0, 0, |
327 |
pxa2xx_keypad_save, pxa2xx_keypad_load, s); |
328 |
|
329 |
return s;
|
330 |
} |
331 |
|
332 |
void pxa27x_register_keypad(struct pxa2xx_keypad_s *kp, struct keymap *map, |
333 |
int size)
|
334 |
{ |
335 |
if(!map || size < 0x80) { |
336 |
fprintf(stderr, "%s - No PXA keypad map defined\n", __FUNCTION__);
|
337 |
exit(-1);
|
338 |
} |
339 |
|
340 |
kp->map = map; |
341 |
qemu_add_kbd_event_handler((QEMUPutKBDEvent *) pxa27x_keyboard_event, kp); |
342 |
} |