mirror of
https://github.com/xemu-project/xemu.git
synced 2024-11-25 04:30:02 +00:00
7267c0947d
qemu_malloc/qemu_free no longer exist after this commit. Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
338 lines
9.5 KiB
C
338 lines
9.5 KiB
C
/*
|
|
* Intel PXA27X Keypad Controller emulation.
|
|
*
|
|
* Copyright (c) 2007 MontaVista Software, Inc
|
|
* Written by Armin Kuster <akuster@kama-aina.net>
|
|
* or <Akuster@mvista.com>
|
|
*
|
|
* This code is licensed under the GPLv2.
|
|
*/
|
|
|
|
#include "hw.h"
|
|
#include "pxa.h"
|
|
#include "console.h"
|
|
|
|
/*
|
|
* Keypad
|
|
*/
|
|
#define KPC 0x00 /* Keypad Interface Control register */
|
|
#define KPDK 0x08 /* Keypad Interface Direct Key register */
|
|
#define KPREC 0x10 /* Keypad Interface Rotary Encoder register */
|
|
#define KPMK 0x18 /* Keypad Interface Matrix Key register */
|
|
#define KPAS 0x20 /* Keypad Interface Automatic Scan register */
|
|
#define KPASMKP0 0x28 /* Keypad Interface Automatic Scan Multiple
|
|
Key Presser register 0 */
|
|
#define KPASMKP1 0x30 /* Keypad Interface Automatic Scan Multiple
|
|
Key Presser register 1 */
|
|
#define KPASMKP2 0x38 /* Keypad Interface Automatic Scan Multiple
|
|
Key Presser register 2 */
|
|
#define KPASMKP3 0x40 /* Keypad Interface Automatic Scan Multiple
|
|
Key Presser register 3 */
|
|
#define KPKDI 0x48 /* Keypad Interface Key Debounce Interval
|
|
register */
|
|
|
|
/* Keypad defines */
|
|
#define KPC_AS (0x1 << 30) /* Automatic Scan bit */
|
|
#define KPC_ASACT (0x1 << 29) /* Automatic Scan on Activity */
|
|
#define KPC_MI (0x1 << 22) /* Matrix interrupt bit */
|
|
#define KPC_IMKP (0x1 << 21) /* Ignore Multiple Key Press */
|
|
#define KPC_MS7 (0x1 << 20) /* Matrix scan line 7 */
|
|
#define KPC_MS6 (0x1 << 19) /* Matrix scan line 6 */
|
|
#define KPC_MS5 (0x1 << 18) /* Matrix scan line 5 */
|
|
#define KPC_MS4 (0x1 << 17) /* Matrix scan line 4 */
|
|
#define KPC_MS3 (0x1 << 16) /* Matrix scan line 3 */
|
|
#define KPC_MS2 (0x1 << 15) /* Matrix scan line 2 */
|
|
#define KPC_MS1 (0x1 << 14) /* Matrix scan line 1 */
|
|
#define KPC_MS0 (0x1 << 13) /* Matrix scan line 0 */
|
|
#define KPC_ME (0x1 << 12) /* Matrix Keypad Enable */
|
|
#define KPC_MIE (0x1 << 11) /* Matrix Interrupt Enable */
|
|
#define KPC_DK_DEB_SEL (0x1 << 9) /* Direct Keypad Debounce Select */
|
|
#define KPC_DI (0x1 << 5) /* Direct key interrupt bit */
|
|
#define KPC_RE_ZERO_DEB (0x1 << 4) /* Rotary Encoder Zero Debounce */
|
|
#define KPC_REE1 (0x1 << 3) /* Rotary Encoder1 Enable */
|
|
#define KPC_REE0 (0x1 << 2) /* Rotary Encoder0 Enable */
|
|
#define KPC_DE (0x1 << 1) /* Direct Keypad Enable */
|
|
#define KPC_DIE (0x1 << 0) /* Direct Keypad interrupt Enable */
|
|
|
|
#define KPDK_DKP (0x1 << 31)
|
|
#define KPDK_DK7 (0x1 << 7)
|
|
#define KPDK_DK6 (0x1 << 6)
|
|
#define KPDK_DK5 (0x1 << 5)
|
|
#define KPDK_DK4 (0x1 << 4)
|
|
#define KPDK_DK3 (0x1 << 3)
|
|
#define KPDK_DK2 (0x1 << 2)
|
|
#define KPDK_DK1 (0x1 << 1)
|
|
#define KPDK_DK0 (0x1 << 0)
|
|
|
|
#define KPREC_OF1 (0x1 << 31)
|
|
#define KPREC_UF1 (0x1 << 30)
|
|
#define KPREC_OF0 (0x1 << 15)
|
|
#define KPREC_UF0 (0x1 << 14)
|
|
|
|
#define KPMK_MKP (0x1 << 31)
|
|
#define KPAS_SO (0x1 << 31)
|
|
#define KPASMKPx_SO (0x1 << 31)
|
|
|
|
|
|
#define KPASMKPx_MKC(row, col) (1 << (row + 16 * (col % 2)))
|
|
|
|
#define PXAKBD_MAXROW 8
|
|
#define PXAKBD_MAXCOL 8
|
|
|
|
struct PXA2xxKeyPadState {
|
|
qemu_irq irq;
|
|
struct keymap *map;
|
|
int pressed_cnt;
|
|
int alt_code;
|
|
|
|
uint32_t kpc;
|
|
uint32_t kpdk;
|
|
uint32_t kprec;
|
|
uint32_t kpmk;
|
|
uint32_t kpas;
|
|
uint32_t kpasmkp[4];
|
|
uint32_t kpkdi;
|
|
};
|
|
|
|
static void pxa27x_keypad_find_pressed_key(PXA2xxKeyPadState *kp, int *row, int *col)
|
|
{
|
|
int i;
|
|
for (i = 0; i < 4; i++)
|
|
{
|
|
*col = i * 2;
|
|
for (*row = 0; *row < 8; (*row)++) {
|
|
if (kp->kpasmkp[i] & (1 << *row))
|
|
return;
|
|
}
|
|
*col = i * 2 + 1;
|
|
for (*row = 0; *row < 8; (*row)++) {
|
|
if (kp->kpasmkp[i] & (1 << (*row + 16)))
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void pxa27x_keyboard_event (PXA2xxKeyPadState *kp, int keycode)
|
|
{
|
|
int row, col, rel, assert_irq = 0;
|
|
uint32_t val;
|
|
|
|
if (keycode == 0xe0) {
|
|
kp->alt_code = 1;
|
|
return;
|
|
}
|
|
|
|
if(!(kp->kpc & KPC_ME)) /* skip if not enabled */
|
|
return;
|
|
|
|
if(kp->kpc & KPC_AS || kp->kpc & KPC_ASACT) {
|
|
if(kp->kpc & KPC_AS)
|
|
kp->kpc &= ~(KPC_AS);
|
|
|
|
rel = (keycode & 0x80) ? 1 : 0; /* key release from qemu */
|
|
keycode &= ~(0x80); /* strip qemu key release bit */
|
|
if (kp->alt_code) {
|
|
keycode |= 0x80;
|
|
kp->alt_code = 0;
|
|
}
|
|
|
|
row = kp->map[keycode].row;
|
|
col = kp->map[keycode].column;
|
|
if(row == -1 || col == -1)
|
|
return;
|
|
|
|
val = KPASMKPx_MKC(row, col);
|
|
if (rel) {
|
|
if (kp->kpasmkp[col / 2] & val) {
|
|
kp->kpasmkp[col / 2] &= ~val;
|
|
kp->pressed_cnt--;
|
|
assert_irq = 1;
|
|
}
|
|
} else {
|
|
if (!(kp->kpasmkp[col / 2] & val)) {
|
|
kp->kpasmkp[col / 2] |= val;
|
|
kp->pressed_cnt++;
|
|
assert_irq = 1;
|
|
}
|
|
}
|
|
kp->kpas = ((kp->pressed_cnt & 0x1f) << 26) | (0xf << 4) | 0xf;
|
|
if (kp->pressed_cnt == 1) {
|
|
kp->kpas &= ~((0xf << 4) | 0xf);
|
|
if (rel)
|
|
pxa27x_keypad_find_pressed_key(kp, &row, &col);
|
|
kp->kpas |= ((row & 0xf) << 4) | (col & 0xf);
|
|
}
|
|
goto out;
|
|
}
|
|
return;
|
|
|
|
out:
|
|
if (assert_irq && (kp->kpc & KPC_MIE)) {
|
|
kp->kpc |= KPC_MI;
|
|
qemu_irq_raise(kp->irq);
|
|
}
|
|
return;
|
|
}
|
|
|
|
static uint32_t pxa2xx_keypad_read(void *opaque, target_phys_addr_t offset)
|
|
{
|
|
PXA2xxKeyPadState *s = (PXA2xxKeyPadState *) opaque;
|
|
uint32_t tmp;
|
|
|
|
switch (offset) {
|
|
case KPC:
|
|
tmp = s->kpc;
|
|
if(tmp & KPC_MI)
|
|
s->kpc &= ~(KPC_MI);
|
|
if(tmp & KPC_DI)
|
|
s->kpc &= ~(KPC_DI);
|
|
qemu_irq_lower(s->irq);
|
|
return tmp;
|
|
break;
|
|
case KPDK:
|
|
return s->kpdk;
|
|
break;
|
|
case KPREC:
|
|
tmp = s->kprec;
|
|
if(tmp & KPREC_OF1)
|
|
s->kprec &= ~(KPREC_OF1);
|
|
if(tmp & KPREC_UF1)
|
|
s->kprec &= ~(KPREC_UF1);
|
|
if(tmp & KPREC_OF0)
|
|
s->kprec &= ~(KPREC_OF0);
|
|
if(tmp & KPREC_UF0)
|
|
s->kprec &= ~(KPREC_UF0);
|
|
return tmp;
|
|
break;
|
|
case KPMK:
|
|
tmp = s->kpmk;
|
|
if(tmp & KPMK_MKP)
|
|
s->kpmk &= ~(KPMK_MKP);
|
|
return tmp;
|
|
break;
|
|
case KPAS:
|
|
return s->kpas;
|
|
break;
|
|
case KPASMKP0:
|
|
return s->kpasmkp[0];
|
|
break;
|
|
case KPASMKP1:
|
|
return s->kpasmkp[1];
|
|
break;
|
|
case KPASMKP2:
|
|
return s->kpasmkp[2];
|
|
break;
|
|
case KPASMKP3:
|
|
return s->kpasmkp[3];
|
|
break;
|
|
case KPKDI:
|
|
return s->kpkdi;
|
|
break;
|
|
default:
|
|
hw_error("%s: Bad offset " REG_FMT "\n", __FUNCTION__, offset);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void pxa2xx_keypad_write(void *opaque,
|
|
target_phys_addr_t offset, uint32_t value)
|
|
{
|
|
PXA2xxKeyPadState *s = (PXA2xxKeyPadState *) opaque;
|
|
|
|
switch (offset) {
|
|
case KPC:
|
|
s->kpc = value;
|
|
break;
|
|
case KPDK:
|
|
s->kpdk = value;
|
|
break;
|
|
case KPREC:
|
|
s->kprec = value;
|
|
break;
|
|
case KPMK:
|
|
s->kpmk = value;
|
|
break;
|
|
case KPAS:
|
|
s->kpas = value;
|
|
break;
|
|
case KPASMKP0:
|
|
s->kpasmkp[0] = value;
|
|
break;
|
|
case KPASMKP1:
|
|
s->kpasmkp[1] = value;
|
|
break;
|
|
case KPASMKP2:
|
|
s->kpasmkp[2] = value;
|
|
break;
|
|
case KPASMKP3:
|
|
s->kpasmkp[3] = value;
|
|
break;
|
|
case KPKDI:
|
|
s->kpkdi = value;
|
|
break;
|
|
|
|
default:
|
|
hw_error("%s: Bad offset " REG_FMT "\n", __FUNCTION__, offset);
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc * const pxa2xx_keypad_readfn[] = {
|
|
pxa2xx_keypad_read,
|
|
pxa2xx_keypad_read,
|
|
pxa2xx_keypad_read
|
|
};
|
|
|
|
static CPUWriteMemoryFunc * const pxa2xx_keypad_writefn[] = {
|
|
pxa2xx_keypad_write,
|
|
pxa2xx_keypad_write,
|
|
pxa2xx_keypad_write
|
|
};
|
|
|
|
static const VMStateDescription vmstate_pxa2xx_keypad = {
|
|
.name = "pxa2xx_keypad",
|
|
.version_id = 0,
|
|
.minimum_version_id = 0,
|
|
.minimum_version_id_old = 0,
|
|
.fields = (VMStateField[]) {
|
|
VMSTATE_UINT32(kpc, PXA2xxKeyPadState),
|
|
VMSTATE_UINT32(kpdk, PXA2xxKeyPadState),
|
|
VMSTATE_UINT32(kprec, PXA2xxKeyPadState),
|
|
VMSTATE_UINT32(kpmk, PXA2xxKeyPadState),
|
|
VMSTATE_UINT32(kpas, PXA2xxKeyPadState),
|
|
VMSTATE_UINT32_ARRAY(kpasmkp, PXA2xxKeyPadState, 4),
|
|
VMSTATE_UINT32(kpkdi, PXA2xxKeyPadState),
|
|
VMSTATE_END_OF_LIST()
|
|
}
|
|
};
|
|
|
|
PXA2xxKeyPadState *pxa27x_keypad_init(target_phys_addr_t base,
|
|
qemu_irq irq)
|
|
{
|
|
int iomemtype;
|
|
PXA2xxKeyPadState *s;
|
|
|
|
s = (PXA2xxKeyPadState *) g_malloc0(sizeof(PXA2xxKeyPadState));
|
|
s->irq = irq;
|
|
|
|
iomemtype = cpu_register_io_memory(pxa2xx_keypad_readfn,
|
|
pxa2xx_keypad_writefn, s, DEVICE_NATIVE_ENDIAN);
|
|
cpu_register_physical_memory(base, 0x00100000, iomemtype);
|
|
|
|
vmstate_register(NULL, 0, &vmstate_pxa2xx_keypad, s);
|
|
|
|
return s;
|
|
}
|
|
|
|
void pxa27x_register_keypad(PXA2xxKeyPadState *kp, struct keymap *map,
|
|
int size)
|
|
{
|
|
if(!map || size < 0x80) {
|
|
fprintf(stderr, "%s - No PXA keypad map defined\n", __FUNCTION__);
|
|
exit(-1);
|
|
}
|
|
|
|
kp->map = map;
|
|
qemu_add_kbd_event_handler((QEMUPutKBDEvent *) pxa27x_keyboard_event, kp);
|
|
}
|