xref: /qemu/hw/input/pckbd.c (revision aa67a42f)
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 
13449ab747fSPaolo Bonzini #define KBD_PENDING_KBD         1
13549ab747fSPaolo Bonzini #define KBD_PENDING_AUX         2
136*aa67a42fSVolker Rümelin #define KBD_PENDING_CTRL_KBD    0x04
137*aa67a42fSVolker Rümelin #define KBD_PENDING_CTRL_AUX    0x08
13849ab747fSPaolo Bonzini 
139d1e45668SVolker Rümelin #define KBD_MIGR_TIMER_PENDING  0x1
140d1e45668SVolker Rümelin 
141ac9192bdSVolker Rümelin #define KBD_OBSRC_KBD           0x01
142ac9192bdSVolker Rümelin #define KBD_OBSRC_MOUSE         0x02
143*aa67a42fSVolker Rümelin #define KBD_OBSRC_CTRL          0x04
144ac9192bdSVolker Rümelin 
14549ab747fSPaolo Bonzini typedef struct KBDState {
14649ab747fSPaolo Bonzini     uint8_t write_cmd; /* if non zero, write data to port 60 is expected */
14749ab747fSPaolo Bonzini     uint8_t status;
14849ab747fSPaolo Bonzini     uint8_t mode;
14949ab747fSPaolo Bonzini     uint8_t outport;
150d1e45668SVolker Rümelin     uint32_t migration_flags;
151ac9192bdSVolker Rümelin     uint32_t obsrc;
152a28fe7e3SPavel Dovgalyuk     bool outport_present;
153ff6e1624SVolker Rümelin     bool extended_state;
154ac9192bdSVolker Rümelin     bool extended_state_loaded;
15549ab747fSPaolo Bonzini     /* Bitmask of devices with data available.  */
15649ab747fSPaolo Bonzini     uint8_t pending;
157ff6e1624SVolker Rümelin     uint8_t obdata;
158*aa67a42fSVolker Rümelin     uint8_t cbdata;
15949ab747fSPaolo Bonzini     void *kbd;
16049ab747fSPaolo Bonzini     void *mouse;
161d1e45668SVolker Rümelin     QEMUTimer *throttle_timer;
16249ab747fSPaolo Bonzini 
16349ab747fSPaolo Bonzini     qemu_irq irq_kbd;
16449ab747fSPaolo Bonzini     qemu_irq irq_mouse;
1653115b9e2SEfimov Vasily     qemu_irq a20_out;
16649ab747fSPaolo Bonzini     hwaddr mask;
16749ab747fSPaolo Bonzini } KBDState;
16849ab747fSPaolo Bonzini 
16949ab747fSPaolo Bonzini /* XXX: not generating the irqs if KBD_MODE_DISABLE_KBD is set may be
17049ab747fSPaolo Bonzini    incorrect, but it avoids having to simulate exact delays */
171c3c4a961SVolker Rümelin static void kbd_update_irq_lines(KBDState *s)
17249ab747fSPaolo Bonzini {
17349ab747fSPaolo Bonzini     int irq_kbd_level, irq_mouse_level;
17449ab747fSPaolo Bonzini 
17549ab747fSPaolo Bonzini     irq_kbd_level = 0;
17649ab747fSPaolo Bonzini     irq_mouse_level = 0;
177c3c4a961SVolker Rümelin 
178c3c4a961SVolker Rümelin     if (s->status & KBD_STAT_OBF) {
179c3c4a961SVolker Rümelin         if (s->status & KBD_STAT_MOUSE_OBF) {
180c3c4a961SVolker Rümelin             if (s->mode & KBD_MODE_MOUSE_INT) {
181c3c4a961SVolker Rümelin                 irq_mouse_level = 1;
182c3c4a961SVolker Rümelin             }
183c3c4a961SVolker Rümelin         } else {
184c3c4a961SVolker Rümelin             if ((s->mode & KBD_MODE_KBD_INT) &&
185c3c4a961SVolker Rümelin                 !(s->mode & KBD_MODE_DISABLE_KBD)) {
186c3c4a961SVolker Rümelin                 irq_kbd_level = 1;
187c3c4a961SVolker Rümelin             }
188c3c4a961SVolker Rümelin         }
189c3c4a961SVolker Rümelin     }
190c3c4a961SVolker Rümelin     qemu_set_irq(s->irq_kbd, irq_kbd_level);
191c3c4a961SVolker Rümelin     qemu_set_irq(s->irq_mouse, irq_mouse_level);
192c3c4a961SVolker Rümelin }
193c3c4a961SVolker Rümelin 
194ff6e1624SVolker Rümelin static void kbd_deassert_irq(KBDState *s)
195ff6e1624SVolker Rümelin {
196ff6e1624SVolker Rümelin     s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF);
197ff6e1624SVolker Rümelin     s->outport &= ~(KBD_OUT_OBF | KBD_OUT_MOUSE_OBF);
198ff6e1624SVolker Rümelin     kbd_update_irq_lines(s);
199ff6e1624SVolker Rümelin }
200ff6e1624SVolker Rümelin 
201c3c4a961SVolker Rümelin /* update irq and KBD_STAT_[MOUSE_]OBF */
202c3c4a961SVolker Rümelin static void kbd_update_irq(KBDState *s)
203c3c4a961SVolker Rümelin {
20449ab747fSPaolo Bonzini     s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF);
20549ab747fSPaolo Bonzini     s->outport &= ~(KBD_OUT_OBF | KBD_OUT_MOUSE_OBF);
20649ab747fSPaolo Bonzini     if (s->pending) {
20749ab747fSPaolo Bonzini         s->status |= KBD_STAT_OBF;
20849ab747fSPaolo Bonzini         s->outport |= KBD_OUT_OBF;
209*aa67a42fSVolker Rümelin         if (s->pending & KBD_PENDING_CTRL_KBD) {
210*aa67a42fSVolker Rümelin             s->obsrc = KBD_OBSRC_CTRL;
211*aa67a42fSVolker Rümelin         } else if (s->pending & KBD_PENDING_CTRL_AUX) {
212*aa67a42fSVolker Rümelin             s->status |= KBD_STAT_MOUSE_OBF;
213*aa67a42fSVolker Rümelin             s->outport |= KBD_OUT_MOUSE_OBF;
214*aa67a42fSVolker Rümelin             s->obsrc = KBD_OBSRC_CTRL;
215*aa67a42fSVolker Rümelin         } else if (s->pending & KBD_PENDING_KBD) {
216*aa67a42fSVolker Rümelin             s->obsrc = KBD_OBSRC_KBD;
217*aa67a42fSVolker Rümelin         } else {
21849ab747fSPaolo Bonzini             s->status |= KBD_STAT_MOUSE_OBF;
21949ab747fSPaolo Bonzini             s->outport |= KBD_OUT_MOUSE_OBF;
220ac9192bdSVolker Rümelin             s->obsrc = KBD_OBSRC_MOUSE;
22149ab747fSPaolo Bonzini         }
22249ab747fSPaolo Bonzini     }
223c3c4a961SVolker Rümelin     kbd_update_irq_lines(s);
22449ab747fSPaolo Bonzini }
22549ab747fSPaolo Bonzini 
226ff6e1624SVolker Rümelin static void kbd_safe_update_irq(KBDState *s)
227ff6e1624SVolker Rümelin {
228ff6e1624SVolker Rümelin     /*
229ff6e1624SVolker Rümelin      * with KBD_STAT_OBF set, a call to kbd_read_data() will eventually call
230ff6e1624SVolker Rümelin      * kbd_update_irq()
231ff6e1624SVolker Rümelin      */
232ff6e1624SVolker Rümelin     if (s->status & KBD_STAT_OBF) {
233ff6e1624SVolker Rümelin         return;
234ff6e1624SVolker Rümelin     }
235d1e45668SVolker Rümelin     /* the throttle timer is pending and will call kbd_update_irq() */
236d1e45668SVolker Rümelin     if (s->throttle_timer && timer_pending(s->throttle_timer)) {
237d1e45668SVolker Rümelin         return;
238d1e45668SVolker Rümelin     }
239ff6e1624SVolker Rümelin     if (s->pending) {
240ff6e1624SVolker Rümelin         kbd_update_irq(s);
241ff6e1624SVolker Rümelin     }
242ff6e1624SVolker Rümelin }
243ff6e1624SVolker Rümelin 
24449ab747fSPaolo Bonzini static void kbd_update_kbd_irq(void *opaque, int level)
24549ab747fSPaolo Bonzini {
246ff6e1624SVolker Rümelin     KBDState *s = opaque;
24749ab747fSPaolo Bonzini 
248ff6e1624SVolker Rümelin     if (level) {
24949ab747fSPaolo Bonzini         s->pending |= KBD_PENDING_KBD;
250ff6e1624SVolker Rümelin     } else {
25149ab747fSPaolo Bonzini         s->pending &= ~KBD_PENDING_KBD;
252ff6e1624SVolker Rümelin     }
253ff6e1624SVolker Rümelin     kbd_safe_update_irq(s);
25449ab747fSPaolo Bonzini }
25549ab747fSPaolo Bonzini 
25649ab747fSPaolo Bonzini static void kbd_update_aux_irq(void *opaque, int level)
25749ab747fSPaolo Bonzini {
258ff6e1624SVolker Rümelin     KBDState *s = opaque;
25949ab747fSPaolo Bonzini 
260ff6e1624SVolker Rümelin     if (level) {
26149ab747fSPaolo Bonzini         s->pending |= KBD_PENDING_AUX;
262ff6e1624SVolker Rümelin     } else {
26349ab747fSPaolo Bonzini         s->pending &= ~KBD_PENDING_AUX;
264ff6e1624SVolker Rümelin     }
265ff6e1624SVolker Rümelin     kbd_safe_update_irq(s);
26649ab747fSPaolo Bonzini }
26749ab747fSPaolo Bonzini 
268d1e45668SVolker Rümelin static void kbd_throttle_timeout(void *opaque)
269d1e45668SVolker Rümelin {
270d1e45668SVolker Rümelin     KBDState *s = opaque;
271d1e45668SVolker Rümelin 
272d1e45668SVolker Rümelin     if (s->pending) {
273d1e45668SVolker Rümelin         kbd_update_irq(s);
274d1e45668SVolker Rümelin     }
275d1e45668SVolker Rümelin }
276d1e45668SVolker Rümelin 
27749ab747fSPaolo Bonzini static uint64_t kbd_read_status(void *opaque, hwaddr addr,
27849ab747fSPaolo Bonzini                                 unsigned size)
27949ab747fSPaolo Bonzini {
28049ab747fSPaolo Bonzini     KBDState *s = opaque;
28149ab747fSPaolo Bonzini     int val;
28249ab747fSPaolo Bonzini     val = s->status;
28365b182c3SDr. David Alan Gilbert     trace_pckbd_kbd_read_status(val);
28449ab747fSPaolo Bonzini     return val;
28549ab747fSPaolo Bonzini }
28649ab747fSPaolo Bonzini 
28749ab747fSPaolo Bonzini static void kbd_queue(KBDState *s, int b, int aux)
28849ab747fSPaolo Bonzini {
289*aa67a42fSVolker Rümelin     if (s->extended_state) {
290*aa67a42fSVolker Rümelin         s->cbdata = b;
291*aa67a42fSVolker Rümelin         s->pending &= ~KBD_PENDING_CTRL_KBD & ~KBD_PENDING_CTRL_AUX;
292*aa67a42fSVolker Rümelin         s->pending |= aux ? KBD_PENDING_CTRL_AUX : KBD_PENDING_CTRL_KBD;
293*aa67a42fSVolker Rümelin         kbd_safe_update_irq(s);
294*aa67a42fSVolker Rümelin     } else {
295*aa67a42fSVolker Rümelin         ps2_queue(aux ? s->mouse : s->kbd, b);
296*aa67a42fSVolker Rümelin     }
297*aa67a42fSVolker Rümelin }
298*aa67a42fSVolker Rümelin 
299*aa67a42fSVolker Rümelin static uint8_t kbd_dequeue(KBDState *s)
300*aa67a42fSVolker Rümelin {
301*aa67a42fSVolker Rümelin     uint8_t b = s->cbdata;
302*aa67a42fSVolker Rümelin 
303*aa67a42fSVolker Rümelin     s->pending &= ~KBD_PENDING_CTRL_KBD & ~KBD_PENDING_CTRL_AUX;
304*aa67a42fSVolker Rümelin     if (s->pending) {
305*aa67a42fSVolker Rümelin         kbd_update_irq(s);
306*aa67a42fSVolker Rümelin     }
307*aa67a42fSVolker Rümelin     return b;
30849ab747fSPaolo Bonzini }
30949ab747fSPaolo Bonzini 
31049ab747fSPaolo Bonzini static void outport_write(KBDState *s, uint32_t val)
31149ab747fSPaolo Bonzini {
31265b182c3SDr. David Alan Gilbert     trace_pckbd_outport_write(val);
31349ab747fSPaolo Bonzini     s->outport = val;
3143115b9e2SEfimov Vasily     qemu_set_irq(s->a20_out, (val >> 1) & 1);
31549ab747fSPaolo Bonzini     if (!(val & 1)) {
316cf83f140SEric Blake         qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
31749ab747fSPaolo Bonzini     }
31849ab747fSPaolo Bonzini }
31949ab747fSPaolo Bonzini 
32049ab747fSPaolo Bonzini static void kbd_write_command(void *opaque, hwaddr addr,
32149ab747fSPaolo Bonzini                               uint64_t val, unsigned size)
32249ab747fSPaolo Bonzini {
32349ab747fSPaolo Bonzini     KBDState *s = opaque;
32449ab747fSPaolo Bonzini 
32565b182c3SDr. David Alan Gilbert     trace_pckbd_kbd_write_command(val);
32649ab747fSPaolo Bonzini 
32749ab747fSPaolo Bonzini     /* Bits 3-0 of the output port P2 of the keyboard controller may be pulsed
32849ab747fSPaolo Bonzini      * low for approximately 6 micro seconds. Bits 3-0 of the KBD_CCMD_PULSE
32949ab747fSPaolo Bonzini      * command specify the output port bits to be pulsed.
33049ab747fSPaolo Bonzini      * 0: Bit should be pulsed. 1: Bit should not be modified.
33149ab747fSPaolo Bonzini      * The only useful version of this command is pulsing bit 0,
33249ab747fSPaolo Bonzini      * which does a CPU reset.
33349ab747fSPaolo Bonzini      */
33449ab747fSPaolo Bonzini     if((val & KBD_CCMD_PULSE_BITS_3_0) == KBD_CCMD_PULSE_BITS_3_0) {
33549ab747fSPaolo Bonzini         if(!(val & 1))
33649ab747fSPaolo Bonzini             val = KBD_CCMD_RESET;
33749ab747fSPaolo Bonzini         else
33849ab747fSPaolo Bonzini             val = KBD_CCMD_NO_OP;
33949ab747fSPaolo Bonzini     }
34049ab747fSPaolo Bonzini 
34149ab747fSPaolo Bonzini     switch(val) {
34249ab747fSPaolo Bonzini     case KBD_CCMD_READ_MODE:
34349ab747fSPaolo Bonzini         kbd_queue(s, s->mode, 0);
34449ab747fSPaolo Bonzini         break;
34549ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_MODE:
34649ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_OBUF:
34749ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_AUX_OBUF:
34849ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_MOUSE:
34949ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_OUTPORT:
35049ab747fSPaolo Bonzini         s->write_cmd = val;
35149ab747fSPaolo Bonzini         break;
35249ab747fSPaolo Bonzini     case KBD_CCMD_MOUSE_DISABLE:
35349ab747fSPaolo Bonzini         s->mode |= KBD_MODE_DISABLE_MOUSE;
35449ab747fSPaolo Bonzini         break;
35549ab747fSPaolo Bonzini     case KBD_CCMD_MOUSE_ENABLE:
35649ab747fSPaolo Bonzini         s->mode &= ~KBD_MODE_DISABLE_MOUSE;
35749ab747fSPaolo Bonzini         break;
35849ab747fSPaolo Bonzini     case KBD_CCMD_TEST_MOUSE:
35949ab747fSPaolo Bonzini         kbd_queue(s, 0x00, 0);
36049ab747fSPaolo Bonzini         break;
36149ab747fSPaolo Bonzini     case KBD_CCMD_SELF_TEST:
36249ab747fSPaolo Bonzini         s->status |= KBD_STAT_SELFTEST;
36349ab747fSPaolo Bonzini         kbd_queue(s, 0x55, 0);
36449ab747fSPaolo Bonzini         break;
36549ab747fSPaolo Bonzini     case KBD_CCMD_KBD_TEST:
36649ab747fSPaolo Bonzini         kbd_queue(s, 0x00, 0);
36749ab747fSPaolo Bonzini         break;
36849ab747fSPaolo Bonzini     case KBD_CCMD_KBD_DISABLE:
36949ab747fSPaolo Bonzini         s->mode |= KBD_MODE_DISABLE_KBD;
37049ab747fSPaolo Bonzini         break;
37149ab747fSPaolo Bonzini     case KBD_CCMD_KBD_ENABLE:
37249ab747fSPaolo Bonzini         s->mode &= ~KBD_MODE_DISABLE_KBD;
373ff6e1624SVolker Rümelin         kbd_safe_update_irq(s);
37449ab747fSPaolo Bonzini         break;
37549ab747fSPaolo Bonzini     case KBD_CCMD_READ_INPORT:
376f1b7e0e4SHervé Poussineau         kbd_queue(s, 0x80, 0);
37749ab747fSPaolo Bonzini         break;
37849ab747fSPaolo Bonzini     case KBD_CCMD_READ_OUTPORT:
37949ab747fSPaolo Bonzini         kbd_queue(s, s->outport, 0);
38049ab747fSPaolo Bonzini         break;
38149ab747fSPaolo Bonzini     case KBD_CCMD_ENABLE_A20:
3823115b9e2SEfimov Vasily         qemu_irq_raise(s->a20_out);
38349ab747fSPaolo Bonzini         s->outport |= KBD_OUT_A20;
38449ab747fSPaolo Bonzini         break;
38549ab747fSPaolo Bonzini     case KBD_CCMD_DISABLE_A20:
3863115b9e2SEfimov Vasily         qemu_irq_lower(s->a20_out);
38749ab747fSPaolo Bonzini         s->outport &= ~KBD_OUT_A20;
38849ab747fSPaolo Bonzini         break;
38949ab747fSPaolo Bonzini     case KBD_CCMD_RESET:
390cf83f140SEric Blake         qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
39149ab747fSPaolo Bonzini         break;
39249ab747fSPaolo Bonzini     case KBD_CCMD_NO_OP:
39349ab747fSPaolo Bonzini         /* ignore that */
39449ab747fSPaolo Bonzini         break;
39549ab747fSPaolo Bonzini     default:
396c2e846bbSPhilippe Mathieu-Daudé         qemu_log_mask(LOG_GUEST_ERROR,
397c2e846bbSPhilippe Mathieu-Daudé                       "unsupported keyboard cmd=0x%02" PRIx64 "\n", val);
39849ab747fSPaolo Bonzini         break;
39949ab747fSPaolo Bonzini     }
40049ab747fSPaolo Bonzini }
40149ab747fSPaolo Bonzini 
40249ab747fSPaolo Bonzini static uint64_t kbd_read_data(void *opaque, hwaddr addr,
40349ab747fSPaolo Bonzini                               unsigned size)
40449ab747fSPaolo Bonzini {
40549ab747fSPaolo Bonzini     KBDState *s = opaque;
40649ab747fSPaolo Bonzini 
407ac9192bdSVolker Rümelin     if (s->status & KBD_STAT_OBF) {
408ff6e1624SVolker Rümelin         kbd_deassert_irq(s);
409ac9192bdSVolker Rümelin         if (s->obsrc & KBD_OBSRC_KBD) {
410d1e45668SVolker Rümelin             if (s->throttle_timer) {
411d1e45668SVolker Rümelin                 timer_mod(s->throttle_timer,
412d1e45668SVolker Rümelin                           qemu_clock_get_us(QEMU_CLOCK_VIRTUAL) + 1000);
413d1e45668SVolker Rümelin             }
414ff6e1624SVolker Rümelin             s->obdata = ps2_read_data(s->kbd);
415ac9192bdSVolker Rümelin         } else if (s->obsrc & KBD_OBSRC_MOUSE) {
416ac9192bdSVolker Rümelin             s->obdata = ps2_read_data(s->mouse);
417*aa67a42fSVolker Rümelin         } else if (s->obsrc & KBD_OBSRC_CTRL) {
418*aa67a42fSVolker Rümelin             s->obdata = kbd_dequeue(s);
419ff6e1624SVolker Rümelin         }
420ff6e1624SVolker Rümelin     }
42149ab747fSPaolo Bonzini 
422ff6e1624SVolker Rümelin     trace_pckbd_kbd_read_data(s->obdata);
423ff6e1624SVolker Rümelin     return s->obdata;
42449ab747fSPaolo Bonzini }
42549ab747fSPaolo Bonzini 
42649ab747fSPaolo Bonzini static void kbd_write_data(void *opaque, hwaddr addr,
42749ab747fSPaolo Bonzini                            uint64_t val, unsigned size)
42849ab747fSPaolo Bonzini {
42949ab747fSPaolo Bonzini     KBDState *s = opaque;
43049ab747fSPaolo Bonzini 
43165b182c3SDr. David Alan Gilbert     trace_pckbd_kbd_write_data(val);
43249ab747fSPaolo Bonzini 
43349ab747fSPaolo Bonzini     switch(s->write_cmd) {
43449ab747fSPaolo Bonzini     case 0:
43549ab747fSPaolo Bonzini         ps2_write_keyboard(s->kbd, val);
43649ab747fSPaolo Bonzini         break;
43749ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_MODE:
43849ab747fSPaolo Bonzini         s->mode = val;
43949ab747fSPaolo Bonzini         ps2_keyboard_set_translation(s->kbd, (s->mode & KBD_MODE_KCC) != 0);
440ff6e1624SVolker Rümelin         /*
441ff6e1624SVolker Rümelin          * a write to the mode byte interrupt enable flags directly updates
442ff6e1624SVolker Rümelin          * the irq lines
443ff6e1624SVolker Rümelin          */
444ff6e1624SVolker Rümelin         kbd_update_irq_lines(s);
445ff6e1624SVolker Rümelin         /*
446ff6e1624SVolker Rümelin          * a write to the mode byte disable interface flags may raise
447ff6e1624SVolker Rümelin          * an irq if there is pending data in the PS/2 queues.
448ff6e1624SVolker Rümelin          */
449ff6e1624SVolker Rümelin         kbd_safe_update_irq(s);
45049ab747fSPaolo Bonzini         break;
45149ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_OBUF:
45249ab747fSPaolo Bonzini         kbd_queue(s, val, 0);
45349ab747fSPaolo Bonzini         break;
45449ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_AUX_OBUF:
45549ab747fSPaolo Bonzini         kbd_queue(s, val, 1);
45649ab747fSPaolo Bonzini         break;
45749ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_OUTPORT:
45849ab747fSPaolo Bonzini         outport_write(s, val);
45949ab747fSPaolo Bonzini         break;
46049ab747fSPaolo Bonzini     case KBD_CCMD_WRITE_MOUSE:
46149ab747fSPaolo Bonzini         ps2_write_mouse(s->mouse, val);
46249ab747fSPaolo Bonzini         break;
46349ab747fSPaolo Bonzini     default:
46449ab747fSPaolo Bonzini         break;
46549ab747fSPaolo Bonzini     }
46649ab747fSPaolo Bonzini     s->write_cmd = 0;
46749ab747fSPaolo Bonzini }
46849ab747fSPaolo Bonzini 
46949ab747fSPaolo Bonzini static void kbd_reset(void *opaque)
47049ab747fSPaolo Bonzini {
47149ab747fSPaolo Bonzini     KBDState *s = opaque;
47249ab747fSPaolo Bonzini 
47349ab747fSPaolo Bonzini     s->mode = KBD_MODE_KBD_INT | KBD_MODE_MOUSE_INT;
47449ab747fSPaolo Bonzini     s->status = KBD_STAT_CMD | KBD_STAT_UNLOCKED;
475d13c0404SPaolo Bonzini     s->outport = KBD_OUT_RESET | KBD_OUT_A20 | KBD_OUT_ONES;
476a28fe7e3SPavel Dovgalyuk     s->outport_present = false;
477ff6e1624SVolker Rümelin     s->pending = 0;
478ff6e1624SVolker Rümelin     kbd_deassert_irq(s);
479d1e45668SVolker Rümelin     if (s->throttle_timer) {
480d1e45668SVolker Rümelin         timer_del(s->throttle_timer);
481d1e45668SVolker Rümelin     }
482a28fe7e3SPavel Dovgalyuk }
483a28fe7e3SPavel Dovgalyuk 
484a28fe7e3SPavel Dovgalyuk static uint8_t kbd_outport_default(KBDState *s)
485a28fe7e3SPavel Dovgalyuk {
486d13c0404SPaolo Bonzini     return KBD_OUT_RESET | KBD_OUT_A20 | KBD_OUT_ONES
487a28fe7e3SPavel Dovgalyuk            | (s->status & KBD_STAT_OBF ? KBD_OUT_OBF : 0)
488a28fe7e3SPavel Dovgalyuk            | (s->status & KBD_STAT_MOUSE_OBF ? KBD_OUT_MOUSE_OBF : 0);
489a28fe7e3SPavel Dovgalyuk }
490a28fe7e3SPavel Dovgalyuk 
491a28fe7e3SPavel Dovgalyuk static int kbd_outport_post_load(void *opaque, int version_id)
492a28fe7e3SPavel Dovgalyuk {
493a28fe7e3SPavel Dovgalyuk     KBDState *s = opaque;
494a28fe7e3SPavel Dovgalyuk     s->outport_present = true;
495a28fe7e3SPavel Dovgalyuk     return 0;
496a28fe7e3SPavel Dovgalyuk }
497a28fe7e3SPavel Dovgalyuk 
498a28fe7e3SPavel Dovgalyuk static bool kbd_outport_needed(void *opaque)
499a28fe7e3SPavel Dovgalyuk {
500a28fe7e3SPavel Dovgalyuk     KBDState *s = opaque;
501a28fe7e3SPavel Dovgalyuk     return s->outport != kbd_outport_default(s);
502a28fe7e3SPavel Dovgalyuk }
503a28fe7e3SPavel Dovgalyuk 
5045cd8cadaSJuan Quintela static const VMStateDescription vmstate_kbd_outport = {
5055cd8cadaSJuan Quintela     .name = "pckbd_outport",
5065cd8cadaSJuan Quintela     .version_id = 1,
5075cd8cadaSJuan Quintela     .minimum_version_id = 1,
5085cd8cadaSJuan Quintela     .post_load = kbd_outport_post_load,
5095cd8cadaSJuan Quintela     .needed = kbd_outport_needed,
5105cd8cadaSJuan Quintela     .fields = (VMStateField[]) {
5115cd8cadaSJuan Quintela         VMSTATE_UINT8(outport, KBDState),
5125cd8cadaSJuan Quintela         VMSTATE_END_OF_LIST()
5135cd8cadaSJuan Quintela     }
5145cd8cadaSJuan Quintela };
5155cd8cadaSJuan Quintela 
516d1e45668SVolker Rümelin static int kbd_extended_state_pre_save(void *opaque)
517d1e45668SVolker Rümelin {
518d1e45668SVolker Rümelin     KBDState *s = opaque;
519d1e45668SVolker Rümelin 
520d1e45668SVolker Rümelin     s->migration_flags = 0;
521d1e45668SVolker Rümelin     if (s->throttle_timer && timer_pending(s->throttle_timer)) {
522d1e45668SVolker Rümelin         s->migration_flags |= KBD_MIGR_TIMER_PENDING;
523d1e45668SVolker Rümelin     }
524d1e45668SVolker Rümelin 
525d1e45668SVolker Rümelin     return 0;
526d1e45668SVolker Rümelin }
527d1e45668SVolker Rümelin 
528d1e45668SVolker Rümelin static int kbd_extended_state_post_load(void *opaque, int version_id)
529d1e45668SVolker Rümelin {
530d1e45668SVolker Rümelin     KBDState *s = opaque;
531d1e45668SVolker Rümelin 
532d1e45668SVolker Rümelin     if (s->migration_flags & KBD_MIGR_TIMER_PENDING) {
533d1e45668SVolker Rümelin         kbd_throttle_timeout(s);
534d1e45668SVolker Rümelin     }
535ac9192bdSVolker Rümelin     s->extended_state_loaded = true;
536d1e45668SVolker Rümelin 
537d1e45668SVolker Rümelin     return 0;
538d1e45668SVolker Rümelin }
539d1e45668SVolker Rümelin 
540ff6e1624SVolker Rümelin static bool kbd_extended_state_needed(void *opaque)
541ff6e1624SVolker Rümelin {
542ff6e1624SVolker Rümelin     KBDState *s = opaque;
543ff6e1624SVolker Rümelin 
544ff6e1624SVolker Rümelin     return s->extended_state;
545ff6e1624SVolker Rümelin }
546ff6e1624SVolker Rümelin 
547ff6e1624SVolker Rümelin static const VMStateDescription vmstate_kbd_extended_state = {
548ff6e1624SVolker Rümelin     .name = "pckbd/extended_state",
549d1e45668SVolker Rümelin     .post_load = kbd_extended_state_post_load,
550d1e45668SVolker Rümelin     .pre_save = kbd_extended_state_pre_save,
551ff6e1624SVolker Rümelin     .needed = kbd_extended_state_needed,
552ff6e1624SVolker Rümelin     .fields = (VMStateField[]) {
553d1e45668SVolker Rümelin         VMSTATE_UINT32(migration_flags, KBDState),
554ac9192bdSVolker Rümelin         VMSTATE_UINT32(obsrc, KBDState),
555ff6e1624SVolker Rümelin         VMSTATE_UINT8(obdata, KBDState),
556*aa67a42fSVolker Rümelin         VMSTATE_UINT8(cbdata, KBDState),
557ff6e1624SVolker Rümelin         VMSTATE_END_OF_LIST()
558ff6e1624SVolker Rümelin     }
559ff6e1624SVolker Rümelin };
560ff6e1624SVolker Rümelin 
561ac9192bdSVolker Rümelin static int kbd_pre_load(void *opaque)
562ac9192bdSVolker Rümelin {
563ac9192bdSVolker Rümelin     KBDState *s = opaque;
564ac9192bdSVolker Rümelin 
565ac9192bdSVolker Rümelin     s->extended_state_loaded = false;
566ac9192bdSVolker Rümelin     return 0;
567ac9192bdSVolker Rümelin }
568ac9192bdSVolker Rümelin 
569a28fe7e3SPavel Dovgalyuk static int kbd_post_load(void *opaque, int version_id)
570a28fe7e3SPavel Dovgalyuk {
571a28fe7e3SPavel Dovgalyuk     KBDState *s = opaque;
572a28fe7e3SPavel Dovgalyuk     if (!s->outport_present) {
573a28fe7e3SPavel Dovgalyuk         s->outport = kbd_outport_default(s);
574a28fe7e3SPavel Dovgalyuk     }
575a28fe7e3SPavel Dovgalyuk     s->outport_present = false;
576ac9192bdSVolker Rümelin     if (!s->extended_state_loaded) {
577ac9192bdSVolker Rümelin         s->obsrc = s->status & KBD_STAT_OBF ?
578ac9192bdSVolker Rümelin             (s->status & KBD_STAT_MOUSE_OBF ? KBD_OBSRC_MOUSE : KBD_OBSRC_KBD) :
579ac9192bdSVolker Rümelin             0;
580ac9192bdSVolker Rümelin     }
581a28fe7e3SPavel Dovgalyuk     return 0;
58249ab747fSPaolo Bonzini }
58349ab747fSPaolo Bonzini 
58449ab747fSPaolo Bonzini static const VMStateDescription vmstate_kbd = {
58549ab747fSPaolo Bonzini     .name = "pckbd",
58649ab747fSPaolo Bonzini     .version_id = 3,
58749ab747fSPaolo Bonzini     .minimum_version_id = 3,
588ac9192bdSVolker Rümelin     .pre_load = kbd_pre_load,
589a28fe7e3SPavel Dovgalyuk     .post_load = kbd_post_load,
59049ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
59149ab747fSPaolo Bonzini         VMSTATE_UINT8(write_cmd, KBDState),
59249ab747fSPaolo Bonzini         VMSTATE_UINT8(status, KBDState),
59349ab747fSPaolo Bonzini         VMSTATE_UINT8(mode, KBDState),
59449ab747fSPaolo Bonzini         VMSTATE_UINT8(pending, KBDState),
59549ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
596a28fe7e3SPavel Dovgalyuk     },
5975cd8cadaSJuan Quintela     .subsections = (const VMStateDescription*[]) {
5985cd8cadaSJuan Quintela         &vmstate_kbd_outport,
599ff6e1624SVolker Rümelin         &vmstate_kbd_extended_state,
6005cd8cadaSJuan Quintela         NULL
60149ab747fSPaolo Bonzini     }
60249ab747fSPaolo Bonzini };
60349ab747fSPaolo Bonzini 
60449ab747fSPaolo Bonzini /* Memory mapped interface */
6055876503cSPeter Maydell static uint64_t kbd_mm_readfn(void *opaque, hwaddr addr, unsigned size)
60649ab747fSPaolo Bonzini {
60749ab747fSPaolo Bonzini     KBDState *s = opaque;
60849ab747fSPaolo Bonzini 
60949ab747fSPaolo Bonzini     if (addr & s->mask)
61049ab747fSPaolo Bonzini         return kbd_read_status(s, 0, 1) & 0xff;
61149ab747fSPaolo Bonzini     else
61249ab747fSPaolo Bonzini         return kbd_read_data(s, 0, 1) & 0xff;
61349ab747fSPaolo Bonzini }
61449ab747fSPaolo Bonzini 
6155876503cSPeter Maydell static void kbd_mm_writefn(void *opaque, hwaddr addr,
6165876503cSPeter Maydell                            uint64_t value, unsigned size)
61749ab747fSPaolo Bonzini {
61849ab747fSPaolo Bonzini     KBDState *s = opaque;
61949ab747fSPaolo Bonzini 
62049ab747fSPaolo Bonzini     if (addr & s->mask)
62149ab747fSPaolo Bonzini         kbd_write_command(s, 0, value & 0xff, 1);
62249ab747fSPaolo Bonzini     else
62349ab747fSPaolo Bonzini         kbd_write_data(s, 0, value & 0xff, 1);
62449ab747fSPaolo Bonzini }
62549ab747fSPaolo Bonzini 
6265876503cSPeter Maydell 
62749ab747fSPaolo Bonzini static const MemoryRegionOps i8042_mmio_ops = {
6285876503cSPeter Maydell     .read = kbd_mm_readfn,
6295876503cSPeter Maydell     .write = kbd_mm_writefn,
6305876503cSPeter Maydell     .valid.min_access_size = 1,
6315876503cSPeter Maydell     .valid.max_access_size = 4,
63249ab747fSPaolo Bonzini     .endianness = DEVICE_NATIVE_ENDIAN,
63349ab747fSPaolo Bonzini };
63449ab747fSPaolo Bonzini 
63549ab747fSPaolo Bonzini void i8042_mm_init(qemu_irq kbd_irq, qemu_irq mouse_irq,
63649ab747fSPaolo Bonzini                    MemoryRegion *region, ram_addr_t size,
63749ab747fSPaolo Bonzini                    hwaddr mask)
63849ab747fSPaolo Bonzini {
63949ab747fSPaolo Bonzini     KBDState *s = g_malloc0(sizeof(KBDState));
64049ab747fSPaolo Bonzini 
64149ab747fSPaolo Bonzini     s->irq_kbd = kbd_irq;
64249ab747fSPaolo Bonzini     s->irq_mouse = mouse_irq;
64349ab747fSPaolo Bonzini     s->mask = mask;
64449ab747fSPaolo Bonzini 
645ff6e1624SVolker Rümelin     s->extended_state = true;
646ff6e1624SVolker Rümelin 
64749ab747fSPaolo Bonzini     vmstate_register(NULL, 0, &vmstate_kbd, s);
64849ab747fSPaolo Bonzini 
6492c9b15caSPaolo Bonzini     memory_region_init_io(region, NULL, &i8042_mmio_ops, s, "i8042", size);
65049ab747fSPaolo Bonzini 
65149ab747fSPaolo Bonzini     s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s);
65249ab747fSPaolo Bonzini     s->mouse = ps2_mouse_init(kbd_update_aux_irq, s);
65349ab747fSPaolo Bonzini     qemu_register_reset(kbd_reset, s);
65449ab747fSPaolo Bonzini }
65549ab747fSPaolo Bonzini 
6560fe4bb32SMarc-André Lureau struct ISAKBDState {
657a2e0b863SAndreas Färber     ISADevice parent_obj;
658a2e0b863SAndreas Färber 
65949ab747fSPaolo Bonzini     KBDState kbd;
660d1e45668SVolker Rümelin     bool kbd_throttle;
66149ab747fSPaolo Bonzini     MemoryRegion io[2];
6620fe4bb32SMarc-André Lureau };
66349ab747fSPaolo Bonzini 
6640fe4bb32SMarc-André Lureau void i8042_isa_mouse_fake_event(ISAKBDState *isa)
66549ab747fSPaolo Bonzini {
666a2e0b863SAndreas Färber     KBDState *s = &isa->kbd;
66749ab747fSPaolo Bonzini 
66849ab747fSPaolo Bonzini     ps2_mouse_fake_event(s->mouse);
66949ab747fSPaolo Bonzini }
67049ab747fSPaolo Bonzini 
671d80fe99dSMarc-André Lureau void i8042_setup_a20_line(ISADevice *dev, qemu_irq a20_out)
67249ab747fSPaolo Bonzini {
673d80fe99dSMarc-André Lureau     qdev_connect_gpio_out_named(DEVICE(dev), I8042_A20_LINE, 0, a20_out);
67449ab747fSPaolo Bonzini }
67549ab747fSPaolo Bonzini 
67649ab747fSPaolo Bonzini static const VMStateDescription vmstate_kbd_isa = {
67749ab747fSPaolo Bonzini     .name = "pckbd",
67849ab747fSPaolo Bonzini     .version_id = 3,
67949ab747fSPaolo Bonzini     .minimum_version_id = 3,
68049ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
68149ab747fSPaolo Bonzini         VMSTATE_STRUCT(kbd, ISAKBDState, 0, vmstate_kbd, KBDState),
68249ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
68349ab747fSPaolo Bonzini     }
68449ab747fSPaolo Bonzini };
68549ab747fSPaolo Bonzini 
68649ab747fSPaolo Bonzini static const MemoryRegionOps i8042_data_ops = {
68749ab747fSPaolo Bonzini     .read = kbd_read_data,
68849ab747fSPaolo Bonzini     .write = kbd_write_data,
68949ab747fSPaolo Bonzini     .impl = {
69049ab747fSPaolo Bonzini         .min_access_size = 1,
69149ab747fSPaolo Bonzini         .max_access_size = 1,
69249ab747fSPaolo Bonzini     },
69349ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
69449ab747fSPaolo Bonzini };
69549ab747fSPaolo Bonzini 
69649ab747fSPaolo Bonzini static const MemoryRegionOps i8042_cmd_ops = {
69749ab747fSPaolo Bonzini     .read = kbd_read_status,
69849ab747fSPaolo Bonzini     .write = kbd_write_command,
69949ab747fSPaolo Bonzini     .impl = {
70049ab747fSPaolo Bonzini         .min_access_size = 1,
70149ab747fSPaolo Bonzini         .max_access_size = 1,
70249ab747fSPaolo Bonzini     },
70349ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
70449ab747fSPaolo Bonzini };
70549ab747fSPaolo Bonzini 
706db895a1eSAndreas Färber static void i8042_initfn(Object *obj)
70749ab747fSPaolo Bonzini {
708db895a1eSAndreas Färber     ISAKBDState *isa_s = I8042(obj);
709db895a1eSAndreas Färber     KBDState *s = &isa_s->kbd;
710db895a1eSAndreas Färber 
7111437c94bSPaolo Bonzini     memory_region_init_io(isa_s->io + 0, obj, &i8042_data_ops, s,
7121437c94bSPaolo Bonzini                           "i8042-data", 1);
7131437c94bSPaolo Bonzini     memory_region_init_io(isa_s->io + 1, obj, &i8042_cmd_ops, s,
7141437c94bSPaolo Bonzini                           "i8042-cmd", 1);
7153115b9e2SEfimov Vasily 
7163115b9e2SEfimov Vasily     qdev_init_gpio_out_named(DEVICE(obj), &s->a20_out, I8042_A20_LINE, 1);
717db895a1eSAndreas Färber }
718db895a1eSAndreas Färber 
719db895a1eSAndreas Färber static void i8042_realizefn(DeviceState *dev, Error **errp)
720db895a1eSAndreas Färber {
721db895a1eSAndreas Färber     ISADevice *isadev = ISA_DEVICE(dev);
722a2e0b863SAndreas Färber     ISAKBDState *isa_s = I8042(dev);
72349ab747fSPaolo Bonzini     KBDState *s = &isa_s->kbd;
72449ab747fSPaolo Bonzini 
725db895a1eSAndreas Färber     isa_init_irq(isadev, &s->irq_kbd, 1);
726db895a1eSAndreas Färber     isa_init_irq(isadev, &s->irq_mouse, 12);
72749ab747fSPaolo Bonzini 
728db895a1eSAndreas Färber     isa_register_ioport(isadev, isa_s->io + 0, 0x60);
729db895a1eSAndreas Färber     isa_register_ioport(isadev, isa_s->io + 1, 0x64);
73049ab747fSPaolo Bonzini 
73149ab747fSPaolo Bonzini     s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s);
73249ab747fSPaolo Bonzini     s->mouse = ps2_mouse_init(kbd_update_aux_irq, s);
733d1e45668SVolker Rümelin     if (isa_s->kbd_throttle && !isa_s->kbd.extended_state) {
734d1e45668SVolker Rümelin         warn_report(TYPE_I8042 ": can't enable kbd-throttle without"
735d1e45668SVolker Rümelin                     " extended-state, disabling kbd-throttle");
736d1e45668SVolker Rümelin     } else if (isa_s->kbd_throttle) {
737d1e45668SVolker Rümelin         s->throttle_timer = timer_new_us(QEMU_CLOCK_VIRTUAL,
738d1e45668SVolker Rümelin                                          kbd_throttle_timeout, s);
739d1e45668SVolker Rümelin     }
74049ab747fSPaolo Bonzini     qemu_register_reset(kbd_reset, s);
74149ab747fSPaolo Bonzini }
74249ab747fSPaolo Bonzini 
743df0f3d13SGerd Hoffmann static void i8042_build_aml(ISADevice *isadev, Aml *scope)
744df0f3d13SGerd Hoffmann {
745df0f3d13SGerd Hoffmann     Aml *kbd;
746df0f3d13SGerd Hoffmann     Aml *mou;
747df0f3d13SGerd Hoffmann     Aml *crs;
748df0f3d13SGerd Hoffmann 
749df0f3d13SGerd Hoffmann     crs = aml_resource_template();
750df0f3d13SGerd Hoffmann     aml_append(crs, aml_io(AML_DECODE16, 0x0060, 0x0060, 0x01, 0x01));
751df0f3d13SGerd Hoffmann     aml_append(crs, aml_io(AML_DECODE16, 0x0064, 0x0064, 0x01, 0x01));
752df0f3d13SGerd Hoffmann     aml_append(crs, aml_irq_no_flags(1));
753df0f3d13SGerd Hoffmann 
754df0f3d13SGerd Hoffmann     kbd = aml_device("KBD");
755df0f3d13SGerd Hoffmann     aml_append(kbd, aml_name_decl("_HID", aml_eisaid("PNP0303")));
756df0f3d13SGerd Hoffmann     aml_append(kbd, aml_name_decl("_STA", aml_int(0xf)));
757df0f3d13SGerd Hoffmann     aml_append(kbd, aml_name_decl("_CRS", crs));
758df0f3d13SGerd Hoffmann 
759df0f3d13SGerd Hoffmann     crs = aml_resource_template();
760df0f3d13SGerd Hoffmann     aml_append(crs, aml_irq_no_flags(12));
761df0f3d13SGerd Hoffmann 
762df0f3d13SGerd Hoffmann     mou = aml_device("MOU");
763df0f3d13SGerd Hoffmann     aml_append(mou, aml_name_decl("_HID", aml_eisaid("PNP0F13")));
764df0f3d13SGerd Hoffmann     aml_append(mou, aml_name_decl("_STA", aml_int(0xf)));
765df0f3d13SGerd Hoffmann     aml_append(mou, aml_name_decl("_CRS", crs));
766df0f3d13SGerd Hoffmann 
767df0f3d13SGerd Hoffmann     aml_append(scope, kbd);
768df0f3d13SGerd Hoffmann     aml_append(scope, mou);
769df0f3d13SGerd Hoffmann }
770df0f3d13SGerd Hoffmann 
771ff6e1624SVolker Rümelin static Property i8042_properties[] = {
772ff6e1624SVolker Rümelin     DEFINE_PROP_BOOL("extended-state", ISAKBDState, kbd.extended_state, true),
773d1e45668SVolker Rümelin     DEFINE_PROP_BOOL("kbd-throttle", ISAKBDState, kbd_throttle, false),
774ff6e1624SVolker Rümelin     DEFINE_PROP_END_OF_LIST(),
775ff6e1624SVolker Rümelin };
776ff6e1624SVolker Rümelin 
77749ab747fSPaolo Bonzini static void i8042_class_initfn(ObjectClass *klass, void *data)
77849ab747fSPaolo Bonzini {
77949ab747fSPaolo Bonzini     DeviceClass *dc = DEVICE_CLASS(klass);
780df0f3d13SGerd Hoffmann     ISADeviceClass *isa = ISA_DEVICE_CLASS(klass);
781db895a1eSAndreas Färber 
782ff6e1624SVolker Rümelin     device_class_set_props(dc, i8042_properties);
783db895a1eSAndreas Färber     dc->realize = i8042_realizefn;
78449ab747fSPaolo Bonzini     dc->vmsd = &vmstate_kbd_isa;
785df0f3d13SGerd Hoffmann     isa->build_aml = i8042_build_aml;
786cbe9ed73Skumar sourav     set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
78749ab747fSPaolo Bonzini }
78849ab747fSPaolo Bonzini 
78949ab747fSPaolo Bonzini static const TypeInfo i8042_info = {
790a2e0b863SAndreas Färber     .name          = TYPE_I8042,
79149ab747fSPaolo Bonzini     .parent        = TYPE_ISA_DEVICE,
79249ab747fSPaolo Bonzini     .instance_size = sizeof(ISAKBDState),
793db895a1eSAndreas Färber     .instance_init = i8042_initfn,
79449ab747fSPaolo Bonzini     .class_init    = i8042_class_initfn,
79549ab747fSPaolo Bonzini };
79649ab747fSPaolo Bonzini 
79749ab747fSPaolo Bonzini static void i8042_register_types(void)
79849ab747fSPaolo Bonzini {
79949ab747fSPaolo Bonzini     type_register_static(&i8042_info);
80049ab747fSPaolo Bonzini }
80149ab747fSPaolo Bonzini 
80249ab747fSPaolo Bonzini type_init(i8042_register_types)
803