/* * 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 pxa2xx_keypad_s{ target_phys_addr_t base; qemu_irq irq; struct keymap *map; uint32_t kpc; uint32_t kpdk; uint32_t kprec; uint32_t kpmk; uint32_t kpas; uint32_t kpasmkp0; uint32_t kpasmkp1; uint32_t kpasmkp2; uint32_t kpasmkp3; uint32_t kpkdi; }; static void pxa27x_keyboard_event (struct pxa2xx_keypad_s *kp, int keycode) { int row, col,rel; 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 */ row = kp->map[keycode].row; col = kp->map[keycode].column; if(row == -1 || col == -1) return; switch (col) { case 0: case 1: if(rel) kp->kpasmkp0 = ~(0xffffffff); else kp->kpasmkp0 |= KPASMKPx_MKC(row,col); break; case 2: case 3: if(rel) kp->kpasmkp1 = ~(0xffffffff); else kp->kpasmkp1 |= KPASMKPx_MKC(row,col); break; case 4: case 5: if(rel) kp->kpasmkp2 = ~(0xffffffff); else kp->kpasmkp2 |= KPASMKPx_MKC(row,col); break; case 6: case 7: if(rel) kp->kpasmkp3 = ~(0xffffffff); else kp->kpasmkp3 |= KPASMKPx_MKC(row,col); break; } /* switch */ goto out; } return; out: if(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) { struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; uint32_t tmp; offset -= s->base; 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->kpasmkp0; break; case KPASMKP1: return s->kpasmkp1; break; case KPASMKP2: return s->kpasmkp2; break; case KPASMKP3: return s->kpasmkp3; break; case KPKDI: return s->kpkdi; break; default: cpu_abort(cpu_single_env, "%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) { struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; offset -= s->base; 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->kpasmkp0 = value; break; case KPASMKP1: s->kpasmkp1 = value; break; case KPASMKP2: s->kpasmkp2 = value; break; case KPASMKP3: s->kpasmkp3 = value; break; case KPKDI: s->kpkdi = value; break; default: cpu_abort(cpu_single_env, "%s: Bad offset " REG_FMT "\n", __FUNCTION__, offset); } } static CPUReadMemoryFunc *pxa2xx_keypad_readfn[] = { pxa2xx_keypad_read, pxa2xx_keypad_read, pxa2xx_keypad_read }; static CPUWriteMemoryFunc *pxa2xx_keypad_writefn[] = { pxa2xx_keypad_write, pxa2xx_keypad_write, pxa2xx_keypad_write }; static void pxa2xx_keypad_save(QEMUFile *f, void *opaque) { struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; qemu_put_be32s(f, &s->kpc); qemu_put_be32s(f, &s->kpdk); qemu_put_be32s(f, &s->kprec); qemu_put_be32s(f, &s->kpmk); qemu_put_be32s(f, &s->kpas); qemu_put_be32s(f, &s->kpasmkp0); qemu_put_be32s(f, &s->kpasmkp1); qemu_put_be32s(f, &s->kpasmkp2); qemu_put_be32s(f, &s->kpasmkp3); qemu_put_be32s(f, &s->kpkdi); } static int pxa2xx_keypad_load(QEMUFile *f, void *opaque, int version_id) { struct pxa2xx_keypad_s *s = (struct pxa2xx_keypad_s *) opaque; qemu_get_be32s(f, &s->kpc); qemu_get_be32s(f, &s->kpdk); qemu_get_be32s(f, &s->kprec); qemu_get_be32s(f, &s->kpmk); qemu_get_be32s(f, &s->kpas); qemu_get_be32s(f, &s->kpasmkp0); qemu_get_be32s(f, &s->kpasmkp1); qemu_get_be32s(f, &s->kpasmkp2); qemu_get_be32s(f, &s->kpasmkp3); qemu_get_be32s(f, &s->kpkdi); return 0; } struct pxa2xx_keypad_s *pxa27x_keypad_init(target_phys_addr_t base, qemu_irq irq) { int iomemtype; struct pxa2xx_keypad_s *s; s = (struct pxa2xx_keypad_s *) qemu_mallocz(sizeof(struct pxa2xx_keypad_s)); s->base = base; s->irq = irq; iomemtype = cpu_register_io_memory(0, pxa2xx_keypad_readfn, pxa2xx_keypad_writefn, s); cpu_register_physical_memory(base, 0x00100000, iomemtype); register_savevm("pxa2xx_keypad", 0, 0, pxa2xx_keypad_save, pxa2xx_keypad_load, s); return s; } void pxa27x_register_keypad(struct pxa2xx_keypad_s *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); }