2 * Intel PXA27X Keypad Controller emulation.
4 * Copyright (c) 2007 MontaVista Software, Inc
5 * Written by Armin Kuster <akuster@kama-aina.net>
6 * or <Akuster@mvista.com>
8 * This code is licensed under the GPLv2.
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
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 */
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)
67 #define KPREC_OF1 (0x1 << 31)
68 #define KPREC_UF1 (0x1 << 30)
69 #define KPREC_OF0 (0x1 << 15)
70 #define KPREC_UF0 (0x1 << 14)
72 #define KPMK_MKP (0x1 << 31)
73 #define KPAS_SO (0x1 << 31)
74 #define KPASMKPx_SO (0x1 << 31)
77 #define KPASMKPx_MKC(row, col) (1 << (row + 16 * (col % 2)))
79 #define PXAKBD_MAXROW 8
80 #define PXAKBD_MAXCOL 8
82 struct PXA2xxKeyPadState
{
96 static void pxa27x_keypad_find_pressed_key(PXA2xxKeyPadState
*kp
, int *row
, int *col
)
99 for (i
= 0; i
< 4; i
++)
102 for (*row
= 0; *row
< 8; (*row
)++) {
103 if (kp
->kpasmkp
[i
] & (1 << *row
))
107 for (*row
= 0; *row
< 8; (*row
)++) {
108 if (kp
->kpasmkp
[i
] & (1 << (*row
+ 16)))
114 static void pxa27x_keyboard_event (PXA2xxKeyPadState
*kp
, int keycode
)
116 int row
, col
, rel
, assert_irq
= 0;
119 if(!(kp
->kpc
& KPC_ME
)) /* skip if not enabled */
122 if(kp
->kpc
& KPC_AS
|| kp
->kpc
& KPC_ASACT
) {
124 kp
->kpc
&= ~(KPC_AS
);
126 rel
= (keycode
& 0x80) ? 1 : 0; /* key release from qemu */
127 keycode
&= ~(0x80); /* strip qemu key release bit */
129 row
= kp
->map
[keycode
].row
;
130 col
= kp
->map
[keycode
].column
;
131 if(row
== -1 || col
== -1)
134 val
= KPASMKPx_MKC(row
, col
);
136 if (kp
->kpasmkp
[col
/ 2] & val
) {
137 kp
->kpasmkp
[col
/ 2] &= ~val
;
142 if (!(kp
->kpasmkp
[col
/ 2] & val
)) {
143 kp
->kpasmkp
[col
/ 2] |= val
;
148 kp
->kpas
= ((kp
->pressed_cnt
& 0x1f) << 26) | (0xf << 4) | 0xf;
149 if (kp
->pressed_cnt
== 1) {
150 kp
->kpas
&= ~((0xf << 4) | 0xf);
152 pxa27x_keypad_find_pressed_key(kp
, &row
, &col
);
153 kp
->kpas
|= ((row
& 0xf) << 4) | (col
& 0xf);
160 if (assert_irq
&& (kp
->kpc
& KPC_MIE
)) {
162 qemu_irq_raise(kp
->irq
);
167 static uint32_t pxa2xx_keypad_read(void *opaque
, target_phys_addr_t offset
)
169 PXA2xxKeyPadState
*s
= (PXA2xxKeyPadState
*) opaque
;
179 qemu_irq_lower(s
->irq
);
188 s
->kprec
&= ~(KPREC_OF1
);
190 s
->kprec
&= ~(KPREC_UF1
);
192 s
->kprec
&= ~(KPREC_OF0
);
194 s
->kprec
&= ~(KPREC_UF0
);
200 s
->kpmk
&= ~(KPMK_MKP
);
207 return s
->kpasmkp
[0];
210 return s
->kpasmkp
[1];
213 return s
->kpasmkp
[2];
216 return s
->kpasmkp
[3];
222 hw_error("%s: Bad offset " REG_FMT
"\n", __FUNCTION__
, offset
);
228 static void pxa2xx_keypad_write(void *opaque
,
229 target_phys_addr_t offset
, uint32_t value
)
231 PXA2xxKeyPadState
*s
= (PXA2xxKeyPadState
*) opaque
;
250 s
->kpasmkp
[0] = value
;
253 s
->kpasmkp
[1] = value
;
256 s
->kpasmkp
[2] = value
;
259 s
->kpasmkp
[3] = value
;
266 hw_error("%s: Bad offset " REG_FMT
"\n", __FUNCTION__
, offset
);
270 static CPUReadMemoryFunc
* const pxa2xx_keypad_readfn
[] = {
276 static CPUWriteMemoryFunc
* const pxa2xx_keypad_writefn
[] = {
282 static void pxa2xx_keypad_save(QEMUFile
*f
, void *opaque
)
284 PXA2xxKeyPadState
*s
= (PXA2xxKeyPadState
*) opaque
;
286 qemu_put_be32s(f
, &s
->kpc
);
287 qemu_put_be32s(f
, &s
->kpdk
);
288 qemu_put_be32s(f
, &s
->kprec
);
289 qemu_put_be32s(f
, &s
->kpmk
);
290 qemu_put_be32s(f
, &s
->kpas
);
291 qemu_put_be32s(f
, &s
->kpasmkp
[0]);
292 qemu_put_be32s(f
, &s
->kpasmkp
[1]);
293 qemu_put_be32s(f
, &s
->kpasmkp
[2]);
294 qemu_put_be32s(f
, &s
->kpasmkp
[3]);
295 qemu_put_be32s(f
, &s
->kpkdi
);
299 static int pxa2xx_keypad_load(QEMUFile
*f
, void *opaque
, int version_id
)
301 PXA2xxKeyPadState
*s
= (PXA2xxKeyPadState
*) opaque
;
303 qemu_get_be32s(f
, &s
->kpc
);
304 qemu_get_be32s(f
, &s
->kpdk
);
305 qemu_get_be32s(f
, &s
->kprec
);
306 qemu_get_be32s(f
, &s
->kpmk
);
307 qemu_get_be32s(f
, &s
->kpas
);
308 qemu_get_be32s(f
, &s
->kpasmkp
[0]);
309 qemu_get_be32s(f
, &s
->kpasmkp
[1]);
310 qemu_get_be32s(f
, &s
->kpasmkp
[2]);
311 qemu_get_be32s(f
, &s
->kpasmkp
[3]);
312 qemu_get_be32s(f
, &s
->kpkdi
);
317 PXA2xxKeyPadState
*pxa27x_keypad_init(target_phys_addr_t base
,
321 PXA2xxKeyPadState
*s
;
323 s
= (PXA2xxKeyPadState
*) qemu_mallocz(sizeof(PXA2xxKeyPadState
));
326 iomemtype
= cpu_register_io_memory(pxa2xx_keypad_readfn
,
327 pxa2xx_keypad_writefn
, s
, DEVICE_NATIVE_ENDIAN
);
328 cpu_register_physical_memory(base
, 0x00100000, iomemtype
);
330 register_savevm(NULL
, "pxa2xx_keypad", 0, 0,
331 pxa2xx_keypad_save
, pxa2xx_keypad_load
, s
);
336 void pxa27x_register_keypad(PXA2xxKeyPadState
*kp
, struct keymap
*map
,
339 if(!map
|| size
< 0x80) {
340 fprintf(stderr
, "%s - No PXA keypad map defined\n", __FUNCTION__
);
345 qemu_add_kbd_event_handler((QEMUPutKBDEvent
*) pxa27x_keyboard_event
, kp
);