pxa2xx_keypad: make single automatic scans work
u-boot uses single automatic scans and polling in pxa2xx_keypad driver, so clear KPC_AS bit immediately and update keys state even if KPC_AS and KPC_ASACT are cleared. Signed-off-by: Vasily Khoruzhick <anarsoul@gmail.com> Signed-off-by: Andrzej Zaborowski <andrew.zaborowski@intel.com>
This commit is contained in:
parent
7ab3aedfe3
commit
753a97c6b4
|
@ -129,48 +129,45 @@ static void pxa27x_keyboard_event (PXA2xxKeyPadState *kp, int keycode)
|
||||||
if(!(kp->kpc & KPC_ME)) /* skip if not enabled */
|
if(!(kp->kpc & KPC_ME)) /* skip if not enabled */
|
||||||
return;
|
return;
|
||||||
|
|
||||||
if(kp->kpc & KPC_AS || kp->kpc & KPC_ASACT) {
|
rel = (keycode & 0x80) ? 1 : 0; /* key release from qemu */
|
||||||
if(kp->kpc & KPC_AS)
|
keycode &= ~0x80; /* strip qemu key release bit */
|
||||||
kp->kpc &= ~(KPC_AS);
|
if (kp->alt_code) {
|
||||||
|
keycode |= 0x80;
|
||||||
rel = (keycode & 0x80) ? 1 : 0; /* key release from qemu */
|
kp->alt_code = 0;
|
||||||
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:
|
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);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!(kp->kpc & (KPC_AS | KPC_ASACT))
|
||||||
|
assert_irq = 0;
|
||||||
|
|
||||||
if (assert_irq && (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);
|
||||||
|
@ -248,6 +245,9 @@ static void pxa2xx_keypad_write(void *opaque, target_phys_addr_t offset,
|
||||||
switch (offset) {
|
switch (offset) {
|
||||||
case KPC:
|
case KPC:
|
||||||
s->kpc = value;
|
s->kpc = value;
|
||||||
|
if (s->kpc & KPC_AS) {
|
||||||
|
s->kpc &= ~(KPC_AS);
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
case KPDK:
|
case KPDK:
|
||||||
s->kpdk = value;
|
s->kpdk = value;
|
||||||
|
|
Loading…
Reference in New Issue