diff -r ffa851df0825 -r 2fb8b9db1c86 symbian-qemu-0.9.1-12/qemu-symbian-svp/hw/pxa2xx_keypad.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/symbian-qemu-0.9.1-12/qemu-symbian-svp/hw/pxa2xx_keypad.c Fri Jul 31 15:01:17 2009 +0100 @@ -0,0 +1,340 @@ +/* + * Intel PXA27X Keypad Controller emulation. + * + * Copyright (c) 2007 MontaVista Software, Inc + * Written by Armin Kuster + * or + * + * This code is licensed under the GPLv2. + */ + +#include "hw.h" +#include "pxa.h" +#include "console.h" +#include "gui.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{ + 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 (void *opaque, int keycode) +{ + struct pxa2xx_keypad_s * const kp = opaque; + 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; + + 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; + + 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->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; + gui_register_dev_key_callback(pxa27x_keyboard_event, kp); +}