149ab747fSPaolo Bonzini /* 249ab747fSPaolo Bonzini * QEMU PC keyboard emulation 349ab747fSPaolo Bonzini * 449ab747fSPaolo Bonzini * Copyright (c) 2003 Fabrice Bellard 549ab747fSPaolo Bonzini * 649ab747fSPaolo Bonzini * Permission is hereby granted, free of charge, to any person obtaining a copy 749ab747fSPaolo Bonzini * of this software and associated documentation files (the "Software"), to deal 849ab747fSPaolo Bonzini * in the Software without restriction, including without limitation the rights 949ab747fSPaolo Bonzini * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 1049ab747fSPaolo Bonzini * copies of the Software, and to permit persons to whom the Software is 1149ab747fSPaolo Bonzini * furnished to do so, subject to the following conditions: 1249ab747fSPaolo Bonzini * 1349ab747fSPaolo Bonzini * The above copyright notice and this permission notice shall be included in 1449ab747fSPaolo Bonzini * all copies or substantial portions of the Software. 1549ab747fSPaolo Bonzini * 1649ab747fSPaolo Bonzini * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 1749ab747fSPaolo Bonzini * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 1849ab747fSPaolo Bonzini * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 1949ab747fSPaolo Bonzini * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 2049ab747fSPaolo Bonzini * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 2149ab747fSPaolo Bonzini * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 2249ab747fSPaolo Bonzini * THE SOFTWARE. 2349ab747fSPaolo Bonzini */ 2449ab747fSPaolo Bonzini #include "hw/hw.h" 2549ab747fSPaolo Bonzini #include "hw/isa/isa.h" 2649ab747fSPaolo Bonzini #include "hw/i386/pc.h" 2749ab747fSPaolo Bonzini #include "hw/input/ps2.h" 2849ab747fSPaolo Bonzini #include "sysemu/sysemu.h" 2949ab747fSPaolo Bonzini 3049ab747fSPaolo Bonzini /* debug PC keyboard */ 3149ab747fSPaolo Bonzini //#define DEBUG_KBD 3249ab747fSPaolo Bonzini #ifdef DEBUG_KBD 3349ab747fSPaolo Bonzini #define DPRINTF(fmt, ...) \ 3449ab747fSPaolo Bonzini do { printf("KBD: " fmt , ## __VA_ARGS__); } while (0) 3549ab747fSPaolo Bonzini #else 3649ab747fSPaolo Bonzini #define DPRINTF(fmt, ...) 3749ab747fSPaolo Bonzini #endif 3849ab747fSPaolo Bonzini 3949ab747fSPaolo Bonzini /* Keyboard Controller Commands */ 4049ab747fSPaolo Bonzini #define KBD_CCMD_READ_MODE 0x20 /* Read mode bits */ 4149ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_MODE 0x60 /* Write mode bits */ 4249ab747fSPaolo Bonzini #define KBD_CCMD_GET_VERSION 0xA1 /* Get controller version */ 4349ab747fSPaolo Bonzini #define KBD_CCMD_MOUSE_DISABLE 0xA7 /* Disable mouse interface */ 4449ab747fSPaolo Bonzini #define KBD_CCMD_MOUSE_ENABLE 0xA8 /* Enable mouse interface */ 4549ab747fSPaolo Bonzini #define KBD_CCMD_TEST_MOUSE 0xA9 /* Mouse interface test */ 4649ab747fSPaolo Bonzini #define KBD_CCMD_SELF_TEST 0xAA /* Controller self test */ 4749ab747fSPaolo Bonzini #define KBD_CCMD_KBD_TEST 0xAB /* Keyboard interface test */ 4849ab747fSPaolo Bonzini #define KBD_CCMD_KBD_DISABLE 0xAD /* Keyboard interface disable */ 4949ab747fSPaolo Bonzini #define KBD_CCMD_KBD_ENABLE 0xAE /* Keyboard interface enable */ 5049ab747fSPaolo Bonzini #define KBD_CCMD_READ_INPORT 0xC0 /* read input port */ 5149ab747fSPaolo Bonzini #define KBD_CCMD_READ_OUTPORT 0xD0 /* read output port */ 5249ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_OUTPORT 0xD1 /* write output port */ 5349ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_OBUF 0xD2 5449ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_AUX_OBUF 0xD3 /* Write to output buffer as if 5549ab747fSPaolo Bonzini initiated by the auxiliary device */ 5649ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_MOUSE 0xD4 /* Write the following byte to the mouse */ 5749ab747fSPaolo Bonzini #define KBD_CCMD_DISABLE_A20 0xDD /* HP vectra only ? */ 5849ab747fSPaolo Bonzini #define KBD_CCMD_ENABLE_A20 0xDF /* HP vectra only ? */ 5949ab747fSPaolo Bonzini #define KBD_CCMD_PULSE_BITS_3_0 0xF0 /* Pulse bits 3-0 of the output port P2. */ 6049ab747fSPaolo Bonzini #define KBD_CCMD_RESET 0xFE /* Pulse bit 0 of the output port P2 = CPU reset. */ 6149ab747fSPaolo Bonzini #define KBD_CCMD_NO_OP 0xFF /* Pulse no bits of the output port P2. */ 6249ab747fSPaolo Bonzini 6349ab747fSPaolo Bonzini /* Keyboard Commands */ 6449ab747fSPaolo Bonzini #define KBD_CMD_SET_LEDS 0xED /* Set keyboard leds */ 6549ab747fSPaolo Bonzini #define KBD_CMD_ECHO 0xEE 6649ab747fSPaolo Bonzini #define KBD_CMD_GET_ID 0xF2 /* get keyboard ID */ 6749ab747fSPaolo Bonzini #define KBD_CMD_SET_RATE 0xF3 /* Set typematic rate */ 6849ab747fSPaolo Bonzini #define KBD_CMD_ENABLE 0xF4 /* Enable scanning */ 6949ab747fSPaolo Bonzini #define KBD_CMD_RESET_DISABLE 0xF5 /* reset and disable scanning */ 7049ab747fSPaolo Bonzini #define KBD_CMD_RESET_ENABLE 0xF6 /* reset and enable scanning */ 7149ab747fSPaolo Bonzini #define KBD_CMD_RESET 0xFF /* Reset */ 7249ab747fSPaolo Bonzini 7349ab747fSPaolo Bonzini /* Keyboard Replies */ 7449ab747fSPaolo Bonzini #define KBD_REPLY_POR 0xAA /* Power on reset */ 7549ab747fSPaolo Bonzini #define KBD_REPLY_ACK 0xFA /* Command ACK */ 7649ab747fSPaolo Bonzini #define KBD_REPLY_RESEND 0xFE /* Command NACK, send the cmd again */ 7749ab747fSPaolo Bonzini 7849ab747fSPaolo Bonzini /* Status Register Bits */ 7949ab747fSPaolo Bonzini #define KBD_STAT_OBF 0x01 /* Keyboard output buffer full */ 8049ab747fSPaolo Bonzini #define KBD_STAT_IBF 0x02 /* Keyboard input buffer full */ 8149ab747fSPaolo Bonzini #define KBD_STAT_SELFTEST 0x04 /* Self test successful */ 8249ab747fSPaolo Bonzini #define KBD_STAT_CMD 0x08 /* Last write was a command write (0=data) */ 8349ab747fSPaolo Bonzini #define KBD_STAT_UNLOCKED 0x10 /* Zero if keyboard locked */ 8449ab747fSPaolo Bonzini #define KBD_STAT_MOUSE_OBF 0x20 /* Mouse output buffer full */ 8549ab747fSPaolo Bonzini #define KBD_STAT_GTO 0x40 /* General receive/xmit timeout */ 8649ab747fSPaolo Bonzini #define KBD_STAT_PERR 0x80 /* Parity error */ 8749ab747fSPaolo Bonzini 8849ab747fSPaolo Bonzini /* Controller Mode Register Bits */ 8949ab747fSPaolo Bonzini #define KBD_MODE_KBD_INT 0x01 /* Keyboard data generate IRQ1 */ 9049ab747fSPaolo Bonzini #define KBD_MODE_MOUSE_INT 0x02 /* Mouse data generate IRQ12 */ 9149ab747fSPaolo Bonzini #define KBD_MODE_SYS 0x04 /* The system flag (?) */ 9249ab747fSPaolo Bonzini #define KBD_MODE_NO_KEYLOCK 0x08 /* The keylock doesn't affect the keyboard if set */ 9349ab747fSPaolo Bonzini #define KBD_MODE_DISABLE_KBD 0x10 /* Disable keyboard interface */ 9449ab747fSPaolo Bonzini #define KBD_MODE_DISABLE_MOUSE 0x20 /* Disable mouse interface */ 9549ab747fSPaolo Bonzini #define KBD_MODE_KCC 0x40 /* Scan code conversion to PC format */ 9649ab747fSPaolo Bonzini #define KBD_MODE_RFU 0x80 9749ab747fSPaolo Bonzini 9849ab747fSPaolo Bonzini /* Output Port Bits */ 9949ab747fSPaolo Bonzini #define KBD_OUT_RESET 0x01 /* 1=normal mode, 0=reset */ 10049ab747fSPaolo Bonzini #define KBD_OUT_A20 0x02 /* x86 only */ 10149ab747fSPaolo Bonzini #define KBD_OUT_OBF 0x10 /* Keyboard output buffer full */ 10249ab747fSPaolo Bonzini #define KBD_OUT_MOUSE_OBF 0x20 /* Mouse output buffer full */ 10349ab747fSPaolo Bonzini 10449ab747fSPaolo Bonzini /* Mouse Commands */ 10549ab747fSPaolo Bonzini #define AUX_SET_SCALE11 0xE6 /* Set 1:1 scaling */ 10649ab747fSPaolo Bonzini #define AUX_SET_SCALE21 0xE7 /* Set 2:1 scaling */ 10749ab747fSPaolo Bonzini #define AUX_SET_RES 0xE8 /* Set resolution */ 10849ab747fSPaolo Bonzini #define AUX_GET_SCALE 0xE9 /* Get scaling factor */ 10949ab747fSPaolo Bonzini #define AUX_SET_STREAM 0xEA /* Set stream mode */ 11049ab747fSPaolo Bonzini #define AUX_POLL 0xEB /* Poll */ 11149ab747fSPaolo Bonzini #define AUX_RESET_WRAP 0xEC /* Reset wrap mode */ 11249ab747fSPaolo Bonzini #define AUX_SET_WRAP 0xEE /* Set wrap mode */ 11349ab747fSPaolo Bonzini #define AUX_SET_REMOTE 0xF0 /* Set remote mode */ 11449ab747fSPaolo Bonzini #define AUX_GET_TYPE 0xF2 /* Get type */ 11549ab747fSPaolo Bonzini #define AUX_SET_SAMPLE 0xF3 /* Set sample rate */ 11649ab747fSPaolo Bonzini #define AUX_ENABLE_DEV 0xF4 /* Enable aux device */ 11749ab747fSPaolo Bonzini #define AUX_DISABLE_DEV 0xF5 /* Disable aux device */ 11849ab747fSPaolo Bonzini #define AUX_SET_DEFAULT 0xF6 11949ab747fSPaolo Bonzini #define AUX_RESET 0xFF /* Reset aux device */ 12049ab747fSPaolo Bonzini #define AUX_ACK 0xFA /* Command byte ACK. */ 12149ab747fSPaolo Bonzini 12249ab747fSPaolo Bonzini #define MOUSE_STATUS_REMOTE 0x40 12349ab747fSPaolo Bonzini #define MOUSE_STATUS_ENABLED 0x20 12449ab747fSPaolo Bonzini #define MOUSE_STATUS_SCALE21 0x10 12549ab747fSPaolo Bonzini 12649ab747fSPaolo Bonzini #define KBD_PENDING_KBD 1 12749ab747fSPaolo Bonzini #define KBD_PENDING_AUX 2 12849ab747fSPaolo Bonzini 12949ab747fSPaolo Bonzini typedef struct KBDState { 13049ab747fSPaolo Bonzini uint8_t write_cmd; /* if non zero, write data to port 60 is expected */ 13149ab747fSPaolo Bonzini uint8_t status; 13249ab747fSPaolo Bonzini uint8_t mode; 13349ab747fSPaolo Bonzini uint8_t outport; 13449ab747fSPaolo Bonzini /* Bitmask of devices with data available. */ 13549ab747fSPaolo Bonzini uint8_t pending; 13649ab747fSPaolo Bonzini void *kbd; 13749ab747fSPaolo Bonzini void *mouse; 13849ab747fSPaolo Bonzini 13949ab747fSPaolo Bonzini qemu_irq irq_kbd; 14049ab747fSPaolo Bonzini qemu_irq irq_mouse; 14149ab747fSPaolo Bonzini qemu_irq *a20_out; 14249ab747fSPaolo Bonzini hwaddr mask; 14349ab747fSPaolo Bonzini } KBDState; 14449ab747fSPaolo Bonzini 14549ab747fSPaolo Bonzini /* update irq and KBD_STAT_[MOUSE_]OBF */ 14649ab747fSPaolo Bonzini /* XXX: not generating the irqs if KBD_MODE_DISABLE_KBD is set may be 14749ab747fSPaolo Bonzini incorrect, but it avoids having to simulate exact delays */ 14849ab747fSPaolo Bonzini static void kbd_update_irq(KBDState *s) 14949ab747fSPaolo Bonzini { 15049ab747fSPaolo Bonzini int irq_kbd_level, irq_mouse_level; 15149ab747fSPaolo Bonzini 15249ab747fSPaolo Bonzini irq_kbd_level = 0; 15349ab747fSPaolo Bonzini irq_mouse_level = 0; 15449ab747fSPaolo Bonzini s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF); 15549ab747fSPaolo Bonzini s->outport &= ~(KBD_OUT_OBF | KBD_OUT_MOUSE_OBF); 15649ab747fSPaolo Bonzini if (s->pending) { 15749ab747fSPaolo Bonzini s->status |= KBD_STAT_OBF; 15849ab747fSPaolo Bonzini s->outport |= KBD_OUT_OBF; 15949ab747fSPaolo Bonzini /* kbd data takes priority over aux data. */ 16049ab747fSPaolo Bonzini if (s->pending == KBD_PENDING_AUX) { 16149ab747fSPaolo Bonzini s->status |= KBD_STAT_MOUSE_OBF; 16249ab747fSPaolo Bonzini s->outport |= KBD_OUT_MOUSE_OBF; 16349ab747fSPaolo Bonzini if (s->mode & KBD_MODE_MOUSE_INT) 16449ab747fSPaolo Bonzini irq_mouse_level = 1; 16549ab747fSPaolo Bonzini } else { 16649ab747fSPaolo Bonzini if ((s->mode & KBD_MODE_KBD_INT) && 16749ab747fSPaolo Bonzini !(s->mode & KBD_MODE_DISABLE_KBD)) 16849ab747fSPaolo Bonzini irq_kbd_level = 1; 16949ab747fSPaolo Bonzini } 17049ab747fSPaolo Bonzini } 17149ab747fSPaolo Bonzini qemu_set_irq(s->irq_kbd, irq_kbd_level); 17249ab747fSPaolo Bonzini qemu_set_irq(s->irq_mouse, irq_mouse_level); 17349ab747fSPaolo Bonzini } 17449ab747fSPaolo Bonzini 17549ab747fSPaolo Bonzini static void kbd_update_kbd_irq(void *opaque, int level) 17649ab747fSPaolo Bonzini { 17749ab747fSPaolo Bonzini KBDState *s = (KBDState *)opaque; 17849ab747fSPaolo Bonzini 17949ab747fSPaolo Bonzini if (level) 18049ab747fSPaolo Bonzini s->pending |= KBD_PENDING_KBD; 18149ab747fSPaolo Bonzini else 18249ab747fSPaolo Bonzini s->pending &= ~KBD_PENDING_KBD; 18349ab747fSPaolo Bonzini kbd_update_irq(s); 18449ab747fSPaolo Bonzini } 18549ab747fSPaolo Bonzini 18649ab747fSPaolo Bonzini static void kbd_update_aux_irq(void *opaque, int level) 18749ab747fSPaolo Bonzini { 18849ab747fSPaolo Bonzini KBDState *s = (KBDState *)opaque; 18949ab747fSPaolo Bonzini 19049ab747fSPaolo Bonzini if (level) 19149ab747fSPaolo Bonzini s->pending |= KBD_PENDING_AUX; 19249ab747fSPaolo Bonzini else 19349ab747fSPaolo Bonzini s->pending &= ~KBD_PENDING_AUX; 19449ab747fSPaolo Bonzini kbd_update_irq(s); 19549ab747fSPaolo Bonzini } 19649ab747fSPaolo Bonzini 19749ab747fSPaolo Bonzini static uint64_t kbd_read_status(void *opaque, hwaddr addr, 19849ab747fSPaolo Bonzini unsigned size) 19949ab747fSPaolo Bonzini { 20049ab747fSPaolo Bonzini KBDState *s = opaque; 20149ab747fSPaolo Bonzini int val; 20249ab747fSPaolo Bonzini val = s->status; 20349ab747fSPaolo Bonzini DPRINTF("kbd: read status=0x%02x\n", val); 20449ab747fSPaolo Bonzini return val; 20549ab747fSPaolo Bonzini } 20649ab747fSPaolo Bonzini 20749ab747fSPaolo Bonzini static void kbd_queue(KBDState *s, int b, int aux) 20849ab747fSPaolo Bonzini { 20949ab747fSPaolo Bonzini if (aux) 21049ab747fSPaolo Bonzini ps2_queue(s->mouse, b); 21149ab747fSPaolo Bonzini else 21249ab747fSPaolo Bonzini ps2_queue(s->kbd, b); 21349ab747fSPaolo Bonzini } 21449ab747fSPaolo Bonzini 21549ab747fSPaolo Bonzini static void outport_write(KBDState *s, uint32_t val) 21649ab747fSPaolo Bonzini { 21749ab747fSPaolo Bonzini DPRINTF("kbd: write outport=0x%02x\n", val); 21849ab747fSPaolo Bonzini s->outport = val; 21949ab747fSPaolo Bonzini if (s->a20_out) { 22049ab747fSPaolo Bonzini qemu_set_irq(*s->a20_out, (val >> 1) & 1); 22149ab747fSPaolo Bonzini } 22249ab747fSPaolo Bonzini if (!(val & 1)) { 22349ab747fSPaolo Bonzini qemu_system_reset_request(); 22449ab747fSPaolo Bonzini } 22549ab747fSPaolo Bonzini } 22649ab747fSPaolo Bonzini 22749ab747fSPaolo Bonzini static void kbd_write_command(void *opaque, hwaddr addr, 22849ab747fSPaolo Bonzini uint64_t val, unsigned size) 22949ab747fSPaolo Bonzini { 23049ab747fSPaolo Bonzini KBDState *s = opaque; 23149ab747fSPaolo Bonzini 23249ab747fSPaolo Bonzini DPRINTF("kbd: write cmd=0x%02x\n", val); 23349ab747fSPaolo Bonzini 23449ab747fSPaolo Bonzini /* Bits 3-0 of the output port P2 of the keyboard controller may be pulsed 23549ab747fSPaolo Bonzini * low for approximately 6 micro seconds. Bits 3-0 of the KBD_CCMD_PULSE 23649ab747fSPaolo Bonzini * command specify the output port bits to be pulsed. 23749ab747fSPaolo Bonzini * 0: Bit should be pulsed. 1: Bit should not be modified. 23849ab747fSPaolo Bonzini * The only useful version of this command is pulsing bit 0, 23949ab747fSPaolo Bonzini * which does a CPU reset. 24049ab747fSPaolo Bonzini */ 24149ab747fSPaolo Bonzini if((val & KBD_CCMD_PULSE_BITS_3_0) == KBD_CCMD_PULSE_BITS_3_0) { 24249ab747fSPaolo Bonzini if(!(val & 1)) 24349ab747fSPaolo Bonzini val = KBD_CCMD_RESET; 24449ab747fSPaolo Bonzini else 24549ab747fSPaolo Bonzini val = KBD_CCMD_NO_OP; 24649ab747fSPaolo Bonzini } 24749ab747fSPaolo Bonzini 24849ab747fSPaolo Bonzini switch(val) { 24949ab747fSPaolo Bonzini case KBD_CCMD_READ_MODE: 25049ab747fSPaolo Bonzini kbd_queue(s, s->mode, 0); 25149ab747fSPaolo Bonzini break; 25249ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MODE: 25349ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OBUF: 25449ab747fSPaolo Bonzini case KBD_CCMD_WRITE_AUX_OBUF: 25549ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MOUSE: 25649ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OUTPORT: 25749ab747fSPaolo Bonzini s->write_cmd = val; 25849ab747fSPaolo Bonzini break; 25949ab747fSPaolo Bonzini case KBD_CCMD_MOUSE_DISABLE: 26049ab747fSPaolo Bonzini s->mode |= KBD_MODE_DISABLE_MOUSE; 26149ab747fSPaolo Bonzini break; 26249ab747fSPaolo Bonzini case KBD_CCMD_MOUSE_ENABLE: 26349ab747fSPaolo Bonzini s->mode &= ~KBD_MODE_DISABLE_MOUSE; 26449ab747fSPaolo Bonzini break; 26549ab747fSPaolo Bonzini case KBD_CCMD_TEST_MOUSE: 26649ab747fSPaolo Bonzini kbd_queue(s, 0x00, 0); 26749ab747fSPaolo Bonzini break; 26849ab747fSPaolo Bonzini case KBD_CCMD_SELF_TEST: 26949ab747fSPaolo Bonzini s->status |= KBD_STAT_SELFTEST; 27049ab747fSPaolo Bonzini kbd_queue(s, 0x55, 0); 27149ab747fSPaolo Bonzini break; 27249ab747fSPaolo Bonzini case KBD_CCMD_KBD_TEST: 27349ab747fSPaolo Bonzini kbd_queue(s, 0x00, 0); 27449ab747fSPaolo Bonzini break; 27549ab747fSPaolo Bonzini case KBD_CCMD_KBD_DISABLE: 27649ab747fSPaolo Bonzini s->mode |= KBD_MODE_DISABLE_KBD; 27749ab747fSPaolo Bonzini kbd_update_irq(s); 27849ab747fSPaolo Bonzini break; 27949ab747fSPaolo Bonzini case KBD_CCMD_KBD_ENABLE: 28049ab747fSPaolo Bonzini s->mode &= ~KBD_MODE_DISABLE_KBD; 28149ab747fSPaolo Bonzini kbd_update_irq(s); 28249ab747fSPaolo Bonzini break; 28349ab747fSPaolo Bonzini case KBD_CCMD_READ_INPORT: 284*f1b7e0e4SHervé Poussineau kbd_queue(s, 0x80, 0); 28549ab747fSPaolo Bonzini break; 28649ab747fSPaolo Bonzini case KBD_CCMD_READ_OUTPORT: 28749ab747fSPaolo Bonzini kbd_queue(s, s->outport, 0); 28849ab747fSPaolo Bonzini break; 28949ab747fSPaolo Bonzini case KBD_CCMD_ENABLE_A20: 29049ab747fSPaolo Bonzini if (s->a20_out) { 29149ab747fSPaolo Bonzini qemu_irq_raise(*s->a20_out); 29249ab747fSPaolo Bonzini } 29349ab747fSPaolo Bonzini s->outport |= KBD_OUT_A20; 29449ab747fSPaolo Bonzini break; 29549ab747fSPaolo Bonzini case KBD_CCMD_DISABLE_A20: 29649ab747fSPaolo Bonzini if (s->a20_out) { 29749ab747fSPaolo Bonzini qemu_irq_lower(*s->a20_out); 29849ab747fSPaolo Bonzini } 29949ab747fSPaolo Bonzini s->outport &= ~KBD_OUT_A20; 30049ab747fSPaolo Bonzini break; 30149ab747fSPaolo Bonzini case KBD_CCMD_RESET: 30249ab747fSPaolo Bonzini qemu_system_reset_request(); 30349ab747fSPaolo Bonzini break; 30449ab747fSPaolo Bonzini case KBD_CCMD_NO_OP: 30549ab747fSPaolo Bonzini /* ignore that */ 30649ab747fSPaolo Bonzini break; 30749ab747fSPaolo Bonzini default: 30849ab747fSPaolo Bonzini fprintf(stderr, "qemu: unsupported keyboard cmd=0x%02x\n", (int)val); 30949ab747fSPaolo Bonzini break; 31049ab747fSPaolo Bonzini } 31149ab747fSPaolo Bonzini } 31249ab747fSPaolo Bonzini 31349ab747fSPaolo Bonzini static uint64_t kbd_read_data(void *opaque, hwaddr addr, 31449ab747fSPaolo Bonzini unsigned size) 31549ab747fSPaolo Bonzini { 31649ab747fSPaolo Bonzini KBDState *s = opaque; 31749ab747fSPaolo Bonzini uint32_t val; 31849ab747fSPaolo Bonzini 31949ab747fSPaolo Bonzini if (s->pending == KBD_PENDING_AUX) 32049ab747fSPaolo Bonzini val = ps2_read_data(s->mouse); 32149ab747fSPaolo Bonzini else 32249ab747fSPaolo Bonzini val = ps2_read_data(s->kbd); 32349ab747fSPaolo Bonzini 32449ab747fSPaolo Bonzini DPRINTF("kbd: read data=0x%02x\n", val); 32549ab747fSPaolo Bonzini return val; 32649ab747fSPaolo Bonzini } 32749ab747fSPaolo Bonzini 32849ab747fSPaolo Bonzini static void kbd_write_data(void *opaque, hwaddr addr, 32949ab747fSPaolo Bonzini uint64_t val, unsigned size) 33049ab747fSPaolo Bonzini { 33149ab747fSPaolo Bonzini KBDState *s = opaque; 33249ab747fSPaolo Bonzini 33349ab747fSPaolo Bonzini DPRINTF("kbd: write data=0x%02x\n", val); 33449ab747fSPaolo Bonzini 33549ab747fSPaolo Bonzini switch(s->write_cmd) { 33649ab747fSPaolo Bonzini case 0: 33749ab747fSPaolo Bonzini ps2_write_keyboard(s->kbd, val); 33849ab747fSPaolo Bonzini break; 33949ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MODE: 34049ab747fSPaolo Bonzini s->mode = val; 34149ab747fSPaolo Bonzini ps2_keyboard_set_translation(s->kbd, (s->mode & KBD_MODE_KCC) != 0); 34249ab747fSPaolo Bonzini /* ??? */ 34349ab747fSPaolo Bonzini kbd_update_irq(s); 34449ab747fSPaolo Bonzini break; 34549ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OBUF: 34649ab747fSPaolo Bonzini kbd_queue(s, val, 0); 34749ab747fSPaolo Bonzini break; 34849ab747fSPaolo Bonzini case KBD_CCMD_WRITE_AUX_OBUF: 34949ab747fSPaolo Bonzini kbd_queue(s, val, 1); 35049ab747fSPaolo Bonzini break; 35149ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OUTPORT: 35249ab747fSPaolo Bonzini outport_write(s, val); 35349ab747fSPaolo Bonzini break; 35449ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MOUSE: 35549ab747fSPaolo Bonzini ps2_write_mouse(s->mouse, val); 35649ab747fSPaolo Bonzini break; 35749ab747fSPaolo Bonzini default: 35849ab747fSPaolo Bonzini break; 35949ab747fSPaolo Bonzini } 36049ab747fSPaolo Bonzini s->write_cmd = 0; 36149ab747fSPaolo Bonzini } 36249ab747fSPaolo Bonzini 36349ab747fSPaolo Bonzini static void kbd_reset(void *opaque) 36449ab747fSPaolo Bonzini { 36549ab747fSPaolo Bonzini KBDState *s = opaque; 36649ab747fSPaolo Bonzini 36749ab747fSPaolo Bonzini s->mode = KBD_MODE_KBD_INT | KBD_MODE_MOUSE_INT; 36849ab747fSPaolo Bonzini s->status = KBD_STAT_CMD | KBD_STAT_UNLOCKED; 36949ab747fSPaolo Bonzini s->outport = KBD_OUT_RESET | KBD_OUT_A20; 37049ab747fSPaolo Bonzini } 37149ab747fSPaolo Bonzini 37249ab747fSPaolo Bonzini static const VMStateDescription vmstate_kbd = { 37349ab747fSPaolo Bonzini .name = "pckbd", 37449ab747fSPaolo Bonzini .version_id = 3, 37549ab747fSPaolo Bonzini .minimum_version_id = 3, 37649ab747fSPaolo Bonzini .minimum_version_id_old = 3, 37749ab747fSPaolo Bonzini .fields = (VMStateField []) { 37849ab747fSPaolo Bonzini VMSTATE_UINT8(write_cmd, KBDState), 37949ab747fSPaolo Bonzini VMSTATE_UINT8(status, KBDState), 38049ab747fSPaolo Bonzini VMSTATE_UINT8(mode, KBDState), 38149ab747fSPaolo Bonzini VMSTATE_UINT8(pending, KBDState), 38249ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 38349ab747fSPaolo Bonzini } 38449ab747fSPaolo Bonzini }; 38549ab747fSPaolo Bonzini 38649ab747fSPaolo Bonzini /* Memory mapped interface */ 38749ab747fSPaolo Bonzini static uint32_t kbd_mm_readb (void *opaque, hwaddr addr) 38849ab747fSPaolo Bonzini { 38949ab747fSPaolo Bonzini KBDState *s = opaque; 39049ab747fSPaolo Bonzini 39149ab747fSPaolo Bonzini if (addr & s->mask) 39249ab747fSPaolo Bonzini return kbd_read_status(s, 0, 1) & 0xff; 39349ab747fSPaolo Bonzini else 39449ab747fSPaolo Bonzini return kbd_read_data(s, 0, 1) & 0xff; 39549ab747fSPaolo Bonzini } 39649ab747fSPaolo Bonzini 39749ab747fSPaolo Bonzini static void kbd_mm_writeb (void *opaque, hwaddr addr, uint32_t value) 39849ab747fSPaolo Bonzini { 39949ab747fSPaolo Bonzini KBDState *s = opaque; 40049ab747fSPaolo Bonzini 40149ab747fSPaolo Bonzini if (addr & s->mask) 40249ab747fSPaolo Bonzini kbd_write_command(s, 0, value & 0xff, 1); 40349ab747fSPaolo Bonzini else 40449ab747fSPaolo Bonzini kbd_write_data(s, 0, value & 0xff, 1); 40549ab747fSPaolo Bonzini } 40649ab747fSPaolo Bonzini 40749ab747fSPaolo Bonzini static const MemoryRegionOps i8042_mmio_ops = { 40849ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 40949ab747fSPaolo Bonzini .old_mmio = { 41049ab747fSPaolo Bonzini .read = { kbd_mm_readb, kbd_mm_readb, kbd_mm_readb }, 41149ab747fSPaolo Bonzini .write = { kbd_mm_writeb, kbd_mm_writeb, kbd_mm_writeb }, 41249ab747fSPaolo Bonzini }, 41349ab747fSPaolo Bonzini }; 41449ab747fSPaolo Bonzini 41549ab747fSPaolo Bonzini void i8042_mm_init(qemu_irq kbd_irq, qemu_irq mouse_irq, 41649ab747fSPaolo Bonzini MemoryRegion *region, ram_addr_t size, 41749ab747fSPaolo Bonzini hwaddr mask) 41849ab747fSPaolo Bonzini { 41949ab747fSPaolo Bonzini KBDState *s = g_malloc0(sizeof(KBDState)); 42049ab747fSPaolo Bonzini 42149ab747fSPaolo Bonzini s->irq_kbd = kbd_irq; 42249ab747fSPaolo Bonzini s->irq_mouse = mouse_irq; 42349ab747fSPaolo Bonzini s->mask = mask; 42449ab747fSPaolo Bonzini 42549ab747fSPaolo Bonzini vmstate_register(NULL, 0, &vmstate_kbd, s); 42649ab747fSPaolo Bonzini 4272c9b15caSPaolo Bonzini memory_region_init_io(region, NULL, &i8042_mmio_ops, s, "i8042", size); 42849ab747fSPaolo Bonzini 42949ab747fSPaolo Bonzini s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s); 43049ab747fSPaolo Bonzini s->mouse = ps2_mouse_init(kbd_update_aux_irq, s); 43149ab747fSPaolo Bonzini qemu_register_reset(kbd_reset, s); 43249ab747fSPaolo Bonzini } 43349ab747fSPaolo Bonzini 434a2e0b863SAndreas Färber #define TYPE_I8042 "i8042" 435a2e0b863SAndreas Färber #define I8042(obj) OBJECT_CHECK(ISAKBDState, (obj), TYPE_I8042) 436a2e0b863SAndreas Färber 43749ab747fSPaolo Bonzini typedef struct ISAKBDState { 438a2e0b863SAndreas Färber ISADevice parent_obj; 439a2e0b863SAndreas Färber 44049ab747fSPaolo Bonzini KBDState kbd; 44149ab747fSPaolo Bonzini MemoryRegion io[2]; 44249ab747fSPaolo Bonzini } ISAKBDState; 44349ab747fSPaolo Bonzini 44449ab747fSPaolo Bonzini void i8042_isa_mouse_fake_event(void *opaque) 44549ab747fSPaolo Bonzini { 44649ab747fSPaolo Bonzini ISADevice *dev = opaque; 447a2e0b863SAndreas Färber ISAKBDState *isa = I8042(dev); 448a2e0b863SAndreas Färber KBDState *s = &isa->kbd; 44949ab747fSPaolo Bonzini 45049ab747fSPaolo Bonzini ps2_mouse_fake_event(s->mouse); 45149ab747fSPaolo Bonzini } 45249ab747fSPaolo Bonzini 45349ab747fSPaolo Bonzini void i8042_setup_a20_line(ISADevice *dev, qemu_irq *a20_out) 45449ab747fSPaolo Bonzini { 455a2e0b863SAndreas Färber ISAKBDState *isa = I8042(dev); 456a2e0b863SAndreas Färber KBDState *s = &isa->kbd; 45749ab747fSPaolo Bonzini 45849ab747fSPaolo Bonzini s->a20_out = a20_out; 45949ab747fSPaolo Bonzini } 46049ab747fSPaolo Bonzini 46149ab747fSPaolo Bonzini static const VMStateDescription vmstate_kbd_isa = { 46249ab747fSPaolo Bonzini .name = "pckbd", 46349ab747fSPaolo Bonzini .version_id = 3, 46449ab747fSPaolo Bonzini .minimum_version_id = 3, 46549ab747fSPaolo Bonzini .minimum_version_id_old = 3, 46649ab747fSPaolo Bonzini .fields = (VMStateField []) { 46749ab747fSPaolo Bonzini VMSTATE_STRUCT(kbd, ISAKBDState, 0, vmstate_kbd, KBDState), 46849ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 46949ab747fSPaolo Bonzini } 47049ab747fSPaolo Bonzini }; 47149ab747fSPaolo Bonzini 47249ab747fSPaolo Bonzini static const MemoryRegionOps i8042_data_ops = { 47349ab747fSPaolo Bonzini .read = kbd_read_data, 47449ab747fSPaolo Bonzini .write = kbd_write_data, 47549ab747fSPaolo Bonzini .impl = { 47649ab747fSPaolo Bonzini .min_access_size = 1, 47749ab747fSPaolo Bonzini .max_access_size = 1, 47849ab747fSPaolo Bonzini }, 47949ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 48049ab747fSPaolo Bonzini }; 48149ab747fSPaolo Bonzini 48249ab747fSPaolo Bonzini static const MemoryRegionOps i8042_cmd_ops = { 48349ab747fSPaolo Bonzini .read = kbd_read_status, 48449ab747fSPaolo Bonzini .write = kbd_write_command, 48549ab747fSPaolo Bonzini .impl = { 48649ab747fSPaolo Bonzini .min_access_size = 1, 48749ab747fSPaolo Bonzini .max_access_size = 1, 48849ab747fSPaolo Bonzini }, 48949ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 49049ab747fSPaolo Bonzini }; 49149ab747fSPaolo Bonzini 492db895a1eSAndreas Färber static void i8042_initfn(Object *obj) 49349ab747fSPaolo Bonzini { 494db895a1eSAndreas Färber ISAKBDState *isa_s = I8042(obj); 495db895a1eSAndreas Färber KBDState *s = &isa_s->kbd; 496db895a1eSAndreas Färber 4971437c94bSPaolo Bonzini memory_region_init_io(isa_s->io + 0, obj, &i8042_data_ops, s, 4981437c94bSPaolo Bonzini "i8042-data", 1); 4991437c94bSPaolo Bonzini memory_region_init_io(isa_s->io + 1, obj, &i8042_cmd_ops, s, 5001437c94bSPaolo Bonzini "i8042-cmd", 1); 501db895a1eSAndreas Färber } 502db895a1eSAndreas Färber 503db895a1eSAndreas Färber static void i8042_realizefn(DeviceState *dev, Error **errp) 504db895a1eSAndreas Färber { 505db895a1eSAndreas Färber ISADevice *isadev = ISA_DEVICE(dev); 506a2e0b863SAndreas Färber ISAKBDState *isa_s = I8042(dev); 50749ab747fSPaolo Bonzini KBDState *s = &isa_s->kbd; 50849ab747fSPaolo Bonzini 509db895a1eSAndreas Färber isa_init_irq(isadev, &s->irq_kbd, 1); 510db895a1eSAndreas Färber isa_init_irq(isadev, &s->irq_mouse, 12); 51149ab747fSPaolo Bonzini 512db895a1eSAndreas Färber isa_register_ioport(isadev, isa_s->io + 0, 0x60); 513db895a1eSAndreas Färber isa_register_ioport(isadev, isa_s->io + 1, 0x64); 51449ab747fSPaolo Bonzini 51549ab747fSPaolo Bonzini s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s); 51649ab747fSPaolo Bonzini s->mouse = ps2_mouse_init(kbd_update_aux_irq, s); 51749ab747fSPaolo Bonzini qemu_register_reset(kbd_reset, s); 51849ab747fSPaolo Bonzini } 51949ab747fSPaolo Bonzini 52049ab747fSPaolo Bonzini static void i8042_class_initfn(ObjectClass *klass, void *data) 52149ab747fSPaolo Bonzini { 52249ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 523db895a1eSAndreas Färber 524db895a1eSAndreas Färber dc->realize = i8042_realizefn; 52549ab747fSPaolo Bonzini dc->vmsd = &vmstate_kbd_isa; 52649ab747fSPaolo Bonzini } 52749ab747fSPaolo Bonzini 52849ab747fSPaolo Bonzini static const TypeInfo i8042_info = { 529a2e0b863SAndreas Färber .name = TYPE_I8042, 53049ab747fSPaolo Bonzini .parent = TYPE_ISA_DEVICE, 53149ab747fSPaolo Bonzini .instance_size = sizeof(ISAKBDState), 532db895a1eSAndreas Färber .instance_init = i8042_initfn, 53349ab747fSPaolo Bonzini .class_init = i8042_class_initfn, 53449ab747fSPaolo Bonzini }; 53549ab747fSPaolo Bonzini 53649ab747fSPaolo Bonzini static void i8042_register_types(void) 53749ab747fSPaolo Bonzini { 53849ab747fSPaolo Bonzini type_register_static(&i8042_info); 53949ab747fSPaolo Bonzini } 54049ab747fSPaolo Bonzini 54149ab747fSPaolo Bonzini type_init(i8042_register_types) 542