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 */ 2471e8a915SMarkus Armbruster 250430891cSPeter Maydell #include "qemu/osdep.h" 26d1e45668SVolker Rümelin #include "qemu/error-report.h" 27c2e846bbSPhilippe Mathieu-Daudé #include "qemu/log.h" 28d1e45668SVolker Rümelin #include "qemu/timer.h" 2949ab747fSPaolo Bonzini #include "hw/isa/isa.h" 30d6454270SMarkus Armbruster #include "migration/vmstate.h" 31df0f3d13SGerd Hoffmann #include "hw/acpi/aml-build.h" 3249ab747fSPaolo Bonzini #include "hw/input/ps2.h" 3364552b6bSMarkus Armbruster #include "hw/irq.h" 3447973a2dSPhilippe Mathieu-Daudé #include "hw/input/i8042.h" 35ff6e1624SVolker Rümelin #include "hw/qdev-properties.h" 3671e8a915SMarkus Armbruster #include "sysemu/reset.h" 3754d31236SMarkus Armbruster #include "sysemu/runstate.h" 3849ab747fSPaolo Bonzini 3965b182c3SDr. David Alan Gilbert #include "trace.h" 4049ab747fSPaolo Bonzini 4149ab747fSPaolo Bonzini /* Keyboard Controller Commands */ 4249ab747fSPaolo Bonzini #define KBD_CCMD_READ_MODE 0x20 /* Read mode bits */ 4349ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_MODE 0x60 /* Write mode bits */ 4449ab747fSPaolo Bonzini #define KBD_CCMD_GET_VERSION 0xA1 /* Get controller version */ 4549ab747fSPaolo Bonzini #define KBD_CCMD_MOUSE_DISABLE 0xA7 /* Disable mouse interface */ 4649ab747fSPaolo Bonzini #define KBD_CCMD_MOUSE_ENABLE 0xA8 /* Enable mouse interface */ 4749ab747fSPaolo Bonzini #define KBD_CCMD_TEST_MOUSE 0xA9 /* Mouse interface test */ 4849ab747fSPaolo Bonzini #define KBD_CCMD_SELF_TEST 0xAA /* Controller self test */ 4949ab747fSPaolo Bonzini #define KBD_CCMD_KBD_TEST 0xAB /* Keyboard interface test */ 5049ab747fSPaolo Bonzini #define KBD_CCMD_KBD_DISABLE 0xAD /* Keyboard interface disable */ 5149ab747fSPaolo Bonzini #define KBD_CCMD_KBD_ENABLE 0xAE /* Keyboard interface enable */ 5249ab747fSPaolo Bonzini #define KBD_CCMD_READ_INPORT 0xC0 /* read input port */ 5349ab747fSPaolo Bonzini #define KBD_CCMD_READ_OUTPORT 0xD0 /* read output port */ 5449ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_OUTPORT 0xD1 /* write output port */ 5549ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_OBUF 0xD2 5649ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_AUX_OBUF 0xD3 /* Write to output buffer as if 5749ab747fSPaolo Bonzini initiated by the auxiliary device */ 5849ab747fSPaolo Bonzini #define KBD_CCMD_WRITE_MOUSE 0xD4 /* Write the following byte to the mouse */ 5949ab747fSPaolo Bonzini #define KBD_CCMD_DISABLE_A20 0xDD /* HP vectra only ? */ 6049ab747fSPaolo Bonzini #define KBD_CCMD_ENABLE_A20 0xDF /* HP vectra only ? */ 6149ab747fSPaolo Bonzini #define KBD_CCMD_PULSE_BITS_3_0 0xF0 /* Pulse bits 3-0 of the output port P2. */ 6249ab747fSPaolo Bonzini #define KBD_CCMD_RESET 0xFE /* Pulse bit 0 of the output port P2 = CPU reset. */ 6349ab747fSPaolo Bonzini #define KBD_CCMD_NO_OP 0xFF /* Pulse no bits of the output port P2. */ 6449ab747fSPaolo Bonzini 6549ab747fSPaolo Bonzini /* Keyboard Commands */ 6649ab747fSPaolo Bonzini #define KBD_CMD_SET_LEDS 0xED /* Set keyboard leds */ 6749ab747fSPaolo Bonzini #define KBD_CMD_ECHO 0xEE 6849ab747fSPaolo Bonzini #define KBD_CMD_GET_ID 0xF2 /* get keyboard ID */ 6949ab747fSPaolo Bonzini #define KBD_CMD_SET_RATE 0xF3 /* Set typematic rate */ 7049ab747fSPaolo Bonzini #define KBD_CMD_ENABLE 0xF4 /* Enable scanning */ 7149ab747fSPaolo Bonzini #define KBD_CMD_RESET_DISABLE 0xF5 /* reset and disable scanning */ 7249ab747fSPaolo Bonzini #define KBD_CMD_RESET_ENABLE 0xF6 /* reset and enable scanning */ 7349ab747fSPaolo Bonzini #define KBD_CMD_RESET 0xFF /* Reset */ 7449ab747fSPaolo Bonzini 7549ab747fSPaolo Bonzini /* Keyboard Replies */ 7649ab747fSPaolo Bonzini #define KBD_REPLY_POR 0xAA /* Power on reset */ 7749ab747fSPaolo Bonzini #define KBD_REPLY_ACK 0xFA /* Command ACK */ 7849ab747fSPaolo Bonzini #define KBD_REPLY_RESEND 0xFE /* Command NACK, send the cmd again */ 7949ab747fSPaolo Bonzini 8049ab747fSPaolo Bonzini /* Status Register Bits */ 8149ab747fSPaolo Bonzini #define KBD_STAT_OBF 0x01 /* Keyboard output buffer full */ 8249ab747fSPaolo Bonzini #define KBD_STAT_IBF 0x02 /* Keyboard input buffer full */ 8349ab747fSPaolo Bonzini #define KBD_STAT_SELFTEST 0x04 /* Self test successful */ 8449ab747fSPaolo Bonzini #define KBD_STAT_CMD 0x08 /* Last write was a command write (0=data) */ 8549ab747fSPaolo Bonzini #define KBD_STAT_UNLOCKED 0x10 /* Zero if keyboard locked */ 8649ab747fSPaolo Bonzini #define KBD_STAT_MOUSE_OBF 0x20 /* Mouse output buffer full */ 8749ab747fSPaolo Bonzini #define KBD_STAT_GTO 0x40 /* General receive/xmit timeout */ 8849ab747fSPaolo Bonzini #define KBD_STAT_PERR 0x80 /* Parity error */ 8949ab747fSPaolo Bonzini 9049ab747fSPaolo Bonzini /* Controller Mode Register Bits */ 9149ab747fSPaolo Bonzini #define KBD_MODE_KBD_INT 0x01 /* Keyboard data generate IRQ1 */ 9249ab747fSPaolo Bonzini #define KBD_MODE_MOUSE_INT 0x02 /* Mouse data generate IRQ12 */ 9349ab747fSPaolo Bonzini #define KBD_MODE_SYS 0x04 /* The system flag (?) */ 9449ab747fSPaolo Bonzini #define KBD_MODE_NO_KEYLOCK 0x08 /* The keylock doesn't affect the keyboard if set */ 9549ab747fSPaolo Bonzini #define KBD_MODE_DISABLE_KBD 0x10 /* Disable keyboard interface */ 9649ab747fSPaolo Bonzini #define KBD_MODE_DISABLE_MOUSE 0x20 /* Disable mouse interface */ 9749ab747fSPaolo Bonzini #define KBD_MODE_KCC 0x40 /* Scan code conversion to PC format */ 9849ab747fSPaolo Bonzini #define KBD_MODE_RFU 0x80 9949ab747fSPaolo Bonzini 10049ab747fSPaolo Bonzini /* Output Port Bits */ 10149ab747fSPaolo Bonzini #define KBD_OUT_RESET 0x01 /* 1=normal mode, 0=reset */ 10249ab747fSPaolo Bonzini #define KBD_OUT_A20 0x02 /* x86 only */ 10349ab747fSPaolo Bonzini #define KBD_OUT_OBF 0x10 /* Keyboard output buffer full */ 10449ab747fSPaolo Bonzini #define KBD_OUT_MOUSE_OBF 0x20 /* Mouse output buffer full */ 10549ab747fSPaolo Bonzini 106d13c0404SPaolo Bonzini /* OSes typically write 0xdd/0xdf to turn the A20 line off and on. 107d13c0404SPaolo Bonzini * We make the default value of the outport include these four bits, 108d13c0404SPaolo Bonzini * so that the subsection is rarely necessary. 109d13c0404SPaolo Bonzini */ 110d13c0404SPaolo Bonzini #define KBD_OUT_ONES 0xcc 111d13c0404SPaolo Bonzini 11249ab747fSPaolo Bonzini /* Mouse Commands */ 11349ab747fSPaolo Bonzini #define AUX_SET_SCALE11 0xE6 /* Set 1:1 scaling */ 11449ab747fSPaolo Bonzini #define AUX_SET_SCALE21 0xE7 /* Set 2:1 scaling */ 11549ab747fSPaolo Bonzini #define AUX_SET_RES 0xE8 /* Set resolution */ 11649ab747fSPaolo Bonzini #define AUX_GET_SCALE 0xE9 /* Get scaling factor */ 11749ab747fSPaolo Bonzini #define AUX_SET_STREAM 0xEA /* Set stream mode */ 11849ab747fSPaolo Bonzini #define AUX_POLL 0xEB /* Poll */ 11949ab747fSPaolo Bonzini #define AUX_RESET_WRAP 0xEC /* Reset wrap mode */ 12049ab747fSPaolo Bonzini #define AUX_SET_WRAP 0xEE /* Set wrap mode */ 12149ab747fSPaolo Bonzini #define AUX_SET_REMOTE 0xF0 /* Set remote mode */ 12249ab747fSPaolo Bonzini #define AUX_GET_TYPE 0xF2 /* Get type */ 12349ab747fSPaolo Bonzini #define AUX_SET_SAMPLE 0xF3 /* Set sample rate */ 12449ab747fSPaolo Bonzini #define AUX_ENABLE_DEV 0xF4 /* Enable aux device */ 12549ab747fSPaolo Bonzini #define AUX_DISABLE_DEV 0xF5 /* Disable aux device */ 12649ab747fSPaolo Bonzini #define AUX_SET_DEFAULT 0xF6 12749ab747fSPaolo Bonzini #define AUX_RESET 0xFF /* Reset aux device */ 12849ab747fSPaolo Bonzini #define AUX_ACK 0xFA /* Command byte ACK. */ 12949ab747fSPaolo Bonzini 13049ab747fSPaolo Bonzini #define MOUSE_STATUS_REMOTE 0x40 13149ab747fSPaolo Bonzini #define MOUSE_STATUS_ENABLED 0x20 13249ab747fSPaolo Bonzini #define MOUSE_STATUS_SCALE21 0x10 13349ab747fSPaolo Bonzini 134*f6f57a82SVolker Rümelin #define KBD_PENDING_KBD_COMPAT 0x01 135*f6f57a82SVolker Rümelin #define KBD_PENDING_AUX_COMPAT 0x02 136aa67a42fSVolker Rümelin #define KBD_PENDING_CTRL_KBD 0x04 137aa67a42fSVolker Rümelin #define KBD_PENDING_CTRL_AUX 0x08 138*f6f57a82SVolker Rümelin #define KBD_PENDING_KBD KBD_MODE_DISABLE_KBD /* 0x10 */ 139*f6f57a82SVolker Rümelin #define KBD_PENDING_AUX KBD_MODE_DISABLE_MOUSE /* 0x20 */ 14049ab747fSPaolo Bonzini 141d1e45668SVolker Rümelin #define KBD_MIGR_TIMER_PENDING 0x1 142d1e45668SVolker Rümelin 143ac9192bdSVolker Rümelin #define KBD_OBSRC_KBD 0x01 144ac9192bdSVolker Rümelin #define KBD_OBSRC_MOUSE 0x02 145aa67a42fSVolker Rümelin #define KBD_OBSRC_CTRL 0x04 146ac9192bdSVolker Rümelin 14749ab747fSPaolo Bonzini typedef struct KBDState { 14849ab747fSPaolo Bonzini uint8_t write_cmd; /* if non zero, write data to port 60 is expected */ 14949ab747fSPaolo Bonzini uint8_t status; 15049ab747fSPaolo Bonzini uint8_t mode; 15149ab747fSPaolo Bonzini uint8_t outport; 152d1e45668SVolker Rümelin uint32_t migration_flags; 153ac9192bdSVolker Rümelin uint32_t obsrc; 154a28fe7e3SPavel Dovgalyuk bool outport_present; 155ff6e1624SVolker Rümelin bool extended_state; 156ac9192bdSVolker Rümelin bool extended_state_loaded; 15749ab747fSPaolo Bonzini /* Bitmask of devices with data available. */ 15849ab747fSPaolo Bonzini uint8_t pending; 159ff6e1624SVolker Rümelin uint8_t obdata; 160aa67a42fSVolker Rümelin uint8_t cbdata; 161*f6f57a82SVolker Rümelin uint8_t pending_tmp; 16249ab747fSPaolo Bonzini void *kbd; 16349ab747fSPaolo Bonzini void *mouse; 164d1e45668SVolker Rümelin QEMUTimer *throttle_timer; 16549ab747fSPaolo Bonzini 16649ab747fSPaolo Bonzini qemu_irq irq_kbd; 16749ab747fSPaolo Bonzini qemu_irq irq_mouse; 1683115b9e2SEfimov Vasily qemu_irq a20_out; 16949ab747fSPaolo Bonzini hwaddr mask; 17049ab747fSPaolo Bonzini } KBDState; 17149ab747fSPaolo Bonzini 17249ab747fSPaolo Bonzini /* XXX: not generating the irqs if KBD_MODE_DISABLE_KBD is set may be 17349ab747fSPaolo Bonzini incorrect, but it avoids having to simulate exact delays */ 174c3c4a961SVolker Rümelin static void kbd_update_irq_lines(KBDState *s) 17549ab747fSPaolo Bonzini { 17649ab747fSPaolo Bonzini int irq_kbd_level, irq_mouse_level; 17749ab747fSPaolo Bonzini 17849ab747fSPaolo Bonzini irq_kbd_level = 0; 17949ab747fSPaolo Bonzini irq_mouse_level = 0; 180c3c4a961SVolker Rümelin 181c3c4a961SVolker Rümelin if (s->status & KBD_STAT_OBF) { 182c3c4a961SVolker Rümelin if (s->status & KBD_STAT_MOUSE_OBF) { 183c3c4a961SVolker Rümelin if (s->mode & KBD_MODE_MOUSE_INT) { 184c3c4a961SVolker Rümelin irq_mouse_level = 1; 185c3c4a961SVolker Rümelin } 186c3c4a961SVolker Rümelin } else { 187c3c4a961SVolker Rümelin if ((s->mode & KBD_MODE_KBD_INT) && 188c3c4a961SVolker Rümelin !(s->mode & KBD_MODE_DISABLE_KBD)) { 189c3c4a961SVolker Rümelin irq_kbd_level = 1; 190c3c4a961SVolker Rümelin } 191c3c4a961SVolker Rümelin } 192c3c4a961SVolker Rümelin } 193c3c4a961SVolker Rümelin qemu_set_irq(s->irq_kbd, irq_kbd_level); 194c3c4a961SVolker Rümelin qemu_set_irq(s->irq_mouse, irq_mouse_level); 195c3c4a961SVolker Rümelin } 196c3c4a961SVolker Rümelin 197ff6e1624SVolker Rümelin static void kbd_deassert_irq(KBDState *s) 198ff6e1624SVolker Rümelin { 199ff6e1624SVolker Rümelin s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF); 200ff6e1624SVolker Rümelin s->outport &= ~(KBD_OUT_OBF | KBD_OUT_MOUSE_OBF); 201ff6e1624SVolker Rümelin kbd_update_irq_lines(s); 202ff6e1624SVolker Rümelin } 203ff6e1624SVolker Rümelin 204e4697fabSVolker Rümelin static uint8_t kbd_pending(KBDState *s) 205e4697fabSVolker Rümelin { 206*f6f57a82SVolker Rümelin if (s->extended_state) { 207*f6f57a82SVolker Rümelin return s->pending & (~s->mode | ~(KBD_PENDING_KBD | KBD_PENDING_AUX)); 208*f6f57a82SVolker Rümelin } else { 209e4697fabSVolker Rümelin return s->pending; 210e4697fabSVolker Rümelin } 211*f6f57a82SVolker Rümelin } 212e4697fabSVolker Rümelin 213c3c4a961SVolker Rümelin /* update irq and KBD_STAT_[MOUSE_]OBF */ 214c3c4a961SVolker Rümelin static void kbd_update_irq(KBDState *s) 215c3c4a961SVolker Rümelin { 216e4697fabSVolker Rümelin uint8_t pending = kbd_pending(s); 217e4697fabSVolker Rümelin 21849ab747fSPaolo Bonzini s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF); 21949ab747fSPaolo Bonzini s->outport &= ~(KBD_OUT_OBF | KBD_OUT_MOUSE_OBF); 220e4697fabSVolker Rümelin if (pending) { 22149ab747fSPaolo Bonzini s->status |= KBD_STAT_OBF; 22249ab747fSPaolo Bonzini s->outport |= KBD_OUT_OBF; 223e4697fabSVolker Rümelin if (pending & KBD_PENDING_CTRL_KBD) { 224aa67a42fSVolker Rümelin s->obsrc = KBD_OBSRC_CTRL; 225e4697fabSVolker Rümelin } else if (pending & KBD_PENDING_CTRL_AUX) { 226aa67a42fSVolker Rümelin s->status |= KBD_STAT_MOUSE_OBF; 227aa67a42fSVolker Rümelin s->outport |= KBD_OUT_MOUSE_OBF; 228aa67a42fSVolker Rümelin s->obsrc = KBD_OBSRC_CTRL; 229e4697fabSVolker Rümelin } else if (pending & KBD_PENDING_KBD) { 230aa67a42fSVolker Rümelin s->obsrc = KBD_OBSRC_KBD; 231aa67a42fSVolker Rümelin } else { 23249ab747fSPaolo Bonzini s->status |= KBD_STAT_MOUSE_OBF; 23349ab747fSPaolo Bonzini s->outport |= KBD_OUT_MOUSE_OBF; 234ac9192bdSVolker Rümelin s->obsrc = KBD_OBSRC_MOUSE; 23549ab747fSPaolo Bonzini } 23649ab747fSPaolo Bonzini } 237c3c4a961SVolker Rümelin kbd_update_irq_lines(s); 23849ab747fSPaolo Bonzini } 23949ab747fSPaolo Bonzini 240ff6e1624SVolker Rümelin static void kbd_safe_update_irq(KBDState *s) 241ff6e1624SVolker Rümelin { 242ff6e1624SVolker Rümelin /* 243ff6e1624SVolker Rümelin * with KBD_STAT_OBF set, a call to kbd_read_data() will eventually call 244ff6e1624SVolker Rümelin * kbd_update_irq() 245ff6e1624SVolker Rümelin */ 246ff6e1624SVolker Rümelin if (s->status & KBD_STAT_OBF) { 247ff6e1624SVolker Rümelin return; 248ff6e1624SVolker Rümelin } 249d1e45668SVolker Rümelin /* the throttle timer is pending and will call kbd_update_irq() */ 250d1e45668SVolker Rümelin if (s->throttle_timer && timer_pending(s->throttle_timer)) { 251d1e45668SVolker Rümelin return; 252d1e45668SVolker Rümelin } 253e4697fabSVolker Rümelin if (kbd_pending(s)) { 254ff6e1624SVolker Rümelin kbd_update_irq(s); 255ff6e1624SVolker Rümelin } 256ff6e1624SVolker Rümelin } 257ff6e1624SVolker Rümelin 25849ab747fSPaolo Bonzini static void kbd_update_kbd_irq(void *opaque, int level) 25949ab747fSPaolo Bonzini { 260ff6e1624SVolker Rümelin KBDState *s = opaque; 26149ab747fSPaolo Bonzini 262ff6e1624SVolker Rümelin if (level) { 26349ab747fSPaolo Bonzini s->pending |= KBD_PENDING_KBD; 264ff6e1624SVolker Rümelin } else { 26549ab747fSPaolo Bonzini s->pending &= ~KBD_PENDING_KBD; 266ff6e1624SVolker Rümelin } 267ff6e1624SVolker Rümelin kbd_safe_update_irq(s); 26849ab747fSPaolo Bonzini } 26949ab747fSPaolo Bonzini 27049ab747fSPaolo Bonzini static void kbd_update_aux_irq(void *opaque, int level) 27149ab747fSPaolo Bonzini { 272ff6e1624SVolker Rümelin KBDState *s = opaque; 27349ab747fSPaolo Bonzini 274ff6e1624SVolker Rümelin if (level) { 27549ab747fSPaolo Bonzini s->pending |= KBD_PENDING_AUX; 276ff6e1624SVolker Rümelin } else { 27749ab747fSPaolo Bonzini s->pending &= ~KBD_PENDING_AUX; 278ff6e1624SVolker Rümelin } 279ff6e1624SVolker Rümelin kbd_safe_update_irq(s); 28049ab747fSPaolo Bonzini } 28149ab747fSPaolo Bonzini 282d1e45668SVolker Rümelin static void kbd_throttle_timeout(void *opaque) 283d1e45668SVolker Rümelin { 284d1e45668SVolker Rümelin KBDState *s = opaque; 285d1e45668SVolker Rümelin 286e4697fabSVolker Rümelin if (kbd_pending(s)) { 287d1e45668SVolker Rümelin kbd_update_irq(s); 288d1e45668SVolker Rümelin } 289d1e45668SVolker Rümelin } 290d1e45668SVolker Rümelin 29149ab747fSPaolo Bonzini static uint64_t kbd_read_status(void *opaque, hwaddr addr, 29249ab747fSPaolo Bonzini unsigned size) 29349ab747fSPaolo Bonzini { 29449ab747fSPaolo Bonzini KBDState *s = opaque; 29549ab747fSPaolo Bonzini int val; 29649ab747fSPaolo Bonzini val = s->status; 29765b182c3SDr. David Alan Gilbert trace_pckbd_kbd_read_status(val); 29849ab747fSPaolo Bonzini return val; 29949ab747fSPaolo Bonzini } 30049ab747fSPaolo Bonzini 30149ab747fSPaolo Bonzini static void kbd_queue(KBDState *s, int b, int aux) 30249ab747fSPaolo Bonzini { 303aa67a42fSVolker Rümelin if (s->extended_state) { 304aa67a42fSVolker Rümelin s->cbdata = b; 305aa67a42fSVolker Rümelin s->pending &= ~KBD_PENDING_CTRL_KBD & ~KBD_PENDING_CTRL_AUX; 306aa67a42fSVolker Rümelin s->pending |= aux ? KBD_PENDING_CTRL_AUX : KBD_PENDING_CTRL_KBD; 307aa67a42fSVolker Rümelin kbd_safe_update_irq(s); 308aa67a42fSVolker Rümelin } else { 309aa67a42fSVolker Rümelin ps2_queue(aux ? s->mouse : s->kbd, b); 310aa67a42fSVolker Rümelin } 311aa67a42fSVolker Rümelin } 312aa67a42fSVolker Rümelin 313aa67a42fSVolker Rümelin static uint8_t kbd_dequeue(KBDState *s) 314aa67a42fSVolker Rümelin { 315aa67a42fSVolker Rümelin uint8_t b = s->cbdata; 316aa67a42fSVolker Rümelin 317aa67a42fSVolker Rümelin s->pending &= ~KBD_PENDING_CTRL_KBD & ~KBD_PENDING_CTRL_AUX; 318e4697fabSVolker Rümelin if (kbd_pending(s)) { 319aa67a42fSVolker Rümelin kbd_update_irq(s); 320aa67a42fSVolker Rümelin } 321aa67a42fSVolker Rümelin return b; 32249ab747fSPaolo Bonzini } 32349ab747fSPaolo Bonzini 32449ab747fSPaolo Bonzini static void outport_write(KBDState *s, uint32_t val) 32549ab747fSPaolo Bonzini { 32665b182c3SDr. David Alan Gilbert trace_pckbd_outport_write(val); 32749ab747fSPaolo Bonzini s->outport = val; 3283115b9e2SEfimov Vasily qemu_set_irq(s->a20_out, (val >> 1) & 1); 32949ab747fSPaolo Bonzini if (!(val & 1)) { 330cf83f140SEric Blake qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET); 33149ab747fSPaolo Bonzini } 33249ab747fSPaolo Bonzini } 33349ab747fSPaolo Bonzini 33449ab747fSPaolo Bonzini static void kbd_write_command(void *opaque, hwaddr addr, 33549ab747fSPaolo Bonzini uint64_t val, unsigned size) 33649ab747fSPaolo Bonzini { 33749ab747fSPaolo Bonzini KBDState *s = opaque; 33849ab747fSPaolo Bonzini 33965b182c3SDr. David Alan Gilbert trace_pckbd_kbd_write_command(val); 34049ab747fSPaolo Bonzini 34149ab747fSPaolo Bonzini /* Bits 3-0 of the output port P2 of the keyboard controller may be pulsed 34249ab747fSPaolo Bonzini * low for approximately 6 micro seconds. Bits 3-0 of the KBD_CCMD_PULSE 34349ab747fSPaolo Bonzini * command specify the output port bits to be pulsed. 34449ab747fSPaolo Bonzini * 0: Bit should be pulsed. 1: Bit should not be modified. 34549ab747fSPaolo Bonzini * The only useful version of this command is pulsing bit 0, 34649ab747fSPaolo Bonzini * which does a CPU reset. 34749ab747fSPaolo Bonzini */ 34849ab747fSPaolo Bonzini if((val & KBD_CCMD_PULSE_BITS_3_0) == KBD_CCMD_PULSE_BITS_3_0) { 34949ab747fSPaolo Bonzini if(!(val & 1)) 35049ab747fSPaolo Bonzini val = KBD_CCMD_RESET; 35149ab747fSPaolo Bonzini else 35249ab747fSPaolo Bonzini val = KBD_CCMD_NO_OP; 35349ab747fSPaolo Bonzini } 35449ab747fSPaolo Bonzini 35549ab747fSPaolo Bonzini switch(val) { 35649ab747fSPaolo Bonzini case KBD_CCMD_READ_MODE: 35749ab747fSPaolo Bonzini kbd_queue(s, s->mode, 0); 35849ab747fSPaolo Bonzini break; 35949ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MODE: 36049ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OBUF: 36149ab747fSPaolo Bonzini case KBD_CCMD_WRITE_AUX_OBUF: 36249ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MOUSE: 36349ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OUTPORT: 36449ab747fSPaolo Bonzini s->write_cmd = val; 36549ab747fSPaolo Bonzini break; 36649ab747fSPaolo Bonzini case KBD_CCMD_MOUSE_DISABLE: 36749ab747fSPaolo Bonzini s->mode |= KBD_MODE_DISABLE_MOUSE; 36849ab747fSPaolo Bonzini break; 36949ab747fSPaolo Bonzini case KBD_CCMD_MOUSE_ENABLE: 37049ab747fSPaolo Bonzini s->mode &= ~KBD_MODE_DISABLE_MOUSE; 371*f6f57a82SVolker Rümelin kbd_safe_update_irq(s); 37249ab747fSPaolo Bonzini break; 37349ab747fSPaolo Bonzini case KBD_CCMD_TEST_MOUSE: 37449ab747fSPaolo Bonzini kbd_queue(s, 0x00, 0); 37549ab747fSPaolo Bonzini break; 37649ab747fSPaolo Bonzini case KBD_CCMD_SELF_TEST: 37749ab747fSPaolo Bonzini s->status |= KBD_STAT_SELFTEST; 37849ab747fSPaolo Bonzini kbd_queue(s, 0x55, 0); 37949ab747fSPaolo Bonzini break; 38049ab747fSPaolo Bonzini case KBD_CCMD_KBD_TEST: 38149ab747fSPaolo Bonzini kbd_queue(s, 0x00, 0); 38249ab747fSPaolo Bonzini break; 38349ab747fSPaolo Bonzini case KBD_CCMD_KBD_DISABLE: 38449ab747fSPaolo Bonzini s->mode |= KBD_MODE_DISABLE_KBD; 38549ab747fSPaolo Bonzini break; 38649ab747fSPaolo Bonzini case KBD_CCMD_KBD_ENABLE: 38749ab747fSPaolo Bonzini s->mode &= ~KBD_MODE_DISABLE_KBD; 388ff6e1624SVolker Rümelin kbd_safe_update_irq(s); 38949ab747fSPaolo Bonzini break; 39049ab747fSPaolo Bonzini case KBD_CCMD_READ_INPORT: 391f1b7e0e4SHervé Poussineau kbd_queue(s, 0x80, 0); 39249ab747fSPaolo Bonzini break; 39349ab747fSPaolo Bonzini case KBD_CCMD_READ_OUTPORT: 39449ab747fSPaolo Bonzini kbd_queue(s, s->outport, 0); 39549ab747fSPaolo Bonzini break; 39649ab747fSPaolo Bonzini case KBD_CCMD_ENABLE_A20: 3973115b9e2SEfimov Vasily qemu_irq_raise(s->a20_out); 39849ab747fSPaolo Bonzini s->outport |= KBD_OUT_A20; 39949ab747fSPaolo Bonzini break; 40049ab747fSPaolo Bonzini case KBD_CCMD_DISABLE_A20: 4013115b9e2SEfimov Vasily qemu_irq_lower(s->a20_out); 40249ab747fSPaolo Bonzini s->outport &= ~KBD_OUT_A20; 40349ab747fSPaolo Bonzini break; 40449ab747fSPaolo Bonzini case KBD_CCMD_RESET: 405cf83f140SEric Blake qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET); 40649ab747fSPaolo Bonzini break; 40749ab747fSPaolo Bonzini case KBD_CCMD_NO_OP: 40849ab747fSPaolo Bonzini /* ignore that */ 40949ab747fSPaolo Bonzini break; 41049ab747fSPaolo Bonzini default: 411c2e846bbSPhilippe Mathieu-Daudé qemu_log_mask(LOG_GUEST_ERROR, 412c2e846bbSPhilippe Mathieu-Daudé "unsupported keyboard cmd=0x%02" PRIx64 "\n", val); 41349ab747fSPaolo Bonzini break; 41449ab747fSPaolo Bonzini } 41549ab747fSPaolo Bonzini } 41649ab747fSPaolo Bonzini 41749ab747fSPaolo Bonzini static uint64_t kbd_read_data(void *opaque, hwaddr addr, 41849ab747fSPaolo Bonzini unsigned size) 41949ab747fSPaolo Bonzini { 42049ab747fSPaolo Bonzini KBDState *s = opaque; 42149ab747fSPaolo Bonzini 422ac9192bdSVolker Rümelin if (s->status & KBD_STAT_OBF) { 423ff6e1624SVolker Rümelin kbd_deassert_irq(s); 424ac9192bdSVolker Rümelin if (s->obsrc & KBD_OBSRC_KBD) { 425d1e45668SVolker Rümelin if (s->throttle_timer) { 426d1e45668SVolker Rümelin timer_mod(s->throttle_timer, 427d1e45668SVolker Rümelin qemu_clock_get_us(QEMU_CLOCK_VIRTUAL) + 1000); 428d1e45668SVolker Rümelin } 429ff6e1624SVolker Rümelin s->obdata = ps2_read_data(s->kbd); 430ac9192bdSVolker Rümelin } else if (s->obsrc & KBD_OBSRC_MOUSE) { 431ac9192bdSVolker Rümelin s->obdata = ps2_read_data(s->mouse); 432aa67a42fSVolker Rümelin } else if (s->obsrc & KBD_OBSRC_CTRL) { 433aa67a42fSVolker Rümelin s->obdata = kbd_dequeue(s); 434ff6e1624SVolker Rümelin } 435ff6e1624SVolker Rümelin } 43649ab747fSPaolo Bonzini 437ff6e1624SVolker Rümelin trace_pckbd_kbd_read_data(s->obdata); 438ff6e1624SVolker Rümelin return s->obdata; 43949ab747fSPaolo Bonzini } 44049ab747fSPaolo Bonzini 44149ab747fSPaolo Bonzini static void kbd_write_data(void *opaque, hwaddr addr, 44249ab747fSPaolo Bonzini uint64_t val, unsigned size) 44349ab747fSPaolo Bonzini { 44449ab747fSPaolo Bonzini KBDState *s = opaque; 44549ab747fSPaolo Bonzini 44665b182c3SDr. David Alan Gilbert trace_pckbd_kbd_write_data(val); 44749ab747fSPaolo Bonzini 44849ab747fSPaolo Bonzini switch(s->write_cmd) { 44949ab747fSPaolo Bonzini case 0: 45049ab747fSPaolo Bonzini ps2_write_keyboard(s->kbd, val); 451*f6f57a82SVolker Rümelin /* sending data to the keyboard reenables PS/2 communication */ 452*f6f57a82SVolker Rümelin s->mode &= ~KBD_MODE_DISABLE_KBD; 453*f6f57a82SVolker Rümelin kbd_safe_update_irq(s); 45449ab747fSPaolo Bonzini break; 45549ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MODE: 45649ab747fSPaolo Bonzini s->mode = val; 45749ab747fSPaolo Bonzini ps2_keyboard_set_translation(s->kbd, (s->mode & KBD_MODE_KCC) != 0); 458ff6e1624SVolker Rümelin /* 459ff6e1624SVolker Rümelin * a write to the mode byte interrupt enable flags directly updates 460ff6e1624SVolker Rümelin * the irq lines 461ff6e1624SVolker Rümelin */ 462ff6e1624SVolker Rümelin kbd_update_irq_lines(s); 463ff6e1624SVolker Rümelin /* 464ff6e1624SVolker Rümelin * a write to the mode byte disable interface flags may raise 465ff6e1624SVolker Rümelin * an irq if there is pending data in the PS/2 queues. 466ff6e1624SVolker Rümelin */ 467ff6e1624SVolker Rümelin kbd_safe_update_irq(s); 46849ab747fSPaolo Bonzini break; 46949ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OBUF: 47049ab747fSPaolo Bonzini kbd_queue(s, val, 0); 47149ab747fSPaolo Bonzini break; 47249ab747fSPaolo Bonzini case KBD_CCMD_WRITE_AUX_OBUF: 47349ab747fSPaolo Bonzini kbd_queue(s, val, 1); 47449ab747fSPaolo Bonzini break; 47549ab747fSPaolo Bonzini case KBD_CCMD_WRITE_OUTPORT: 47649ab747fSPaolo Bonzini outport_write(s, val); 47749ab747fSPaolo Bonzini break; 47849ab747fSPaolo Bonzini case KBD_CCMD_WRITE_MOUSE: 47949ab747fSPaolo Bonzini ps2_write_mouse(s->mouse, val); 480*f6f57a82SVolker Rümelin /* sending data to the mouse reenables PS/2 communication */ 481*f6f57a82SVolker Rümelin s->mode &= ~KBD_MODE_DISABLE_MOUSE; 482*f6f57a82SVolker Rümelin kbd_safe_update_irq(s); 48349ab747fSPaolo Bonzini break; 48449ab747fSPaolo Bonzini default: 48549ab747fSPaolo Bonzini break; 48649ab747fSPaolo Bonzini } 48749ab747fSPaolo Bonzini s->write_cmd = 0; 48849ab747fSPaolo Bonzini } 48949ab747fSPaolo Bonzini 49049ab747fSPaolo Bonzini static void kbd_reset(void *opaque) 49149ab747fSPaolo Bonzini { 49249ab747fSPaolo Bonzini KBDState *s = opaque; 49349ab747fSPaolo Bonzini 49449ab747fSPaolo Bonzini s->mode = KBD_MODE_KBD_INT | KBD_MODE_MOUSE_INT; 49549ab747fSPaolo Bonzini s->status = KBD_STAT_CMD | KBD_STAT_UNLOCKED; 496d13c0404SPaolo Bonzini s->outport = KBD_OUT_RESET | KBD_OUT_A20 | KBD_OUT_ONES; 497a28fe7e3SPavel Dovgalyuk s->outport_present = false; 498ff6e1624SVolker Rümelin s->pending = 0; 499ff6e1624SVolker Rümelin kbd_deassert_irq(s); 500d1e45668SVolker Rümelin if (s->throttle_timer) { 501d1e45668SVolker Rümelin timer_del(s->throttle_timer); 502d1e45668SVolker Rümelin } 503a28fe7e3SPavel Dovgalyuk } 504a28fe7e3SPavel Dovgalyuk 505a28fe7e3SPavel Dovgalyuk static uint8_t kbd_outport_default(KBDState *s) 506a28fe7e3SPavel Dovgalyuk { 507d13c0404SPaolo Bonzini return KBD_OUT_RESET | KBD_OUT_A20 | KBD_OUT_ONES 508a28fe7e3SPavel Dovgalyuk | (s->status & KBD_STAT_OBF ? KBD_OUT_OBF : 0) 509a28fe7e3SPavel Dovgalyuk | (s->status & KBD_STAT_MOUSE_OBF ? KBD_OUT_MOUSE_OBF : 0); 510a28fe7e3SPavel Dovgalyuk } 511a28fe7e3SPavel Dovgalyuk 512a28fe7e3SPavel Dovgalyuk static int kbd_outport_post_load(void *opaque, int version_id) 513a28fe7e3SPavel Dovgalyuk { 514a28fe7e3SPavel Dovgalyuk KBDState *s = opaque; 515a28fe7e3SPavel Dovgalyuk s->outport_present = true; 516a28fe7e3SPavel Dovgalyuk return 0; 517a28fe7e3SPavel Dovgalyuk } 518a28fe7e3SPavel Dovgalyuk 519a28fe7e3SPavel Dovgalyuk static bool kbd_outport_needed(void *opaque) 520a28fe7e3SPavel Dovgalyuk { 521a28fe7e3SPavel Dovgalyuk KBDState *s = opaque; 522a28fe7e3SPavel Dovgalyuk return s->outport != kbd_outport_default(s); 523a28fe7e3SPavel Dovgalyuk } 524a28fe7e3SPavel Dovgalyuk 5255cd8cadaSJuan Quintela static const VMStateDescription vmstate_kbd_outport = { 5265cd8cadaSJuan Quintela .name = "pckbd_outport", 5275cd8cadaSJuan Quintela .version_id = 1, 5285cd8cadaSJuan Quintela .minimum_version_id = 1, 5295cd8cadaSJuan Quintela .post_load = kbd_outport_post_load, 5305cd8cadaSJuan Quintela .needed = kbd_outport_needed, 5315cd8cadaSJuan Quintela .fields = (VMStateField[]) { 5325cd8cadaSJuan Quintela VMSTATE_UINT8(outport, KBDState), 5335cd8cadaSJuan Quintela VMSTATE_END_OF_LIST() 5345cd8cadaSJuan Quintela } 5355cd8cadaSJuan Quintela }; 5365cd8cadaSJuan Quintela 537d1e45668SVolker Rümelin static int kbd_extended_state_pre_save(void *opaque) 538d1e45668SVolker Rümelin { 539d1e45668SVolker Rümelin KBDState *s = opaque; 540d1e45668SVolker Rümelin 541d1e45668SVolker Rümelin s->migration_flags = 0; 542d1e45668SVolker Rümelin if (s->throttle_timer && timer_pending(s->throttle_timer)) { 543d1e45668SVolker Rümelin s->migration_flags |= KBD_MIGR_TIMER_PENDING; 544d1e45668SVolker Rümelin } 545d1e45668SVolker Rümelin 546d1e45668SVolker Rümelin return 0; 547d1e45668SVolker Rümelin } 548d1e45668SVolker Rümelin 549d1e45668SVolker Rümelin static int kbd_extended_state_post_load(void *opaque, int version_id) 550d1e45668SVolker Rümelin { 551d1e45668SVolker Rümelin KBDState *s = opaque; 552d1e45668SVolker Rümelin 553d1e45668SVolker Rümelin if (s->migration_flags & KBD_MIGR_TIMER_PENDING) { 554d1e45668SVolker Rümelin kbd_throttle_timeout(s); 555d1e45668SVolker Rümelin } 556ac9192bdSVolker Rümelin s->extended_state_loaded = true; 557d1e45668SVolker Rümelin 558d1e45668SVolker Rümelin return 0; 559d1e45668SVolker Rümelin } 560d1e45668SVolker Rümelin 561ff6e1624SVolker Rümelin static bool kbd_extended_state_needed(void *opaque) 562ff6e1624SVolker Rümelin { 563ff6e1624SVolker Rümelin KBDState *s = opaque; 564ff6e1624SVolker Rümelin 565ff6e1624SVolker Rümelin return s->extended_state; 566ff6e1624SVolker Rümelin } 567ff6e1624SVolker Rümelin 568ff6e1624SVolker Rümelin static const VMStateDescription vmstate_kbd_extended_state = { 569ff6e1624SVolker Rümelin .name = "pckbd/extended_state", 570d1e45668SVolker Rümelin .post_load = kbd_extended_state_post_load, 571d1e45668SVolker Rümelin .pre_save = kbd_extended_state_pre_save, 572ff6e1624SVolker Rümelin .needed = kbd_extended_state_needed, 573ff6e1624SVolker Rümelin .fields = (VMStateField[]) { 574d1e45668SVolker Rümelin VMSTATE_UINT32(migration_flags, KBDState), 575ac9192bdSVolker Rümelin VMSTATE_UINT32(obsrc, KBDState), 576ff6e1624SVolker Rümelin VMSTATE_UINT8(obdata, KBDState), 577aa67a42fSVolker Rümelin VMSTATE_UINT8(cbdata, KBDState), 578ff6e1624SVolker Rümelin VMSTATE_END_OF_LIST() 579ff6e1624SVolker Rümelin } 580ff6e1624SVolker Rümelin }; 581ff6e1624SVolker Rümelin 582*f6f57a82SVolker Rümelin static int kbd_pre_save(void *opaque) 583*f6f57a82SVolker Rümelin { 584*f6f57a82SVolker Rümelin KBDState *s = opaque; 585*f6f57a82SVolker Rümelin 586*f6f57a82SVolker Rümelin if (s->extended_state) { 587*f6f57a82SVolker Rümelin s->pending_tmp = s->pending; 588*f6f57a82SVolker Rümelin } else { 589*f6f57a82SVolker Rümelin s->pending_tmp = 0; 590*f6f57a82SVolker Rümelin if (s->pending & KBD_PENDING_KBD) { 591*f6f57a82SVolker Rümelin s->pending_tmp |= KBD_PENDING_KBD_COMPAT; 592*f6f57a82SVolker Rümelin } 593*f6f57a82SVolker Rümelin if (s->pending & KBD_PENDING_AUX) { 594*f6f57a82SVolker Rümelin s->pending_tmp |= KBD_PENDING_AUX_COMPAT; 595*f6f57a82SVolker Rümelin } 596*f6f57a82SVolker Rümelin } 597*f6f57a82SVolker Rümelin return 0; 598*f6f57a82SVolker Rümelin } 599*f6f57a82SVolker Rümelin 600ac9192bdSVolker Rümelin static int kbd_pre_load(void *opaque) 601ac9192bdSVolker Rümelin { 602ac9192bdSVolker Rümelin KBDState *s = opaque; 603ac9192bdSVolker Rümelin 604ac9192bdSVolker Rümelin s->extended_state_loaded = false; 605ac9192bdSVolker Rümelin return 0; 606ac9192bdSVolker Rümelin } 607ac9192bdSVolker Rümelin 608a28fe7e3SPavel Dovgalyuk static int kbd_post_load(void *opaque, int version_id) 609a28fe7e3SPavel Dovgalyuk { 610a28fe7e3SPavel Dovgalyuk KBDState *s = opaque; 611a28fe7e3SPavel Dovgalyuk if (!s->outport_present) { 612a28fe7e3SPavel Dovgalyuk s->outport = kbd_outport_default(s); 613a28fe7e3SPavel Dovgalyuk } 614a28fe7e3SPavel Dovgalyuk s->outport_present = false; 615*f6f57a82SVolker Rümelin s->pending = s->pending_tmp; 616ac9192bdSVolker Rümelin if (!s->extended_state_loaded) { 617ac9192bdSVolker Rümelin s->obsrc = s->status & KBD_STAT_OBF ? 618ac9192bdSVolker Rümelin (s->status & KBD_STAT_MOUSE_OBF ? KBD_OBSRC_MOUSE : KBD_OBSRC_KBD) : 619ac9192bdSVolker Rümelin 0; 620*f6f57a82SVolker Rümelin if (s->pending & KBD_PENDING_KBD_COMPAT) { 621*f6f57a82SVolker Rümelin s->pending |= KBD_PENDING_KBD; 622ac9192bdSVolker Rümelin } 623*f6f57a82SVolker Rümelin if (s->pending & KBD_PENDING_AUX_COMPAT) { 624*f6f57a82SVolker Rümelin s->pending |= KBD_PENDING_AUX; 625*f6f57a82SVolker Rümelin } 626*f6f57a82SVolker Rümelin } 627*f6f57a82SVolker Rümelin /* clear all unused flags */ 628*f6f57a82SVolker Rümelin s->pending &= KBD_PENDING_CTRL_KBD | KBD_PENDING_CTRL_AUX | 629*f6f57a82SVolker Rümelin KBD_PENDING_KBD | KBD_PENDING_AUX; 630a28fe7e3SPavel Dovgalyuk return 0; 63149ab747fSPaolo Bonzini } 63249ab747fSPaolo Bonzini 63349ab747fSPaolo Bonzini static const VMStateDescription vmstate_kbd = { 63449ab747fSPaolo Bonzini .name = "pckbd", 63549ab747fSPaolo Bonzini .version_id = 3, 63649ab747fSPaolo Bonzini .minimum_version_id = 3, 637ac9192bdSVolker Rümelin .pre_load = kbd_pre_load, 638a28fe7e3SPavel Dovgalyuk .post_load = kbd_post_load, 639*f6f57a82SVolker Rümelin .pre_save = kbd_pre_save, 64049ab747fSPaolo Bonzini .fields = (VMStateField[]) { 64149ab747fSPaolo Bonzini VMSTATE_UINT8(write_cmd, KBDState), 64249ab747fSPaolo Bonzini VMSTATE_UINT8(status, KBDState), 64349ab747fSPaolo Bonzini VMSTATE_UINT8(mode, KBDState), 644*f6f57a82SVolker Rümelin VMSTATE_UINT8(pending_tmp, KBDState), 64549ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 646a28fe7e3SPavel Dovgalyuk }, 6475cd8cadaSJuan Quintela .subsections = (const VMStateDescription*[]) { 6485cd8cadaSJuan Quintela &vmstate_kbd_outport, 649ff6e1624SVolker Rümelin &vmstate_kbd_extended_state, 6505cd8cadaSJuan Quintela NULL 65149ab747fSPaolo Bonzini } 65249ab747fSPaolo Bonzini }; 65349ab747fSPaolo Bonzini 65449ab747fSPaolo Bonzini /* Memory mapped interface */ 6555876503cSPeter Maydell static uint64_t kbd_mm_readfn(void *opaque, hwaddr addr, unsigned size) 65649ab747fSPaolo Bonzini { 65749ab747fSPaolo Bonzini KBDState *s = opaque; 65849ab747fSPaolo Bonzini 65949ab747fSPaolo Bonzini if (addr & s->mask) 66049ab747fSPaolo Bonzini return kbd_read_status(s, 0, 1) & 0xff; 66149ab747fSPaolo Bonzini else 66249ab747fSPaolo Bonzini return kbd_read_data(s, 0, 1) & 0xff; 66349ab747fSPaolo Bonzini } 66449ab747fSPaolo Bonzini 6655876503cSPeter Maydell static void kbd_mm_writefn(void *opaque, hwaddr addr, 6665876503cSPeter Maydell uint64_t value, unsigned size) 66749ab747fSPaolo Bonzini { 66849ab747fSPaolo Bonzini KBDState *s = opaque; 66949ab747fSPaolo Bonzini 67049ab747fSPaolo Bonzini if (addr & s->mask) 67149ab747fSPaolo Bonzini kbd_write_command(s, 0, value & 0xff, 1); 67249ab747fSPaolo Bonzini else 67349ab747fSPaolo Bonzini kbd_write_data(s, 0, value & 0xff, 1); 67449ab747fSPaolo Bonzini } 67549ab747fSPaolo Bonzini 6765876503cSPeter Maydell 67749ab747fSPaolo Bonzini static const MemoryRegionOps i8042_mmio_ops = { 6785876503cSPeter Maydell .read = kbd_mm_readfn, 6795876503cSPeter Maydell .write = kbd_mm_writefn, 6805876503cSPeter Maydell .valid.min_access_size = 1, 6815876503cSPeter Maydell .valid.max_access_size = 4, 68249ab747fSPaolo Bonzini .endianness = DEVICE_NATIVE_ENDIAN, 68349ab747fSPaolo Bonzini }; 68449ab747fSPaolo Bonzini 68549ab747fSPaolo Bonzini void i8042_mm_init(qemu_irq kbd_irq, qemu_irq mouse_irq, 68649ab747fSPaolo Bonzini MemoryRegion *region, ram_addr_t size, 68749ab747fSPaolo Bonzini hwaddr mask) 68849ab747fSPaolo Bonzini { 68949ab747fSPaolo Bonzini KBDState *s = g_malloc0(sizeof(KBDState)); 69049ab747fSPaolo Bonzini 69149ab747fSPaolo Bonzini s->irq_kbd = kbd_irq; 69249ab747fSPaolo Bonzini s->irq_mouse = mouse_irq; 69349ab747fSPaolo Bonzini s->mask = mask; 69449ab747fSPaolo Bonzini 695ff6e1624SVolker Rümelin s->extended_state = true; 696ff6e1624SVolker Rümelin 69749ab747fSPaolo Bonzini vmstate_register(NULL, 0, &vmstate_kbd, s); 69849ab747fSPaolo Bonzini 6992c9b15caSPaolo Bonzini memory_region_init_io(region, NULL, &i8042_mmio_ops, s, "i8042", size); 70049ab747fSPaolo Bonzini 70149ab747fSPaolo Bonzini s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s); 70249ab747fSPaolo Bonzini s->mouse = ps2_mouse_init(kbd_update_aux_irq, s); 70349ab747fSPaolo Bonzini qemu_register_reset(kbd_reset, s); 70449ab747fSPaolo Bonzini } 70549ab747fSPaolo Bonzini 7060fe4bb32SMarc-André Lureau struct ISAKBDState { 707a2e0b863SAndreas Färber ISADevice parent_obj; 708a2e0b863SAndreas Färber 70949ab747fSPaolo Bonzini KBDState kbd; 710d1e45668SVolker Rümelin bool kbd_throttle; 71149ab747fSPaolo Bonzini MemoryRegion io[2]; 7120fe4bb32SMarc-André Lureau }; 71349ab747fSPaolo Bonzini 7140fe4bb32SMarc-André Lureau void i8042_isa_mouse_fake_event(ISAKBDState *isa) 71549ab747fSPaolo Bonzini { 716a2e0b863SAndreas Färber KBDState *s = &isa->kbd; 71749ab747fSPaolo Bonzini 71849ab747fSPaolo Bonzini ps2_mouse_fake_event(s->mouse); 71949ab747fSPaolo Bonzini } 72049ab747fSPaolo Bonzini 721d80fe99dSMarc-André Lureau void i8042_setup_a20_line(ISADevice *dev, qemu_irq a20_out) 72249ab747fSPaolo Bonzini { 723d80fe99dSMarc-André Lureau qdev_connect_gpio_out_named(DEVICE(dev), I8042_A20_LINE, 0, a20_out); 72449ab747fSPaolo Bonzini } 72549ab747fSPaolo Bonzini 72649ab747fSPaolo Bonzini static const VMStateDescription vmstate_kbd_isa = { 72749ab747fSPaolo Bonzini .name = "pckbd", 72849ab747fSPaolo Bonzini .version_id = 3, 72949ab747fSPaolo Bonzini .minimum_version_id = 3, 73049ab747fSPaolo Bonzini .fields = (VMStateField[]) { 73149ab747fSPaolo Bonzini VMSTATE_STRUCT(kbd, ISAKBDState, 0, vmstate_kbd, KBDState), 73249ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 73349ab747fSPaolo Bonzini } 73449ab747fSPaolo Bonzini }; 73549ab747fSPaolo Bonzini 73649ab747fSPaolo Bonzini static const MemoryRegionOps i8042_data_ops = { 73749ab747fSPaolo Bonzini .read = kbd_read_data, 73849ab747fSPaolo Bonzini .write = kbd_write_data, 73949ab747fSPaolo Bonzini .impl = { 74049ab747fSPaolo Bonzini .min_access_size = 1, 74149ab747fSPaolo Bonzini .max_access_size = 1, 74249ab747fSPaolo Bonzini }, 74349ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 74449ab747fSPaolo Bonzini }; 74549ab747fSPaolo Bonzini 74649ab747fSPaolo Bonzini static const MemoryRegionOps i8042_cmd_ops = { 74749ab747fSPaolo Bonzini .read = kbd_read_status, 74849ab747fSPaolo Bonzini .write = kbd_write_command, 74949ab747fSPaolo Bonzini .impl = { 75049ab747fSPaolo Bonzini .min_access_size = 1, 75149ab747fSPaolo Bonzini .max_access_size = 1, 75249ab747fSPaolo Bonzini }, 75349ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 75449ab747fSPaolo Bonzini }; 75549ab747fSPaolo Bonzini 756db895a1eSAndreas Färber static void i8042_initfn(Object *obj) 75749ab747fSPaolo Bonzini { 758db895a1eSAndreas Färber ISAKBDState *isa_s = I8042(obj); 759db895a1eSAndreas Färber KBDState *s = &isa_s->kbd; 760db895a1eSAndreas Färber 7611437c94bSPaolo Bonzini memory_region_init_io(isa_s->io + 0, obj, &i8042_data_ops, s, 7621437c94bSPaolo Bonzini "i8042-data", 1); 7631437c94bSPaolo Bonzini memory_region_init_io(isa_s->io + 1, obj, &i8042_cmd_ops, s, 7641437c94bSPaolo Bonzini "i8042-cmd", 1); 7653115b9e2SEfimov Vasily 7663115b9e2SEfimov Vasily qdev_init_gpio_out_named(DEVICE(obj), &s->a20_out, I8042_A20_LINE, 1); 767db895a1eSAndreas Färber } 768db895a1eSAndreas Färber 769db895a1eSAndreas Färber static void i8042_realizefn(DeviceState *dev, Error **errp) 770db895a1eSAndreas Färber { 771db895a1eSAndreas Färber ISADevice *isadev = ISA_DEVICE(dev); 772a2e0b863SAndreas Färber ISAKBDState *isa_s = I8042(dev); 77349ab747fSPaolo Bonzini KBDState *s = &isa_s->kbd; 77449ab747fSPaolo Bonzini 775db895a1eSAndreas Färber isa_init_irq(isadev, &s->irq_kbd, 1); 776db895a1eSAndreas Färber isa_init_irq(isadev, &s->irq_mouse, 12); 77749ab747fSPaolo Bonzini 778db895a1eSAndreas Färber isa_register_ioport(isadev, isa_s->io + 0, 0x60); 779db895a1eSAndreas Färber isa_register_ioport(isadev, isa_s->io + 1, 0x64); 78049ab747fSPaolo Bonzini 78149ab747fSPaolo Bonzini s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s); 78249ab747fSPaolo Bonzini s->mouse = ps2_mouse_init(kbd_update_aux_irq, s); 783d1e45668SVolker Rümelin if (isa_s->kbd_throttle && !isa_s->kbd.extended_state) { 784d1e45668SVolker Rümelin warn_report(TYPE_I8042 ": can't enable kbd-throttle without" 785d1e45668SVolker Rümelin " extended-state, disabling kbd-throttle"); 786d1e45668SVolker Rümelin } else if (isa_s->kbd_throttle) { 787d1e45668SVolker Rümelin s->throttle_timer = timer_new_us(QEMU_CLOCK_VIRTUAL, 788d1e45668SVolker Rümelin kbd_throttle_timeout, s); 789d1e45668SVolker Rümelin } 79049ab747fSPaolo Bonzini qemu_register_reset(kbd_reset, s); 79149ab747fSPaolo Bonzini } 79249ab747fSPaolo Bonzini 793df0f3d13SGerd Hoffmann static void i8042_build_aml(ISADevice *isadev, Aml *scope) 794df0f3d13SGerd Hoffmann { 795df0f3d13SGerd Hoffmann Aml *kbd; 796df0f3d13SGerd Hoffmann Aml *mou; 797df0f3d13SGerd Hoffmann Aml *crs; 798df0f3d13SGerd Hoffmann 799df0f3d13SGerd Hoffmann crs = aml_resource_template(); 800df0f3d13SGerd Hoffmann aml_append(crs, aml_io(AML_DECODE16, 0x0060, 0x0060, 0x01, 0x01)); 801df0f3d13SGerd Hoffmann aml_append(crs, aml_io(AML_DECODE16, 0x0064, 0x0064, 0x01, 0x01)); 802df0f3d13SGerd Hoffmann aml_append(crs, aml_irq_no_flags(1)); 803df0f3d13SGerd Hoffmann 804df0f3d13SGerd Hoffmann kbd = aml_device("KBD"); 805df0f3d13SGerd Hoffmann aml_append(kbd, aml_name_decl("_HID", aml_eisaid("PNP0303"))); 806df0f3d13SGerd Hoffmann aml_append(kbd, aml_name_decl("_STA", aml_int(0xf))); 807df0f3d13SGerd Hoffmann aml_append(kbd, aml_name_decl("_CRS", crs)); 808df0f3d13SGerd Hoffmann 809df0f3d13SGerd Hoffmann crs = aml_resource_template(); 810df0f3d13SGerd Hoffmann aml_append(crs, aml_irq_no_flags(12)); 811df0f3d13SGerd Hoffmann 812df0f3d13SGerd Hoffmann mou = aml_device("MOU"); 813df0f3d13SGerd Hoffmann aml_append(mou, aml_name_decl("_HID", aml_eisaid("PNP0F13"))); 814df0f3d13SGerd Hoffmann aml_append(mou, aml_name_decl("_STA", aml_int(0xf))); 815df0f3d13SGerd Hoffmann aml_append(mou, aml_name_decl("_CRS", crs)); 816df0f3d13SGerd Hoffmann 817df0f3d13SGerd Hoffmann aml_append(scope, kbd); 818df0f3d13SGerd Hoffmann aml_append(scope, mou); 819df0f3d13SGerd Hoffmann } 820df0f3d13SGerd Hoffmann 821ff6e1624SVolker Rümelin static Property i8042_properties[] = { 822ff6e1624SVolker Rümelin DEFINE_PROP_BOOL("extended-state", ISAKBDState, kbd.extended_state, true), 823d1e45668SVolker Rümelin DEFINE_PROP_BOOL("kbd-throttle", ISAKBDState, kbd_throttle, false), 824ff6e1624SVolker Rümelin DEFINE_PROP_END_OF_LIST(), 825ff6e1624SVolker Rümelin }; 826ff6e1624SVolker Rümelin 82749ab747fSPaolo Bonzini static void i8042_class_initfn(ObjectClass *klass, void *data) 82849ab747fSPaolo Bonzini { 82949ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 830df0f3d13SGerd Hoffmann ISADeviceClass *isa = ISA_DEVICE_CLASS(klass); 831db895a1eSAndreas Färber 832ff6e1624SVolker Rümelin device_class_set_props(dc, i8042_properties); 833db895a1eSAndreas Färber dc->realize = i8042_realizefn; 83449ab747fSPaolo Bonzini dc->vmsd = &vmstate_kbd_isa; 835df0f3d13SGerd Hoffmann isa->build_aml = i8042_build_aml; 836cbe9ed73Skumar sourav set_bit(DEVICE_CATEGORY_INPUT, dc->categories); 83749ab747fSPaolo Bonzini } 83849ab747fSPaolo Bonzini 83949ab747fSPaolo Bonzini static const TypeInfo i8042_info = { 840a2e0b863SAndreas Färber .name = TYPE_I8042, 84149ab747fSPaolo Bonzini .parent = TYPE_ISA_DEVICE, 84249ab747fSPaolo Bonzini .instance_size = sizeof(ISAKBDState), 843db895a1eSAndreas Färber .instance_init = i8042_initfn, 84449ab747fSPaolo Bonzini .class_init = i8042_class_initfn, 84549ab747fSPaolo Bonzini }; 84649ab747fSPaolo Bonzini 84749ab747fSPaolo Bonzini static void i8042_register_types(void) 84849ab747fSPaolo Bonzini { 84949ab747fSPaolo Bonzini type_register_static(&i8042_info); 85049ab747fSPaolo Bonzini } 85149ab747fSPaolo Bonzini 85249ab747fSPaolo Bonzini type_init(i8042_register_types) 853