pxa2xx_keypad: enhance emulation of KPAS, KPASMKP regs

Add emulation of KPAS register and proper emulation of
KPASMKP regs, so now driver supports multipresses and properly
works with Linux driver.

Signed-off-by: Vasily Khoruzhick <anarsoul@gmail.com>
Signed-off-by: Aurelien Jarno <aurelien@aurel32.net>
This commit is contained in:
Vasily Khoruzhick 2011-02-15 15:27:28 +02:00 committed by Aurelien Jarno
parent 5a5e3d55ff
commit b976b4c0e7
1 changed files with 62 additions and 52 deletions

View File

@ -82,22 +82,39 @@
struct PXA2xxKeyPadState { struct PXA2xxKeyPadState {
qemu_irq irq; qemu_irq irq;
struct keymap *map; struct keymap *map;
int pressed_cnt;
uint32_t kpc; uint32_t kpc;
uint32_t kpdk; uint32_t kpdk;
uint32_t kprec; uint32_t kprec;
uint32_t kpmk; uint32_t kpmk;
uint32_t kpas; uint32_t kpas;
uint32_t kpasmkp0; uint32_t kpasmkp[4];
uint32_t kpasmkp1;
uint32_t kpasmkp2;
uint32_t kpasmkp3;
uint32_t kpkdi; 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) static void pxa27x_keyboard_event (PXA2xxKeyPadState *kp, int keycode)
{ {
int row, col,rel; int row, col, rel, assert_irq = 0;
uint32_t val;
if(!(kp->kpc & KPC_ME)) /* skip if not enabled */ if(!(kp->kpc & KPC_ME)) /* skip if not enabled */
return; return;
@ -108,46 +125,39 @@ static void pxa27x_keyboard_event (PXA2xxKeyPadState *kp, int keycode)
rel = (keycode & 0x80) ? 1 : 0; /* key release from qemu */ rel = (keycode & 0x80) ? 1 : 0; /* key release from qemu */
keycode &= ~(0x80); /* strip qemu key release bit */ keycode &= ~(0x80); /* strip qemu key release bit */
row = kp->map[keycode].row; row = kp->map[keycode].row;
col = kp->map[keycode].column; col = kp->map[keycode].column;
if(row == -1 || col == -1) if(row == -1 || col == -1)
return; return;
switch (col) {
case 0: val = KPASMKPx_MKC(row, col);
case 1: if (rel) {
if(rel) if (kp->kpasmkp[col / 2] & val) {
kp->kpasmkp0 = ~(0xffffffff); kp->kpasmkp[col / 2] &= ~val;
else kp->pressed_cnt--;
kp->kpasmkp0 |= KPASMKPx_MKC(row,col); assert_irq = 1;
break; }
case 2: } else {
case 3: if (!(kp->kpasmkp[col / 2] & val)) {
if(rel) kp->kpasmkp[col / 2] |= val;
kp->kpasmkp1 = ~(0xffffffff); kp->pressed_cnt++;
else assert_irq = 1;
kp->kpasmkp1 |= KPASMKPx_MKC(row,col); }
break; }
case 4: kp->kpas = ((kp->pressed_cnt & 0x1f) << 26) | (0xf << 4) | 0xf;
case 5: if (kp->pressed_cnt == 1) {
if(rel) kp->kpas &= ~((0xf << 4) | 0xf);
kp->kpasmkp2 = ~(0xffffffff); if (rel)
else pxa27x_keypad_find_pressed_key(kp, &row, &col);
kp->kpasmkp2 |= KPASMKPx_MKC(row,col); kp->kpas |= ((row & 0xf) << 4) | (col & 0xf);
break; }
case 6:
case 7:
if(rel)
kp->kpasmkp3 = ~(0xffffffff);
else
kp->kpasmkp3 |= KPASMKPx_MKC(row,col);
break;
} /* switch */
goto out; goto out;
} }
return; return;
out: out:
if(kp->kpc & KPC_MIE) { if (assert_irq && (kp->kpc & KPC_MIE)) {
kp->kpc |= KPC_MI; kp->kpc |= KPC_MI;
qemu_irq_raise(kp->irq); qemu_irq_raise(kp->irq);
} }
@ -194,16 +204,16 @@ static uint32_t pxa2xx_keypad_read(void *opaque, target_phys_addr_t offset)
return s->kpas; return s->kpas;
break; break;
case KPASMKP0: case KPASMKP0:
return s->kpasmkp0; return s->kpasmkp[0];
break; break;
case KPASMKP1: case KPASMKP1:
return s->kpasmkp1; return s->kpasmkp[1];
break; break;
case KPASMKP2: case KPASMKP2:
return s->kpasmkp2; return s->kpasmkp[2];
break; break;
case KPASMKP3: case KPASMKP3:
return s->kpasmkp3; return s->kpasmkp[3];
break; break;
case KPKDI: case KPKDI:
return s->kpkdi; return s->kpkdi;
@ -237,16 +247,16 @@ static void pxa2xx_keypad_write(void *opaque,
s->kpas = value; s->kpas = value;
break; break;
case KPASMKP0: case KPASMKP0:
s->kpasmkp0 = value; s->kpasmkp[0] = value;
break; break;
case KPASMKP1: case KPASMKP1:
s->kpasmkp1 = value; s->kpasmkp[1] = value;
break; break;
case KPASMKP2: case KPASMKP2:
s->kpasmkp2 = value; s->kpasmkp[2] = value;
break; break;
case KPASMKP3: case KPASMKP3:
s->kpasmkp3 = value; s->kpasmkp[3] = value;
break; break;
case KPKDI: case KPKDI:
s->kpkdi = value; s->kpkdi = value;
@ -278,10 +288,10 @@ static void pxa2xx_keypad_save(QEMUFile *f, void *opaque)
qemu_put_be32s(f, &s->kprec); qemu_put_be32s(f, &s->kprec);
qemu_put_be32s(f, &s->kpmk); qemu_put_be32s(f, &s->kpmk);
qemu_put_be32s(f, &s->kpas); qemu_put_be32s(f, &s->kpas);
qemu_put_be32s(f, &s->kpasmkp0); qemu_put_be32s(f, &s->kpasmkp[0]);
qemu_put_be32s(f, &s->kpasmkp1); qemu_put_be32s(f, &s->kpasmkp[1]);
qemu_put_be32s(f, &s->kpasmkp2); qemu_put_be32s(f, &s->kpasmkp[2]);
qemu_put_be32s(f, &s->kpasmkp3); qemu_put_be32s(f, &s->kpasmkp[3]);
qemu_put_be32s(f, &s->kpkdi); qemu_put_be32s(f, &s->kpkdi);
} }
@ -295,10 +305,10 @@ static int pxa2xx_keypad_load(QEMUFile *f, void *opaque, int version_id)
qemu_get_be32s(f, &s->kprec); qemu_get_be32s(f, &s->kprec);
qemu_get_be32s(f, &s->kpmk); qemu_get_be32s(f, &s->kpmk);
qemu_get_be32s(f, &s->kpas); qemu_get_be32s(f, &s->kpas);
qemu_get_be32s(f, &s->kpasmkp0); qemu_get_be32s(f, &s->kpasmkp[0]);
qemu_get_be32s(f, &s->kpasmkp1); qemu_get_be32s(f, &s->kpasmkp[1]);
qemu_get_be32s(f, &s->kpasmkp2); qemu_get_be32s(f, &s->kpasmkp[2]);
qemu_get_be32s(f, &s->kpasmkp3); qemu_get_be32s(f, &s->kpasmkp[3]);
qemu_get_be32s(f, &s->kpkdi); qemu_get_be32s(f, &s->kpkdi);
return 0; return 0;