2 * QEMU PS/2 keyboard/mouse emulation
4 * Copyright (c) 2003 Fabrice Bellard
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
25 #include "qemu/osdep.h"
28 #include "hw/sysbus.h"
29 #include "hw/input/ps2.h"
30 #include "migration/vmstate.h"
31 #include "ui/console.h"
33 #include "sysemu/reset.h"
34 #include "sysemu/runstate.h"
35 #include "qapi/error.h"
39 /* Keyboard Commands */
40 #define KBD_CMD_SET_LEDS 0xED /* Set keyboard leds */
41 #define KBD_CMD_ECHO 0xEE
42 #define KBD_CMD_SCANCODE 0xF0 /* Get/set scancode set */
43 #define KBD_CMD_GET_ID 0xF2 /* get keyboard ID */
44 #define KBD_CMD_SET_RATE 0xF3 /* Set typematic rate */
45 #define KBD_CMD_ENABLE 0xF4 /* Enable scanning */
46 #define KBD_CMD_RESET_DISABLE 0xF5 /* reset and disable scanning */
47 #define KBD_CMD_RESET_ENABLE 0xF6 /* reset and enable scanning */
48 #define KBD_CMD_RESET 0xFF /* Reset */
49 #define KBD_CMD_SET_MAKE_BREAK 0xFC /* Set Make and Break mode */
50 #define KBD_CMD_SET_TYPEMATIC 0xFA /* Set Typematic Make and Break mode */
52 /* Keyboard Replies */
53 #define KBD_REPLY_POR 0xAA /* Power on reset */
54 #define KBD_REPLY_ID 0xAB /* Keyboard ID */
55 #define KBD_REPLY_ACK 0xFA /* Command ACK */
56 #define KBD_REPLY_RESEND 0xFE /* Command NACK, send the cmd again */
59 #define AUX_SET_SCALE11 0xE6 /* Set 1:1 scaling */
60 #define AUX_SET_SCALE21 0xE7 /* Set 2:1 scaling */
61 #define AUX_SET_RES 0xE8 /* Set resolution */
62 #define AUX_GET_SCALE 0xE9 /* Get scaling factor */
63 #define AUX_SET_STREAM 0xEA /* Set stream mode */
64 #define AUX_POLL 0xEB /* Poll */
65 #define AUX_RESET_WRAP 0xEC /* Reset wrap mode */
66 #define AUX_SET_WRAP 0xEE /* Set wrap mode */
67 #define AUX_SET_REMOTE 0xF0 /* Set remote mode */
68 #define AUX_GET_TYPE 0xF2 /* Get type */
69 #define AUX_SET_SAMPLE 0xF3 /* Set sample rate */
70 #define AUX_ENABLE_DEV 0xF4 /* Enable aux device */
71 #define AUX_DISABLE_DEV 0xF5 /* Disable aux device */
72 #define AUX_SET_DEFAULT 0xF6
73 #define AUX_RESET 0xFF /* Reset aux device */
74 #define AUX_ACK 0xFA /* Command byte ACK. */
76 #define MOUSE_STATUS_REMOTE 0x40
77 #define MOUSE_STATUS_ENABLED 0x20
78 #define MOUSE_STATUS_SCALE21 0x10
80 #define PS2_QUEUE_SIZE 16 /* Queue size required by PS/2 protocol */
81 #define PS2_QUEUE_HEADROOM 8 /* Queue size for keyboard command replies */
83 /* Bits for 'modifiers' field in PS2KbdState */
84 #define MOD_CTRL_L (1 << 0)
85 #define MOD_SHIFT_L (1 << 1)
86 #define MOD_ALT_L (1 << 2)
87 #define MOD_CTRL_R (1 << 3)
88 #define MOD_SHIFT_R (1 << 4)
89 #define MOD_ALT_R (1 << 5)
91 static uint8_t translate_table
[256] = {
92 0xff, 0x43, 0x41, 0x3f, 0x3d, 0x3b, 0x3c, 0x58,
93 0x64, 0x44, 0x42, 0x40, 0x3e, 0x0f, 0x29, 0x59,
94 0x65, 0x38, 0x2a, 0x70, 0x1d, 0x10, 0x02, 0x5a,
95 0x66, 0x71, 0x2c, 0x1f, 0x1e, 0x11, 0x03, 0x5b,
96 0x67, 0x2e, 0x2d, 0x20, 0x12, 0x05, 0x04, 0x5c,
97 0x68, 0x39, 0x2f, 0x21, 0x14, 0x13, 0x06, 0x5d,
98 0x69, 0x31, 0x30, 0x23, 0x22, 0x15, 0x07, 0x5e,
99 0x6a, 0x72, 0x32, 0x24, 0x16, 0x08, 0x09, 0x5f,
100 0x6b, 0x33, 0x25, 0x17, 0x18, 0x0b, 0x0a, 0x60,
101 0x6c, 0x34, 0x35, 0x26, 0x27, 0x19, 0x0c, 0x61,
102 0x6d, 0x73, 0x28, 0x74, 0x1a, 0x0d, 0x62, 0x6e,
103 0x3a, 0x36, 0x1c, 0x1b, 0x75, 0x2b, 0x63, 0x76,
104 0x55, 0x56, 0x77, 0x78, 0x79, 0x7a, 0x0e, 0x7b,
105 0x7c, 0x4f, 0x7d, 0x4b, 0x47, 0x7e, 0x7f, 0x6f,
106 0x52, 0x53, 0x50, 0x4c, 0x4d, 0x48, 0x01, 0x45,
107 0x57, 0x4e, 0x51, 0x4a, 0x37, 0x49, 0x46, 0x54,
108 0x80, 0x81, 0x82, 0x41, 0x54, 0x85, 0x86, 0x87,
109 0x88, 0x89, 0x8a, 0x8b, 0x8c, 0x8d, 0x8e, 0x8f,
110 0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97,
111 0x98, 0x99, 0x9a, 0x9b, 0x9c, 0x9d, 0x9e, 0x9f,
112 0xa0, 0xa1, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7,
113 0xa8, 0xa9, 0xaa, 0xab, 0xac, 0xad, 0xae, 0xaf,
114 0xb0, 0xb1, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6, 0xb7,
115 0xb8, 0xb9, 0xba, 0xbb, 0xbc, 0xbd, 0xbe, 0xbf,
116 0xc0, 0xc1, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7,
117 0xc8, 0xc9, 0xca, 0xcb, 0xcc, 0xcd, 0xce, 0xcf,
118 0xd0, 0xd1, 0xd2, 0xd3, 0xd4, 0xd5, 0xd6, 0xd7,
119 0xd8, 0xd9, 0xda, 0xdb, 0xdc, 0xdd, 0xde, 0xdf,
120 0xe0, 0xe1, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7,
121 0xe8, 0xe9, 0xea, 0xeb, 0xec, 0xed, 0xee, 0xef,
122 0xf0, 0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7,
123 0xf8, 0xf9, 0xfa, 0xfb, 0xfc, 0xfd, 0xfe, 0xff,
126 static unsigned int ps2_modifier_bit(QKeyCode key
)
129 case Q_KEY_CODE_CTRL
:
131 case Q_KEY_CODE_CTRL_R
:
133 case Q_KEY_CODE_SHIFT
:
135 case Q_KEY_CODE_SHIFT_R
:
139 case Q_KEY_CODE_ALT_R
:
146 static void ps2_reset_queue(PS2State
*s
)
148 PS2Queue
*q
= &s
->queue
;
156 int ps2_queue_empty(PS2State
*s
)
158 return s
->queue
.count
== 0;
161 void ps2_queue_noirq(PS2State
*s
, int b
)
163 PS2Queue
*q
= &s
->queue
;
165 if (q
->count
>= PS2_QUEUE_SIZE
) {
169 q
->data
[q
->wptr
] = b
;
170 if (++q
->wptr
== PS2_BUFFER_SIZE
) {
176 static void ps2_raise_irq(PS2State
*s
)
178 qemu_set_irq(s
->irq
, 1);
181 static void ps2_lower_irq(PS2State
*s
)
183 qemu_set_irq(s
->irq
, 0);
186 void ps2_queue(PS2State
*s
, int b
)
188 if (PS2_QUEUE_SIZE
- s
->queue
.count
< 1) {
192 ps2_queue_noirq(s
, b
);
196 void ps2_queue_2(PS2State
*s
, int b1
, int b2
)
198 if (PS2_QUEUE_SIZE
- s
->queue
.count
< 2) {
202 ps2_queue_noirq(s
, b1
);
203 ps2_queue_noirq(s
, b2
);
207 void ps2_queue_3(PS2State
*s
, int b1
, int b2
, int b3
)
209 if (PS2_QUEUE_SIZE
- s
->queue
.count
< 3) {
213 ps2_queue_noirq(s
, b1
);
214 ps2_queue_noirq(s
, b2
);
215 ps2_queue_noirq(s
, b3
);
219 void ps2_queue_4(PS2State
*s
, int b1
, int b2
, int b3
, int b4
)
221 if (PS2_QUEUE_SIZE
- s
->queue
.count
< 4) {
225 ps2_queue_noirq(s
, b1
);
226 ps2_queue_noirq(s
, b2
);
227 ps2_queue_noirq(s
, b3
);
228 ps2_queue_noirq(s
, b4
);
232 static void ps2_cqueue_data(PS2Queue
*q
, int b
)
234 q
->data
[q
->cwptr
] = b
;
235 if (++q
->cwptr
>= PS2_BUFFER_SIZE
) {
241 static void ps2_cqueue_1(PS2State
*s
, int b1
)
243 PS2Queue
*q
= &s
->queue
;
245 q
->rptr
= (q
->rptr
- 1) & (PS2_BUFFER_SIZE
- 1);
247 ps2_cqueue_data(q
, b1
);
251 static void ps2_cqueue_2(PS2State
*s
, int b1
, int b2
)
253 PS2Queue
*q
= &s
->queue
;
255 q
->rptr
= (q
->rptr
- 2) & (PS2_BUFFER_SIZE
- 1);
257 ps2_cqueue_data(q
, b1
);
258 ps2_cqueue_data(q
, b2
);
262 static void ps2_cqueue_3(PS2State
*s
, int b1
, int b2
, int b3
)
264 PS2Queue
*q
= &s
->queue
;
266 q
->rptr
= (q
->rptr
- 3) & (PS2_BUFFER_SIZE
- 1);
268 ps2_cqueue_data(q
, b1
);
269 ps2_cqueue_data(q
, b2
);
270 ps2_cqueue_data(q
, b3
);
274 static void ps2_cqueue_reset(PS2State
*s
)
276 PS2Queue
*q
= &s
->queue
;
279 if (q
->cwptr
== -1) {
283 ccount
= (q
->cwptr
- q
->rptr
) & (PS2_BUFFER_SIZE
- 1);
289 /* keycode is the untranslated scancode in the current scancode set. */
290 static void ps2_put_keycode(void *opaque
, int keycode
)
292 PS2KbdState
*s
= opaque
;
293 PS2State
*ps
= PS2_DEVICE(s
);
295 trace_ps2_put_keycode(opaque
, keycode
);
296 qemu_system_wakeup_request(QEMU_WAKEUP_REASON_OTHER
, NULL
);
299 if (keycode
== 0xf0) {
300 s
->need_high_bit
= true;
301 } else if (s
->need_high_bit
) {
302 ps2_queue(ps
, translate_table
[keycode
] | 0x80);
303 s
->need_high_bit
= false;
305 ps2_queue(ps
, translate_table
[keycode
]);
308 ps2_queue(ps
, keycode
);
312 static void ps2_keyboard_event(DeviceState
*dev
, QemuConsole
*src
,
315 PS2KbdState
*s
= (PS2KbdState
*)dev
;
316 InputKeyEvent
*key
= evt
->u
.key
.data
;
318 uint16_t keycode
= 0;
321 /* do not process events while disabled to prevent stream corruption */
322 if (!s
->scan_enabled
) {
326 qemu_system_wakeup_request(QEMU_WAKEUP_REASON_OTHER
, NULL
);
327 assert(evt
->type
== INPUT_EVENT_KIND_KEY
);
328 qcode
= qemu_input_key_value_to_qcode(key
->key
);
330 mod
= ps2_modifier_bit(qcode
);
331 trace_ps2_keyboard_event(s
, qcode
, key
->down
, mod
,
332 s
->modifiers
, s
->scancode_set
, s
->translate
);
336 s
->modifiers
&= ~mod
;
339 if (s
->scancode_set
== 1) {
340 if (qcode
== Q_KEY_CODE_PAUSE
) {
341 if (s
->modifiers
& (MOD_CTRL_L
| MOD_CTRL_R
)) {
343 ps2_put_keycode(s
, 0xe0);
344 ps2_put_keycode(s
, 0x46);
345 ps2_put_keycode(s
, 0xe0);
346 ps2_put_keycode(s
, 0xc6);
350 ps2_put_keycode(s
, 0xe1);
351 ps2_put_keycode(s
, 0x1d);
352 ps2_put_keycode(s
, 0x45);
353 ps2_put_keycode(s
, 0xe1);
354 ps2_put_keycode(s
, 0x9d);
355 ps2_put_keycode(s
, 0xc5);
358 } else if (qcode
== Q_KEY_CODE_PRINT
) {
359 if (s
->modifiers
& MOD_ALT_L
) {
361 ps2_put_keycode(s
, 0xb8);
362 ps2_put_keycode(s
, 0x38);
363 ps2_put_keycode(s
, 0x54);
365 ps2_put_keycode(s
, 0xd4);
366 ps2_put_keycode(s
, 0xb8);
367 ps2_put_keycode(s
, 0x38);
369 } else if (s
->modifiers
& MOD_ALT_R
) {
371 ps2_put_keycode(s
, 0xe0);
372 ps2_put_keycode(s
, 0xb8);
373 ps2_put_keycode(s
, 0xe0);
374 ps2_put_keycode(s
, 0x38);
375 ps2_put_keycode(s
, 0x54);
377 ps2_put_keycode(s
, 0xd4);
378 ps2_put_keycode(s
, 0xe0);
379 ps2_put_keycode(s
, 0xb8);
380 ps2_put_keycode(s
, 0xe0);
381 ps2_put_keycode(s
, 0x38);
383 } else if (s
->modifiers
& (MOD_SHIFT_L
| MOD_CTRL_L
|
384 MOD_SHIFT_R
| MOD_CTRL_R
)) {
386 ps2_put_keycode(s
, 0xe0);
387 ps2_put_keycode(s
, 0x37);
389 ps2_put_keycode(s
, 0xe0);
390 ps2_put_keycode(s
, 0xb7);
394 ps2_put_keycode(s
, 0xe0);
395 ps2_put_keycode(s
, 0x2a);
396 ps2_put_keycode(s
, 0xe0);
397 ps2_put_keycode(s
, 0x37);
399 ps2_put_keycode(s
, 0xe0);
400 ps2_put_keycode(s
, 0xb7);
401 ps2_put_keycode(s
, 0xe0);
402 ps2_put_keycode(s
, 0xaa);
406 if (qcode
< qemu_input_map_qcode_to_atset1_len
) {
407 keycode
= qemu_input_map_qcode_to_atset1
[qcode
];
410 if (keycode
& 0xff00) {
411 ps2_put_keycode(s
, keycode
>> 8);
416 ps2_put_keycode(s
, keycode
& 0xff);
418 qemu_log_mask(LOG_UNIMP
,
419 "ps2: ignoring key with qcode %d\n", qcode
);
422 } else if (s
->scancode_set
== 2) {
423 if (qcode
== Q_KEY_CODE_PAUSE
) {
424 if (s
->modifiers
& (MOD_CTRL_L
| MOD_CTRL_R
)) {
426 ps2_put_keycode(s
, 0xe0);
427 ps2_put_keycode(s
, 0x7e);
428 ps2_put_keycode(s
, 0xe0);
429 ps2_put_keycode(s
, 0xf0);
430 ps2_put_keycode(s
, 0x7e);
434 ps2_put_keycode(s
, 0xe1);
435 ps2_put_keycode(s
, 0x14);
436 ps2_put_keycode(s
, 0x77);
437 ps2_put_keycode(s
, 0xe1);
438 ps2_put_keycode(s
, 0xf0);
439 ps2_put_keycode(s
, 0x14);
440 ps2_put_keycode(s
, 0xf0);
441 ps2_put_keycode(s
, 0x77);
444 } else if (qcode
== Q_KEY_CODE_PRINT
) {
445 if (s
->modifiers
& MOD_ALT_L
) {
447 ps2_put_keycode(s
, 0xf0);
448 ps2_put_keycode(s
, 0x11);
449 ps2_put_keycode(s
, 0x11);
450 ps2_put_keycode(s
, 0x84);
452 ps2_put_keycode(s
, 0xf0);
453 ps2_put_keycode(s
, 0x84);
454 ps2_put_keycode(s
, 0xf0);
455 ps2_put_keycode(s
, 0x11);
456 ps2_put_keycode(s
, 0x11);
458 } else if (s
->modifiers
& MOD_ALT_R
) {
460 ps2_put_keycode(s
, 0xe0);
461 ps2_put_keycode(s
, 0xf0);
462 ps2_put_keycode(s
, 0x11);
463 ps2_put_keycode(s
, 0xe0);
464 ps2_put_keycode(s
, 0x11);
465 ps2_put_keycode(s
, 0x84);
467 ps2_put_keycode(s
, 0xf0);
468 ps2_put_keycode(s
, 0x84);
469 ps2_put_keycode(s
, 0xe0);
470 ps2_put_keycode(s
, 0xf0);
471 ps2_put_keycode(s
, 0x11);
472 ps2_put_keycode(s
, 0xe0);
473 ps2_put_keycode(s
, 0x11);
475 } else if (s
->modifiers
& (MOD_SHIFT_L
| MOD_CTRL_L
|
476 MOD_SHIFT_R
| MOD_CTRL_R
)) {
478 ps2_put_keycode(s
, 0xe0);
479 ps2_put_keycode(s
, 0x7c);
481 ps2_put_keycode(s
, 0xe0);
482 ps2_put_keycode(s
, 0xf0);
483 ps2_put_keycode(s
, 0x7c);
487 ps2_put_keycode(s
, 0xe0);
488 ps2_put_keycode(s
, 0x12);
489 ps2_put_keycode(s
, 0xe0);
490 ps2_put_keycode(s
, 0x7c);
492 ps2_put_keycode(s
, 0xe0);
493 ps2_put_keycode(s
, 0xf0);
494 ps2_put_keycode(s
, 0x7c);
495 ps2_put_keycode(s
, 0xe0);
496 ps2_put_keycode(s
, 0xf0);
497 ps2_put_keycode(s
, 0x12);
501 if (qcode
< qemu_input_map_qcode_to_atset2_len
) {
502 keycode
= qemu_input_map_qcode_to_atset2
[qcode
];
505 if (keycode
& 0xff00) {
506 ps2_put_keycode(s
, keycode
>> 8);
509 ps2_put_keycode(s
, 0xf0);
511 ps2_put_keycode(s
, keycode
& 0xff);
513 qemu_log_mask(LOG_UNIMP
,
514 "ps2: ignoring key with qcode %d\n", qcode
);
517 } else if (s
->scancode_set
== 3) {
518 if (qcode
< qemu_input_map_qcode_to_atset3_len
) {
519 keycode
= qemu_input_map_qcode_to_atset3
[qcode
];
522 /* FIXME: break code should be configured on a key by key basis */
524 ps2_put_keycode(s
, 0xf0);
526 ps2_put_keycode(s
, keycode
);
528 qemu_log_mask(LOG_UNIMP
,
529 "ps2: ignoring key with qcode %d\n", qcode
);
534 uint32_t ps2_read_data(PS2State
*s
)
539 trace_ps2_read_data(s
);
543 * NOTE: if no data left, we return the last keyboard one
544 * (needed for EMM386)
546 /* XXX: need a timer to do things correctly */
549 index
= PS2_BUFFER_SIZE
- 1;
551 val
= q
->data
[index
];
553 val
= q
->data
[q
->rptr
];
554 if (++q
->rptr
== PS2_BUFFER_SIZE
) {
558 if (q
->rptr
== q
->cwptr
) {
559 /* command reply queue is empty */
562 /* reading deasserts IRQ */
564 /* reassert IRQs if data left */
572 static void ps2_set_ledstate(PS2KbdState
*s
, int ledstate
)
574 trace_ps2_set_ledstate(s
, ledstate
);
575 s
->ledstate
= ledstate
;
576 kbd_put_ledstate(ledstate
);
579 static void ps2_reset_keyboard(PS2KbdState
*s
)
581 PS2State
*ps2
= PS2_DEVICE(s
);
583 trace_ps2_reset_keyboard(s
);
586 ps2_reset_queue(ps2
);
587 ps2_set_ledstate(s
, 0);
590 void ps2_write_keyboard(PS2KbdState
*s
, int val
)
592 PS2State
*ps2
= PS2_DEVICE(s
);
594 trace_ps2_write_keyboard(s
, val
);
595 ps2_cqueue_reset(ps2
);
596 switch (ps2
->write_cmd
) {
601 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
604 ps2_cqueue_1(ps2
, KBD_REPLY_RESEND
);
607 /* We emulate a MF2 AT keyboard here */
608 ps2_cqueue_3(ps2
, KBD_REPLY_ACK
, KBD_REPLY_ID
,
609 s
->translate
? 0x41 : 0x83);
612 ps2_cqueue_1(ps2
, KBD_CMD_ECHO
);
616 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
618 case KBD_CMD_SCANCODE
:
619 case KBD_CMD_SET_LEDS
:
620 case KBD_CMD_SET_RATE
:
621 case KBD_CMD_SET_MAKE_BREAK
:
622 ps2
->write_cmd
= val
;
623 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
625 case KBD_CMD_RESET_DISABLE
:
626 ps2_reset_keyboard(s
);
628 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
630 case KBD_CMD_RESET_ENABLE
:
631 ps2_reset_keyboard(s
);
633 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
636 ps2_reset_keyboard(s
);
641 case KBD_CMD_SET_TYPEMATIC
:
642 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
645 ps2_cqueue_1(ps2
, KBD_REPLY_RESEND
);
649 case KBD_CMD_SET_MAKE_BREAK
:
650 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
653 case KBD_CMD_SCANCODE
:
655 ps2_cqueue_2(ps2
, KBD_REPLY_ACK
, s
->translate
?
656 translate_table
[s
->scancode_set
] : s
->scancode_set
);
657 } else if (val
>= 1 && val
<= 3) {
658 s
->scancode_set
= val
;
659 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
661 ps2_cqueue_1(ps2
, KBD_REPLY_RESEND
);
665 case KBD_CMD_SET_LEDS
:
666 ps2_set_ledstate(s
, val
);
667 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
670 case KBD_CMD_SET_RATE
:
671 ps2_cqueue_1(ps2
, KBD_REPLY_ACK
);
678 * Set the scancode translation mode.
680 * 1 = translated scancodes (used by qemu internally).
683 void ps2_keyboard_set_translation(PS2KbdState
*s
, int mode
)
685 trace_ps2_keyboard_set_translation(s
, mode
);
689 static int ps2_mouse_send_packet(PS2MouseState
*s
)
691 PS2State
*ps2
= PS2_DEVICE(s
);
692 /* IMPS/2 and IMEX send 4 bytes, PS2 sends 3 bytes */
693 const int needed
= s
->mouse_type
? 4 : 3;
695 int dx1
, dy1
, dz1
, dw1
;
697 if (PS2_QUEUE_SIZE
- ps2
->queue
.count
< needed
) {
705 /* XXX: increase range to 8 bits ? */
708 } else if (dx1
< -127) {
713 } else if (dy1
< -127) {
716 b
= 0x08 | ((dx1
< 0) << 4) | ((dy1
< 0) << 5) | (s
->mouse_buttons
& 0x07);
717 ps2_queue_noirq(ps2
, b
);
718 ps2_queue_noirq(ps2
, dx1
& 0xff);
719 ps2_queue_noirq(ps2
, dy1
& 0xff);
720 /* extra byte for IMPS/2 or IMEX */
721 switch (s
->mouse_type
) {
723 /* Just ignore the wheels if not supported */
730 } else if (dz1
< -127) {
733 ps2_queue_noirq(ps2
, dz1
& 0xff);
739 * This matches what the Linux kernel expects for exps/2 in
740 * drivers/input/mouse/psmouse-base.c. Note, if you happen to
741 * press/release the 4th or 5th buttons at the same moment as a
742 * horizontal wheel scroll, those button presses will get lost. I'm not
743 * sure what to do about that, since by this point we don't know
744 * whether those buttons actually changed state.
749 } else if (dw1
< -31) {
754 * linux kernel expects first 6 bits to represent the value
755 * for horizontal scroll
757 b
= (dw1
& 0x3f) | 0x40;
762 } else if (dz1
< -7) {
766 b
= (dz1
& 0x0f) | ((s
->mouse_buttons
& 0x18) << 1);
769 ps2_queue_noirq(ps2
, b
);
775 trace_ps2_mouse_send_packet(s
, dx1
, dy1
, dz1
, b
);
783 static void ps2_mouse_event(DeviceState
*dev
, QemuConsole
*src
,
786 static const int bmap
[INPUT_BUTTON__MAX
] = {
787 [INPUT_BUTTON_LEFT
] = PS2_MOUSE_BUTTON_LEFT
,
788 [INPUT_BUTTON_MIDDLE
] = PS2_MOUSE_BUTTON_MIDDLE
,
789 [INPUT_BUTTON_RIGHT
] = PS2_MOUSE_BUTTON_RIGHT
,
790 [INPUT_BUTTON_SIDE
] = PS2_MOUSE_BUTTON_SIDE
,
791 [INPUT_BUTTON_EXTRA
] = PS2_MOUSE_BUTTON_EXTRA
,
793 PS2MouseState
*s
= (PS2MouseState
*)dev
;
794 InputMoveEvent
*move
;
797 /* check if deltas are recorded when disabled */
798 if (!(s
->mouse_status
& MOUSE_STATUS_ENABLED
)) {
803 case INPUT_EVENT_KIND_REL
:
804 move
= evt
->u
.rel
.data
;
805 if (move
->axis
== INPUT_AXIS_X
) {
806 s
->mouse_dx
+= move
->value
;
807 } else if (move
->axis
== INPUT_AXIS_Y
) {
808 s
->mouse_dy
-= move
->value
;
812 case INPUT_EVENT_KIND_BTN
:
813 btn
= evt
->u
.btn
.data
;
815 s
->mouse_buttons
|= bmap
[btn
->button
];
816 if (btn
->button
== INPUT_BUTTON_WHEEL_UP
) {
818 } else if (btn
->button
== INPUT_BUTTON_WHEEL_DOWN
) {
822 if (btn
->button
== INPUT_BUTTON_WHEEL_RIGHT
) {
824 } else if (btn
->button
== INPUT_BUTTON_WHEEL_LEFT
) {
828 s
->mouse_buttons
&= ~bmap
[btn
->button
];
838 static void ps2_mouse_sync(DeviceState
*dev
)
840 PS2MouseState
*s
= (PS2MouseState
*)dev
;
842 /* do not sync while disabled to prevent stream corruption */
843 if (!(s
->mouse_status
& MOUSE_STATUS_ENABLED
)) {
847 if (s
->mouse_buttons
) {
848 qemu_system_wakeup_request(QEMU_WAKEUP_REASON_OTHER
, NULL
);
850 if (!(s
->mouse_status
& MOUSE_STATUS_REMOTE
)) {
852 * if not remote, send event. Multiple events are sent if
855 while (ps2_mouse_send_packet(s
)) {
856 if (s
->mouse_dx
== 0 && s
->mouse_dy
== 0
857 && s
->mouse_dz
== 0 && s
->mouse_dw
== 0) {
864 void ps2_mouse_fake_event(PS2MouseState
*s
)
866 trace_ps2_mouse_fake_event(s
);
868 ps2_mouse_sync(DEVICE(s
));
871 void ps2_write_mouse(PS2MouseState
*s
, int val
)
873 PS2State
*ps2
= PS2_DEVICE(s
);
875 trace_ps2_write_mouse(s
, val
);
876 switch (ps2
->write_cmd
) {
881 if (val
== AUX_RESET_WRAP
) {
883 ps2_queue(ps2
, AUX_ACK
);
885 } else if (val
!= AUX_RESET
) {
891 case AUX_SET_SCALE11
:
892 s
->mouse_status
&= ~MOUSE_STATUS_SCALE21
;
893 ps2_queue(ps2
, AUX_ACK
);
895 case AUX_SET_SCALE21
:
896 s
->mouse_status
|= MOUSE_STATUS_SCALE21
;
897 ps2_queue(ps2
, AUX_ACK
);
900 s
->mouse_status
&= ~MOUSE_STATUS_REMOTE
;
901 ps2_queue(ps2
, AUX_ACK
);
905 ps2_queue(ps2
, AUX_ACK
);
908 s
->mouse_status
|= MOUSE_STATUS_REMOTE
;
909 ps2_queue(ps2
, AUX_ACK
);
918 ps2
->write_cmd
= val
;
919 ps2_queue(ps2
, AUX_ACK
);
926 s
->mouse_sample_rate
);
929 ps2_queue(ps2
, AUX_ACK
);
930 ps2_mouse_send_packet(s
);
933 s
->mouse_status
|= MOUSE_STATUS_ENABLED
;
934 ps2_queue(ps2
, AUX_ACK
);
936 case AUX_DISABLE_DEV
:
937 s
->mouse_status
&= ~MOUSE_STATUS_ENABLED
;
938 ps2_queue(ps2
, AUX_ACK
);
940 case AUX_SET_DEFAULT
:
941 s
->mouse_sample_rate
= 100;
942 s
->mouse_resolution
= 2;
944 ps2_queue(ps2
, AUX_ACK
);
947 s
->mouse_sample_rate
= 100;
948 s
->mouse_resolution
= 2;
951 ps2_reset_queue(ps2
);
962 s
->mouse_sample_rate
= val
;
963 /* detect IMPS/2 or IMEX */
964 switch (s
->mouse_detect_state
) {
968 s
->mouse_detect_state
= 1;
973 s
->mouse_detect_state
= 2;
974 } else if (val
== 200) {
975 s
->mouse_detect_state
= 3;
977 s
->mouse_detect_state
= 0;
982 s
->mouse_type
= 3; /* IMPS/2 */
984 s
->mouse_detect_state
= 0;
988 s
->mouse_type
= 4; /* IMEX */
990 s
->mouse_detect_state
= 0;
993 ps2_queue(ps2
, AUX_ACK
);
997 s
->mouse_resolution
= val
;
998 ps2_queue(ps2
, AUX_ACK
);
1004 static void ps2_reset(DeviceState
*dev
)
1006 PS2State
*s
= PS2_DEVICE(dev
);
1013 static void ps2_common_post_load(PS2State
*s
)
1015 PS2Queue
*q
= &s
->queue
;
1018 /* limit the number of queued command replies to PS2_QUEUE_HEADROOM */
1019 if (q
->cwptr
!= -1) {
1020 ccount
= (q
->cwptr
- q
->rptr
) & (PS2_BUFFER_SIZE
- 1);
1021 if (ccount
> PS2_QUEUE_HEADROOM
) {
1022 ccount
= PS2_QUEUE_HEADROOM
;
1026 /* limit the scancode queue size to PS2_QUEUE_SIZE */
1027 if (q
->count
< ccount
) {
1029 } else if (q
->count
> ccount
+ PS2_QUEUE_SIZE
) {
1030 q
->count
= ccount
+ PS2_QUEUE_SIZE
;
1033 /* sanitize rptr and recalculate wptr and cwptr */
1034 q
->rptr
= q
->rptr
& (PS2_BUFFER_SIZE
- 1);
1035 q
->wptr
= (q
->rptr
+ q
->count
) & (PS2_BUFFER_SIZE
- 1);
1036 q
->cwptr
= ccount
? (q
->rptr
+ ccount
) & (PS2_BUFFER_SIZE
- 1) : -1;
1039 static void ps2_kbd_reset(DeviceState
*dev
)
1041 PS2DeviceClass
*ps2dc
= PS2_DEVICE_GET_CLASS(dev
);
1042 PS2KbdState
*s
= PS2_KBD_DEVICE(dev
);
1044 trace_ps2_kbd_reset(s
);
1045 ps2dc
->parent_reset(dev
);
1047 s
->scan_enabled
= 1;
1049 s
->scancode_set
= 2;
1053 static void ps2_mouse_reset(DeviceState
*dev
)
1055 PS2DeviceClass
*ps2dc
= PS2_DEVICE_GET_CLASS(dev
);
1056 PS2MouseState
*s
= PS2_MOUSE_DEVICE(dev
);
1058 trace_ps2_mouse_reset(s
);
1059 ps2dc
->parent_reset(dev
);
1061 s
->mouse_status
= 0;
1062 s
->mouse_resolution
= 0;
1063 s
->mouse_sample_rate
= 0;
1066 s
->mouse_detect_state
= 0;
1071 s
->mouse_buttons
= 0;
1074 static const VMStateDescription vmstate_ps2_common
= {
1075 .name
= "PS2 Common State",
1077 .minimum_version_id
= 2,
1078 .fields
= (VMStateField
[]) {
1079 VMSTATE_INT32(write_cmd
, PS2State
),
1080 VMSTATE_INT32(queue
.rptr
, PS2State
),
1081 VMSTATE_INT32(queue
.wptr
, PS2State
),
1082 VMSTATE_INT32(queue
.count
, PS2State
),
1083 VMSTATE_BUFFER(queue
.data
, PS2State
),
1084 VMSTATE_END_OF_LIST()
1088 static bool ps2_keyboard_ledstate_needed(void *opaque
)
1090 PS2KbdState
*s
= opaque
;
1092 return s
->ledstate
!= 0; /* 0 is default state */
1095 static int ps2_kbd_ledstate_post_load(void *opaque
, int version_id
)
1097 PS2KbdState
*s
= opaque
;
1099 kbd_put_ledstate(s
->ledstate
);
1103 static const VMStateDescription vmstate_ps2_keyboard_ledstate
= {
1104 .name
= "ps2kbd/ledstate",
1106 .minimum_version_id
= 2,
1107 .post_load
= ps2_kbd_ledstate_post_load
,
1108 .needed
= ps2_keyboard_ledstate_needed
,
1109 .fields
= (VMStateField
[]) {
1110 VMSTATE_INT32(ledstate
, PS2KbdState
),
1111 VMSTATE_END_OF_LIST()
1115 static bool ps2_keyboard_need_high_bit_needed(void *opaque
)
1117 PS2KbdState
*s
= opaque
;
1118 return s
->need_high_bit
!= 0; /* 0 is the usual state */
1121 static const VMStateDescription vmstate_ps2_keyboard_need_high_bit
= {
1122 .name
= "ps2kbd/need_high_bit",
1124 .minimum_version_id
= 1,
1125 .needed
= ps2_keyboard_need_high_bit_needed
,
1126 .fields
= (VMStateField
[]) {
1127 VMSTATE_BOOL(need_high_bit
, PS2KbdState
),
1128 VMSTATE_END_OF_LIST()
1132 static bool ps2_keyboard_cqueue_needed(void *opaque
)
1134 PS2KbdState
*s
= opaque
;
1135 PS2State
*ps2
= PS2_DEVICE(s
);
1137 return ps2
->queue
.cwptr
!= -1; /* the queue is mostly empty */
1140 static const VMStateDescription vmstate_ps2_keyboard_cqueue
= {
1141 .name
= "ps2kbd/command_reply_queue",
1142 .needed
= ps2_keyboard_cqueue_needed
,
1143 .fields
= (VMStateField
[]) {
1144 VMSTATE_INT32(parent_obj
.queue
.cwptr
, PS2KbdState
),
1145 VMSTATE_END_OF_LIST()
1149 static int ps2_kbd_post_load(void *opaque
, int version_id
)
1151 PS2KbdState
*s
= (PS2KbdState
*)opaque
;
1152 PS2State
*ps2
= PS2_DEVICE(s
);
1154 if (version_id
== 2) {
1155 s
->scancode_set
= 2;
1158 ps2_common_post_load(ps2
);
1163 static const VMStateDescription vmstate_ps2_keyboard
= {
1166 .minimum_version_id
= 2,
1167 .post_load
= ps2_kbd_post_load
,
1168 .fields
= (VMStateField
[]) {
1169 VMSTATE_STRUCT(parent_obj
, PS2KbdState
, 0, vmstate_ps2_common
,
1171 VMSTATE_INT32(scan_enabled
, PS2KbdState
),
1172 VMSTATE_INT32(translate
, PS2KbdState
),
1173 VMSTATE_INT32_V(scancode_set
, PS2KbdState
, 3),
1174 VMSTATE_END_OF_LIST()
1176 .subsections
= (const VMStateDescription
* []) {
1177 &vmstate_ps2_keyboard_ledstate
,
1178 &vmstate_ps2_keyboard_need_high_bit
,
1179 &vmstate_ps2_keyboard_cqueue
,
1184 static int ps2_mouse_post_load(void *opaque
, int version_id
)
1186 PS2MouseState
*s
= (PS2MouseState
*)opaque
;
1187 PS2State
*ps2
= PS2_DEVICE(s
);
1189 ps2_common_post_load(ps2
);
1194 static const VMStateDescription vmstate_ps2_mouse
= {
1197 .minimum_version_id
= 2,
1198 .post_load
= ps2_mouse_post_load
,
1199 .fields
= (VMStateField
[]) {
1200 VMSTATE_STRUCT(parent_obj
, PS2MouseState
, 0, vmstate_ps2_common
,
1202 VMSTATE_UINT8(mouse_status
, PS2MouseState
),
1203 VMSTATE_UINT8(mouse_resolution
, PS2MouseState
),
1204 VMSTATE_UINT8(mouse_sample_rate
, PS2MouseState
),
1205 VMSTATE_UINT8(mouse_wrap
, PS2MouseState
),
1206 VMSTATE_UINT8(mouse_type
, PS2MouseState
),
1207 VMSTATE_UINT8(mouse_detect_state
, PS2MouseState
),
1208 VMSTATE_INT32(mouse_dx
, PS2MouseState
),
1209 VMSTATE_INT32(mouse_dy
, PS2MouseState
),
1210 VMSTATE_INT32(mouse_dz
, PS2MouseState
),
1211 VMSTATE_UINT8(mouse_buttons
, PS2MouseState
),
1212 VMSTATE_END_OF_LIST()
1216 static QemuInputHandler ps2_keyboard_handler
= {
1217 .name
= "QEMU PS/2 Keyboard",
1218 .mask
= INPUT_EVENT_MASK_KEY
,
1219 .event
= ps2_keyboard_event
,
1222 static void ps2_kbd_realize(DeviceState
*dev
, Error
**errp
)
1224 qemu_input_handler_register(dev
, &ps2_keyboard_handler
);
1227 static QemuInputHandler ps2_mouse_handler
= {
1228 .name
= "QEMU PS/2 Mouse",
1229 .mask
= INPUT_EVENT_MASK_BTN
| INPUT_EVENT_MASK_REL
,
1230 .event
= ps2_mouse_event
,
1231 .sync
= ps2_mouse_sync
,
1234 static void ps2_mouse_realize(DeviceState
*dev
, Error
**errp
)
1236 qemu_input_handler_register(dev
, &ps2_mouse_handler
);
1239 static void ps2_kbd_class_init(ObjectClass
*klass
, void *data
)
1241 DeviceClass
*dc
= DEVICE_CLASS(klass
);
1242 PS2DeviceClass
*ps2dc
= PS2_DEVICE_CLASS(klass
);
1244 dc
->realize
= ps2_kbd_realize
;
1245 device_class_set_parent_reset(dc
, ps2_kbd_reset
, &ps2dc
->parent_reset
);
1246 dc
->vmsd
= &vmstate_ps2_keyboard
;
1249 static const TypeInfo ps2_kbd_info
= {
1250 .name
= TYPE_PS2_KBD_DEVICE
,
1251 .parent
= TYPE_PS2_DEVICE
,
1252 .instance_size
= sizeof(PS2KbdState
),
1253 .class_init
= ps2_kbd_class_init
1256 static void ps2_mouse_class_init(ObjectClass
*klass
, void *data
)
1258 DeviceClass
*dc
= DEVICE_CLASS(klass
);
1259 PS2DeviceClass
*ps2dc
= PS2_DEVICE_CLASS(klass
);
1261 dc
->realize
= ps2_mouse_realize
;
1262 device_class_set_parent_reset(dc
, ps2_mouse_reset
,
1263 &ps2dc
->parent_reset
);
1264 dc
->vmsd
= &vmstate_ps2_mouse
;
1267 static const TypeInfo ps2_mouse_info
= {
1268 .name
= TYPE_PS2_MOUSE_DEVICE
,
1269 .parent
= TYPE_PS2_DEVICE
,
1270 .instance_size
= sizeof(PS2MouseState
),
1271 .class_init
= ps2_mouse_class_init
1274 static void ps2_init(Object
*obj
)
1276 PS2State
*s
= PS2_DEVICE(obj
);
1278 qdev_init_gpio_out(DEVICE(obj
), &s
->irq
, 1);
1281 static void ps2_class_init(ObjectClass
*klass
, void *data
)
1283 DeviceClass
*dc
= DEVICE_CLASS(klass
);
1285 dc
->reset
= ps2_reset
;
1286 set_bit(DEVICE_CATEGORY_INPUT
, dc
->categories
);
1289 static const TypeInfo ps2_info
= {
1290 .name
= TYPE_PS2_DEVICE
,
1291 .parent
= TYPE_SYS_BUS_DEVICE
,
1292 .instance_init
= ps2_init
,
1293 .instance_size
= sizeof(PS2State
),
1294 .class_init
= ps2_class_init
,
1295 .class_size
= sizeof(PS2DeviceClass
),
1299 static void ps2_register_types(void)
1301 type_register_static(&ps2_info
);
1302 type_register_static(&ps2_kbd_info
);
1303 type_register_static(&ps2_mouse_info
);
1306 type_init(ps2_register_types
)