mirror of
				https://git.proxmox.com/git/qemu
				synced 2025-10-26 05:20:22 +00:00 
			
		
		
		
	 c227f0995e
			
		
	
	
		c227f0995e
		
	
	
	
	
		
			
			In the very least, a change like this requires discussion on the list.
The naming convention is goofy and it causes a massive merge problem.  Something
like this _must_ be presented on the list first so people can provide input
and cope with it.
This reverts commit 99a0949b72.
Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
		
	
			
		
			
				
	
	
		
			337 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			337 lines
		
	
	
		
			9.3 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;
 | |
| 
 | |
|     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 (PXA2xxKeyPadState *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)
 | |
| {
 | |
|     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->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:
 | |
|         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->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:
 | |
|         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 void pxa2xx_keypad_save(QEMUFile *f, void *opaque)
 | |
| {
 | |
|     PXA2xxKeyPadState *s = (PXA2xxKeyPadState *) 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)
 | |
| {
 | |
|     PXA2xxKeyPadState *s = (PXA2xxKeyPadState *) 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;
 | |
| }
 | |
| 
 | |
| PXA2xxKeyPadState *pxa27x_keypad_init(target_phys_addr_t base,
 | |
|         qemu_irq irq)
 | |
| {
 | |
|     int iomemtype;
 | |
|     PXA2xxKeyPadState *s;
 | |
| 
 | |
|     s = (PXA2xxKeyPadState *) qemu_mallocz(sizeof(PXA2xxKeyPadState));
 | |
|     s->irq = irq;
 | |
| 
 | |
|     iomemtype = cpu_register_io_memory(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(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);
 | |
| }
 |