5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define LOG_GROUP LOG_GROUP_DEV_KBD

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#include "vl_vbox.h"

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#include <VBox/pdmdev.h>

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#include <iprt/assert.h>

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#include "../Builtins.h"

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define PCKBD_SAVED_STATE_VERSION 2

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX_DEVICE_STRUCT_TESTCASE

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncPDMBOTHCBDECL(int) kbdIOPortDataRead(PPDMDEVINS pDevIns, void *pvUser, RTIOPORT Port, uint32_t *pu32, unsigned cb);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncPDMBOTHCBDECL(int) kbdIOPortDataWrite(PPDMDEVINS pDevIns, void *pvUser, RTIOPORT Port, uint32_t u32, unsigned cb);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncPDMBOTHCBDECL(int) kbdIOPortStatusRead(PPDMDEVINS pDevIns, void *pvUser, RTIOPORT Port, uint32_t *pu32, unsigned cb);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncPDMBOTHCBDECL(int) kbdIOPortCommandWrite(PPDMDEVINS pDevIns, void *pvUser, RTIOPORT Port, uint32_t u32, unsigned cb);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX_DEVICE_STRUCT_TESTCASE */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#include "vl.h"

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define DEBUG_KBD

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define DEBUG_MOUSE

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_READ_MODE 0x20 /* Read mode bits */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_WRITE_MODE 0x60 /* Write mode bits */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_GET_VERSION 0xA1 /* Get controller version */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_MOUSE_DISABLE 0xA7 /* Disable mouse interface */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_MOUSE_ENABLE 0xA8 /* Enable mouse interface */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_TEST_MOUSE 0xA9 /* Mouse interface test */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_SELF_TEST 0xAA /* Controller self test */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_KBD_TEST 0xAB /* Keyboard interface test */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_KBD_DISABLE 0xAD /* Keyboard interface disable */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_KBD_ENABLE 0xAE /* Keyboard interface enable */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_READ_INPORT 0xC0 /* read input port */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_READ_OUTPORT 0xD0 /* read output port */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_WRITE_OUTPORT 0xD1 /* write output port */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_WRITE_OBUF 0xD2

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_WRITE_AUX_OBUF 0xD3 /* Write to output buffer as if

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_WRITE_MOUSE 0xD4 /* Write the following byte to the mouse */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_DISABLE_A20 0xDD /* HP vectra only ? */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_ENABLE_A20 0xDF /* HP vectra only ? */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_READ_TSTINP 0xE0 /* Read test inputs T0, T1 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CCMD_RESET 0xFE

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_SET_LEDS 0xED /* Set keyboard leds */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_ECHO 0xEE

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_GET_ID 0xF2 /* get keyboard ID */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_SET_RATE 0xF3 /* Set typematic rate */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_ENABLE 0xF4 /* Enable scanning */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_RESET_DISABLE 0xF5 /* reset and disable scanning */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_RESET_ENABLE 0xF6 /* reset and enable scanning */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_CMD_RESET 0xFF /* Reset */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_REPLY_POR 0xAA /* Power on reset */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_REPLY_ACK 0xFA /* Command ACK */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_REPLY_RESEND 0xFE /* Command NACK, send the cmd again */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_OBF 0x01 /* Keyboard output buffer full */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_IBF 0x02 /* Keyboard input buffer full */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_SELFTEST 0x04 /* Self test successful */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_CMD 0x08 /* Last write was a command write (0=data) */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_UNLOCKED 0x10 /* Zero if keyboard locked */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_MOUSE_OBF 0x20 /* Mouse output buffer full */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_GTO 0x40 /* General receive/xmit timeout */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_STAT_PERR 0x80 /* Parity error */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_KBD_INT 0x01 /* Keyboard data generate IRQ1 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_MOUSE_INT 0x02 /* Mouse data generate IRQ12 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_SYS 0x04 /* The system flag (?) */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_NO_KEYLOCK 0x08 /* The keylock doesn't affect the keyboard if set */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_DISABLE_KBD 0x10 /* Disable keyboard interface */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_DISABLE_MOUSE 0x20 /* Disable mouse interface */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_KCC 0x40 /* Scan code conversion to PC format */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_MODE_RFU 0x80

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_SCALE11 0xE6 /* Set 1:1 scaling */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_SCALE21 0xE7 /* Set 2:1 scaling */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_RES 0xE8 /* Set resolution */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_GET_SCALE 0xE9 /* Get scaling factor */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_STREAM 0xEA /* Set stream mode */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_POLL 0xEB /* Poll */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_RESET_WRAP 0xEC /* Reset wrap mode */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_WRAP 0xEE /* Set wrap mode */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_REMOTE 0xF0 /* Set remote mode */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_GET_TYPE 0xF2 /* Get type */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_SAMPLE 0xF3 /* Set sample rate */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_ENABLE_DEV 0xF4 /* Enable aux device */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_DISABLE_DEV 0xF5 /* Disable aux device */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_SET_DEFAULT 0xF6

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_RESET 0xFF /* Reset aux device */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_ACK 0xFA /* Command byte ACK. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define AUX_NACK 0xFE /* Command byte NACK. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define MOUSE_STATUS_REMOTE 0x40

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define MOUSE_STATUS_ENABLED 0x20

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define MOUSE_STATUS_SCALE21 0x10

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define KBD_QUEUE_SIZE 256

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsynctypedef struct {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t aux[KBD_QUEUE_SIZE];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t data[KBD_QUEUE_SIZE];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int rptr, wptr, count;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync} KBDQueue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define MOUSE_CMD_QUEUE_SIZE 8

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsynctypedef struct {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t data[MOUSE_CMD_QUEUE_SIZE];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int rptr, wptr, count;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync} MouseCmdQueue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#define MOUSE_EVENT_QUEUE_SIZE 256

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsynctypedef struct {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t data[MOUSE_EVENT_QUEUE_SIZE];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int rptr, wptr, count;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync} MouseEventQueue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsynctypedef struct KBDState {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDQueue queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseCmdQueue mouse_command_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseEventQueue mouse_event_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t write_cmd; /* if non zero, write data to port 60 is expected */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t status;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mode;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* keyboard state */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int32_t kbd_write_cmd;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int32_t scan_enabled;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* mouse state */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int32_t mouse_write_cmd;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_status;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_resolution;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_sample_rate;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_wrap;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_type; /* 0 = PS2, 3 = IMPS/2, 4 = IMEX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_detect_state;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int32_t mouse_dx; /* current values, needed for 'poll' mode */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int32_t mouse_dy;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int32_t mouse_dz;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync uint8_t mouse_buttons;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** Pointer to the device instance - RC. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PPDMDEVINSRC pDevInsRC;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** Pointer to the device instance - R3 . */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PPDMDEVINSR3 pDevInsR3;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** Pointer to the device instance. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PPDMDEVINSR0 pDevInsR0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** Critical section protecting the state. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMCRITSECT CritSect;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /**

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync struct

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The base interface for the keyboard port. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMIBASE Base;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The keyboard port base interface. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMIKEYBOARDPORT Port;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The base interface of the attached keyboard driver. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync R3PTRTYPE(PPDMIBASE) pDrvBase;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The keyboard interface of the attached keyboard driver. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync R3PTRTYPE(PPDMIKEYBOARDCONNECTOR) pDrv;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync } Keyboard;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /**

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync struct

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The base interface for the mouse port. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMIBASE Base;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The mouse port base interface. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMIMOUSEPORT Port;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The base interface of the attached mouse driver. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync R3PTRTYPE(PPDMIBASE) pDrvBase;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** The mouse interface of the attached mouse driver. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync R3PTRTYPE(PPDMIMOUSECONNECTOR) pDrv;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync } Mouse;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync} KBDState;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX_DEVICE_STRUCT_TESTCASE

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncKBDState kbd_state;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_update_irq(KBDState *s)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDQueue *q = &s->queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseCmdQueue *mcq = &s->mouse_command_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseEventQueue *meq = &s->mouse_event_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int irq12_level, irq1_level;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync irq1_level = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync irq12_level = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->count != 0)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->status |= KBD_STAT_OBF;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if ((s->mode & KBD_MODE_KBD_INT) && !(s->mode & KBD_MODE_DISABLE_KBD))

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync irq1_level = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else if (mcq->count != 0 || meq->count != 0)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->status |= KBD_STAT_OBF | KBD_STAT_MOUSE_OBF;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->mode & KBD_MODE_MOUSE_INT)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync irq12_level = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->count != 0) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->status |= KBD_STAT_OBF;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->aux[q->rptr]) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->status |= KBD_STAT_MOUSE_OBF;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->mode & KBD_MODE_MOUSE_INT)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync irq12_level = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync } else {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if ((s->mode & KBD_MODE_KBD_INT) &&

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync !(s->mode & KBD_MODE_DISABLE_KBD))

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync irq1_level = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync pic_set_irq(1, irq1_level);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync pic_set_irq(12, irq12_level);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpISASetIrq(s->CTX_SUFF(pDevIns), 1, irq1_level);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpISASetIrq(s->CTX_SUFF(pDevIns), 12, irq12_level);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_queue(KBDState *s, int b, int aux)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDQueue *q = &s->queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseCmdQueue *mcq = &s->mouse_command_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseEventQueue *meq = &s->mouse_event_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#if defined(DEBUG_MOUSE) || defined(DEBUG_KBD)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (aux)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("mouse event: 0x%02x\n", b));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef DEBUG_KBD

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd event: 0x%02x\n", b));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch (aux)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0: /* keyboard */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->count >= KBD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->data[q->wptr] = b;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++q->wptr == KBD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->count++;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 1: /* mouse command response */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (mcq->count >= MOUSE_CMD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync mcq->data[mcq->wptr] = b;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++mcq->wptr == MOUSE_CMD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync mcq->wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync mcq->count++;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 2: /* mouse event data */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (meq->count >= MOUSE_EVENT_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync meq->data[meq->wptr] = b;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++meq->wptr == MOUSE_EVENT_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync meq->wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync meq->count++;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync AssertMsgFailed(("aux=%d\n", aux));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->count >= KBD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->aux[q->wptr] = aux;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->data[q->wptr] = b;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++q->wptr == KBD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->count++;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_update_irq(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void pc_kbd_put_keycode(void *opaque, int keycode)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, keycode, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic uint32_t kbd_read_status(void *opaque, uint32_t addr)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = s->status;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#if defined(DEBUG_KBD)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: read status=0x%02x\n", val));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_write_command(void *opaque, uint32_t addr, uint32_t val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX (we need VMReset return code passed back) */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic int kbd_write_command(void *opaque, uint32_t addr, uint32_t val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int rc = VINF_SUCCESS;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef DEBUG_KBD

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: write cmd=0x%02x\n", val));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(val) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_READ_MODE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, s->mode, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_MODE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_OBUF:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_AUX_OBUF:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_MOUSE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_OUTPORT:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->write_cmd = val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_MOUSE_DISABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mode |= KBD_MODE_DISABLE_MOUSE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_MOUSE_ENABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mode &= ~KBD_MODE_DISABLE_MOUSE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_TEST_MOUSE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0x00, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_SELF_TEST:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->status |= KBD_STAT_SELFTEST;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0x55, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_KBD_TEST:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0x00, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_KBD_DISABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mode |= KBD_MODE_DISABLE_KBD;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_update_irq(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_KBD_ENABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mode &= ~KBD_MODE_DISABLE_KBD;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_update_irq(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_READ_INPORT:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0x00, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_READ_OUTPORT:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* XXX: check that */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef TARGET_I386

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = 0x01 | (ioport_get_a20() << 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = 0x01 | (PDMDevHlpA20IsEnabled(s->CTX_SUFF(pDevIns)) << 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = 0x01;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->status & KBD_STAT_OBF)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val |= 0x10;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->status & KBD_STAT_MOUSE_OBF)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val |= 0x20;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, val, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef TARGET_I386

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_ENABLE_A20:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync ioport_set_a20(1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (!PDMDevHlpA20IsEnabled(s->CTX_SUFF(pDevIns)))

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = VINF_IOM_HC_IOPORT_WRITE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpA20Set(s->CTX_SUFF(pDevIns), true);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_DISABLE_A20:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync ioport_set_a20(0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (PDMDevHlpA20IsEnabled(s->CTX_SUFF(pDevIns)))

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = VINF_IOM_HC_IOPORT_WRITE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpA20Set(s->CTX_SUFF(pDevIns), false);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif /* !IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_READ_TSTINP:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* Keyboard clock line is zero IFF keyboard is disabled */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = (s->mode & KBD_MODE_DISABLE_KBD) ? 0 : 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, val, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_RESET:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync qemu_system_reset_request();

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = VINF_IOM_HC_IOPORT_WRITE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = PDMDevHlpVMReset(s->CTX_SUFF(pDevIns));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif /* !IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0xff:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* ignore that - I don't know what is its use */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX /* Make OS/2 happy. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* The 8042 RAM is readble using commands 0x20 thru 0x3f, and writable

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0x21: case 0x22: case 0x23: case 0x24: case 0x25: case 0x26: case 0x27:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0x28: case 0x29: case 0x2a: case 0x2b: case 0x2c: case 0x2d: case 0x2e: case 0x2f:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: case 0x35: case 0x36: case 0x37:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0x38: case 0x39: case 0x3a: case 0x3b: case 0x3c: case 0x3d: case 0x3e: case 0x3f:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: reading non-standard RAM addr %#x\n", val & 0x1f));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: unsupported keyboard cmd=0x%02x\n", val));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return rc;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic uint32_t kbd_read_data(void *opaque, uint32_t addr)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDQueue *q;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseCmdQueue *mcq;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync MouseEventQueue *meq;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int val, index, aux;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q = &s->queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync mcq = &s->mouse_command_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync meq = &s->mouse_event_queue;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->count == 0 && mcq->count == 0 && meq->count == 0) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (q->count == 0) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* NOTE: if no data left, we return the last keyboard one

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* XXX: need a timer to do things correctly */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync index = q->rptr - 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (index < 0)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync index = KBD_QUEUE_SIZE - 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = q->data[index];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync } else {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync aux = (s->status & KBD_STAT_MOUSE_OBF);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (!aux)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = q->data[q->rptr];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++q->rptr == KBD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->count--;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (mcq->count)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = mcq->data[mcq->rptr];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++mcq->rptr == MOUSE_CMD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync mcq->rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync mcq->count--;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = meq->data[meq->rptr];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++meq->rptr == MOUSE_EVENT_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync meq->rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync meq->count--;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync aux = q->aux[q->rptr];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync val = q->data[q->rptr];

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (++q->rptr == KBD_QUEUE_SIZE)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync q->count--;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* reading deasserts IRQ */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (aux)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync pic_set_irq(12, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync pic_set_irq(1, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (aux)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpISASetIrq(s->CTX_SUFF(pDevIns), 12, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpISASetIrq(s->CTX_SUFF(pDevIns), 1, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* reassert IRQs if data left */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_update_irq(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef DEBUG_KBD

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: read data=0x%02x\n", val));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_reset_keyboard(KBDState *s)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->scan_enabled = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_write_keyboard(KBDState *s, int val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic int kbd_write_keyboard(KBDState *s, int val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(s->kbd_write_cmd) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case -1:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(val) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0x00:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0x05:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_RESEND, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_GET_ID:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0xab, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0x83, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_ECHO:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_CMD_ECHO, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_ENABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->scan_enabled = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_SET_LEDS:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_SET_RATE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->kbd_write_cmd = val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_RESET_DISABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_reset_keyboard(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->scan_enabled = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_RESET_ENABLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_reset_keyboard(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->scan_enabled = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_RESET:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_reset_keyboard(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_POR, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_SET_LEDS:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMKEYBLEDS enmLeds = PDMKEYBLEDS_NONE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val & 0x01)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync enmLeds = (PDMKEYBLEDS)(enmLeds | PDMKEYBLEDS_SCROLLLOCK);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val & 0x02)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync enmLeds = (PDMKEYBLEDS)(enmLeds | PDMKEYBLEDS_NUMLOCK);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val & 0x04)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync enmLeds = (PDMKEYBLEDS)(enmLeds | PDMKEYBLEDS_CAPSLOCK);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->Keyboard.pDrv->pfnLedStatusChange(s->Keyboard.pDrv, enmLeds);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return VINF_IOM_HC_IOPORT_WRITE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->kbd_write_cmd = -1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CMD_SET_RATE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, KBD_REPLY_ACK, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->kbd_write_cmd = -1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return VINF_SUCCESS;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_mouse_send_packet(KBDState *s, bool fToCmdQueue)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_mouse_send_packet(KBDState *s)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int aux = fToCmdQueue ? 1 : 2;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync unsigned int b;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int dx1, dy1, dz1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dx1 = s->mouse_dx;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dy1 = s->mouse_dy;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dz1 = s->mouse_dz;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* XXX: increase range to 8 bits ? */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (dx1 > 127)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dx1 = 127;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else if (dx1 < -127)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dx1 = -127;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (dy1 > 127)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dy1 = 127;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else if (dy1 < -127)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dy1 = -127;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync b = 0x08 | ((dx1 < 0) << 4) | ((dy1 < 0) << 5) | (s->mouse_buttons & 0x07);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, b, aux);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, dx1 & 0xff, aux);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, dy1 & 0xff, aux);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, b, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, dx1 & 0xff, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, dy1 & 0xff, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* extra byte for IMPS/2 or IMEX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(s->mouse_type) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 3:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (dz1 > 127)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dz1 = 127;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else if (dz1 < -127)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dz1 = -127;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, dz1 & 0xff, aux);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, dz1 & 0xff, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 4:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (dz1 > 7)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dz1 = 7;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else if (dz1 < -7)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync dz1 = -7;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync b = (dz1 & 0x0f) | ((s->mouse_buttons & 0x18) << 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, b, aux);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, b, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* update deltas */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_dx -= dx1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_dy -= dy1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_dz -= dz1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void pc_kbd_mouse_event(void *opaque,

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int dx, int dy, int dz, int buttons_state)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* check if deltas are recorded when disabled */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (!(s->mouse_status & MOUSE_STATUS_ENABLED))

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_dx += dx;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_dy -= dy;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_dz += dz;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* XXX: SDL sometimes generates nul events: we delete them */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->mouse_dx == 0 && s->mouse_dy == 0 && s->mouse_dz == 0 &&

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_buttons == buttons_state)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* This issue does not affect VBox, and under some circumstances (which?)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_buttons = buttons_state;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (!(s->mouse_status & MOUSE_STATUS_REMOTE) &&

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync (s->mouse_event_queue.count < (MOUSE_EVENT_QUEUE_SIZE - 4))) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync for(;;) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* if not remote, send event. Multiple events are sent if

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_mouse_send_packet(s, false);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->mouse_dx == 0 && s->mouse_dy == 0 && s->mouse_dz == 0)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (!(s->mouse_status & MOUSE_STATUS_REMOTE) &&

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync (s->queue.count < (KBD_QUEUE_SIZE - 16))) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync for(;;) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* if not remote, send event. Multiple events are sent if

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_mouse_send_packet(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->mouse_dx == 0 && s->mouse_dy == 0 && s->mouse_dz == 0)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_write_mouse(KBDState *s, int val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef DEBUG_MOUSE

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: write mouse 0x%02x\n", val));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* Flush the mouse command response queue. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_command_queue.count = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_command_queue.rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_command_queue.wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(s->mouse_write_cmd) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case -1:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* mouse command */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (s->mouse_wrap) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val == AUX_RESET_WRAP) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_wrap = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync } else if (val != AUX_RESET) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, val, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(val) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_SCALE11:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status &= ~MOUSE_STATUS_SCALE21;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_SCALE21:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status |= MOUSE_STATUS_SCALE21;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_STREAM:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status &= ~MOUSE_STATUS_REMOTE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_WRAP:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_wrap = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_REMOTE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status |= MOUSE_STATUS_REMOTE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_GET_TYPE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, s->mouse_type, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_RES:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_SAMPLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_write_cmd = val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_GET_SCALE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, s->mouse_status, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, s->mouse_resolution, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, s->mouse_sample_rate, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_POLL:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_mouse_send_packet(s, true);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_mouse_send_packet(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* !VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_ENABLE_DEV:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status |= MOUSE_STATUS_ENABLED;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_DISABLE_DEV:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status &= ~MOUSE_STATUS_ENABLED;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* Flush the mouse events queue. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_event_queue.count = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_event_queue.rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_event_queue.wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_DEFAULT:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_sample_rate = 100;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_resolution = 2;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_RESET:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_sample_rate = 100;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_resolution = 2;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_status = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_type = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, 0xaa, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, s->mouse_type, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* Flush the mouse events queue. */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_event_queue.count = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_event_queue.rptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_event_queue.wptr = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* NACK all commands we don't know.

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /** @todo send error if we NACKed the previous command? */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_NACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_SAMPLE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_sample_rate = val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync /* detect IMPS/2 or IMEX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(s->mouse_detect_state) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val == 200)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_detect_state = 1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 1:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val == 100)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_detect_state = 2;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else if (val == 200)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_detect_state = 3;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_detect_state = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 2:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val == 80)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_type = 3; /* IMPS/2 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_detect_state = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 3:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (val == 80)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_type = 4; /* IMEX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_detect_state = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_write_cmd = -1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case AUX_SET_RES:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_resolution = val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, AUX_ACK, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mouse_write_cmd = -1;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_write_data(void *opaque, uint32_t addr, uint32_t val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic int kbd_write_data(void *opaque, uint32_t addr, uint32_t val)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync int rc = VINF_SUCCESS;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef DEBUG_KBD

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync Log(("kbd: write data=0x%02x\n", val));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync switch(s->write_cmd) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case 0:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = kbd_write_keyboard(s, val);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_MODE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->mode = val;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_update_irq(s);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_OBUF:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, val, 0);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_AUX_OBUF:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_queue(s, val, 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_OUTPORT:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef TARGET_I386

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync ioport_set_a20((val >> 1) & 1);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (PDMDevHlpA20IsEnabled(s->CTX_SUFF(pDevIns)) != !!(val & 2))

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = VINF_IOM_HC_IOPORT_WRITE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else /* IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync PDMDevHlpA20Set(s->CTX_SUFF(pDevIns), !!(val & 2));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif /* !IN_RING3 */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync if (!(val & 1)) {

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifndef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync qemu_system_reset_request();

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#else /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# ifndef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = VINF_IOM_HC_IOPORT_WRITE;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# else

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync rc = PDMDevHlpVMReset(s->CTX_SUFF(pDevIns));

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync# endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif /* VBOX */

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync case KBD_CCMD_WRITE_MOUSE:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync kbd_write_mouse(s, val);

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync default:

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync break;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync }

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync s->write_cmd = 0;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync return rc;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#endif

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync}

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef IN_RING3

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsyncstatic void kbd_reset(void *opaque)

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync{

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDState *s = (KBDState*)opaque;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync KBDQueue *q;

5f80794f0fac6c6ae43bf4d2baaef60babb2a7c7vboxsync#ifdef VBOX

MouseCmdQueue *mcq;

MouseEventQueue *meq;

#endif /* VBOX */

s->kbd_write_cmd = -1;

s->mouse_write_cmd = -1;

s->mode = KBD_MODE_KBD_INT | KBD_MODE_MOUSE_INT;

s->status = KBD_STAT_CMD | KBD_STAT_UNLOCKED;

#ifdef VBOX /* Resetting everything, keyword was not working right on NT4 reboot. */

s->write_cmd = 0;

s->scan_enabled = 0;

s->mouse_status = 0;

s->mouse_resolution = 0;

s->mouse_sample_rate = 0;

s->mouse_wrap = 0;

s->mouse_type = 0;

s->mouse_detect_state = 0;

s->mouse_dx = 0;

s->mouse_dy = 0;

s->mouse_dz = 0;

s->mouse_buttons = 0;

#endif

q = &s->queue;

q->rptr = 0;

q->wptr = 0;

q->count = 0;

#ifdef VBOX

mcq = &s->mouse_command_queue;

mcq->rptr = 0;

mcq->wptr = 0;

mcq->count = 0;

meq = &s->mouse_event_queue;

meq->rptr = 0;

meq->wptr = 0;

meq->count = 0;

#endif /* VBOX */

}

static void kbd_save(QEMUFile* f, void* opaque)

{

#ifdef VBOX

uint32_t cItems;

int i;

#endif /* VBOX */

KBDState *s = (KBDState*)opaque;

qemu_put_8s(f, &s->write_cmd);

qemu_put_8s(f, &s->status);

qemu_put_8s(f, &s->mode);

qemu_put_be32s(f, &s->kbd_write_cmd);

qemu_put_be32s(f, &s->scan_enabled);

qemu_put_be32s(f, &s->mouse_write_cmd);

qemu_put_8s(f, &s->mouse_status);

qemu_put_8s(f, &s->mouse_resolution);

qemu_put_8s(f, &s->mouse_sample_rate);

qemu_put_8s(f, &s->mouse_wrap);

qemu_put_8s(f, &s->mouse_type);

qemu_put_8s(f, &s->mouse_detect_state);

qemu_put_be32s(f, &s->mouse_dx);

qemu_put_be32s(f, &s->mouse_dy);

qemu_put_be32s(f, &s->mouse_dz);

qemu_put_8s(f, &s->mouse_buttons);

#ifdef VBOX

/*

cItems = s->queue.count;

SSMR3PutU32(f, cItems);

for (i = s->queue.rptr; cItems-- > 0; i = (i + 1) % RT_ELEMENTS(s->queue.data))

SSMR3PutU8(f, s->queue.data[i]);

Log(("kbd_save: %d keyboard queue items stored\n", s->queue.count));

cItems = s->mouse_command_queue.count;

SSMR3PutU32(f, cItems);

for (i = s->mouse_command_queue.rptr; cItems-- > 0; i = (i + 1) % RT_ELEMENTS(s->mouse_command_queue.data))

SSMR3PutU8(f, s->mouse_command_queue.data[i]);

Log(("kbd_save: %d mouse command queue items stored\n", s->mouse_command_queue.count));

cItems = s->mouse_event_queue.count;

SSMR3PutU32(f, cItems);

for (i = s->mouse_event_queue.rptr; cItems-- > 0; i = (i + 1) % RT_ELEMENTS(s->mouse_event_queue.data))

SSMR3PutU8(f, s->mouse_event_queue.data[i]);

Log(("kbd_save: %d mouse event queue items stored\n", s->mouse_event_queue.count));

/* terminator */

SSMR3PutU32(f, ~0);

#endif /* VBOX */

}

static int kbd_load(QEMUFile* f, void* opaque, int version_id)

{

#ifdef VBOX

uint32_t u32, i;

int rc;

#endif

KBDState *s = (KBDState*)opaque;

if (version_id != PCKBD_SAVED_STATE_VERSION)

#ifndef VBOX

return -EINVAL;

#else

return VERR_SSM_UNSUPPORTED_DATA_UNIT_VERSION;

#endif

qemu_get_8s(f, &s->write_cmd);

qemu_get_8s(f, &s->status);

qemu_get_8s(f, &s->mode);

qemu_get_be32s(f, (uint32_t *)&s->kbd_write_cmd);

qemu_get_be32s(f, (uint32_t *)&s->scan_enabled);

qemu_get_be32s(f, (uint32_t *)&s->mouse_write_cmd);

qemu_get_8s(f, &s->mouse_status);

qemu_get_8s(f, &s->mouse_resolution);

qemu_get_8s(f, &s->mouse_sample_rate);

qemu_get_8s(f, &s->mouse_wrap);

qemu_get_8s(f, &s->mouse_type);

qemu_get_8s(f, &s->mouse_detect_state);

qemu_get_be32s(f, (uint32_t *)&s->mouse_dx);

qemu_get_be32s(f, (uint32_t *)&s->mouse_dy);

qemu_get_be32s(f, (uint32_t *)&s->mouse_dz);

qemu_get_8s(f, &s->mouse_buttons);

#ifdef VBOX

s->queue.count = 0;

s->queue.rptr = 0;

s->queue.wptr = 0;

s->mouse_command_queue.count = 0;

s->mouse_command_queue.rptr = 0;

s->mouse_command_queue.wptr = 0;

s->mouse_event_queue.count = 0;

s->mouse_event_queue.rptr = 0;

s->mouse_event_queue.wptr = 0;

/*

rc = SSMR3GetU32(f, &u32);

if (RT_FAILURE(rc))

return rc;

if (u32 > RT_ELEMENTS(s->queue.data))

{

AssertMsgFailed(("u32=%#x\n", u32));

return VERR_SSM_DATA_UNIT_FORMAT_CHANGED;

}

for (i = 0; i < u32; i++)

{

rc = SSMR3GetU8(f, &s->queue.data[i]);

if (RT_FAILURE(rc))

return rc;

}

s->queue.wptr = u32 % RT_ELEMENTS(s->queue.data);

s->queue.count = u32;

Log(("kbd_load: %d keyboard queue items loaded\n", u32));

rc = SSMR3GetU32(f, &u32);

if (RT_FAILURE(rc))

return rc;

if (u32 > RT_ELEMENTS(s->mouse_command_queue.data))

{

AssertMsgFailed(("u32=%#x\n", u32));

return VERR_SSM_DATA_UNIT_FORMAT_CHANGED;

}

for (i = 0; i < u32; i++)

{

rc = SSMR3GetU8(f, &s->mouse_command_queue.data[i]);

if (RT_FAILURE(rc))

return rc;

}

s->mouse_command_queue.wptr = u32 % RT_ELEMENTS(s->mouse_command_queue.data);

s->mouse_command_queue.count = u32;

Log(("kbd_load: %d mouse command queue items loaded\n", u32));

rc = SSMR3GetU32(f, &u32);

if (RT_FAILURE(rc))

return rc;

if (u32 > RT_ELEMENTS(s->mouse_event_queue.data))

{

AssertMsgFailed(("u32=%#x\n", u32));

return VERR_SSM_DATA_UNIT_FORMAT_CHANGED;

}

for (i = 0; i < u32; i++)

{

rc = SSMR3GetU8(f, &s->mouse_event_queue.data[i]);

if (RT_FAILURE(rc))

return rc;

}

s->mouse_event_queue.wptr = u32 % RT_ELEMENTS(s->mouse_event_queue.data);

s->mouse_event_queue.count = u32;

Log(("kbd_load: %d mouse event queue items loaded\n", u32));

/* terminator */

rc = SSMR3GetU32(f, &u32);

if (RT_FAILURE(rc))

return rc;

if (u32 != ~0U)

{

AssertMsgFailed(("u32=%#x\n", u32));

return VERR_SSM_DATA_UNIT_FORMAT_CHANGED;

}

#endif /* VBOX */

return 0;

}

#ifndef VBOX

void kbd_init(void)

{

KBDState *s = &kbd_state;

kbd_reset(s);

register_savevm("pckbd", 0, 1, kbd_save, kbd_load, s);

register_ioport_read(0x60, 1, 1, kbd_read_data, s);

register_ioport_write(0x60, 1, 1, kbd_write_data, s);

register_ioport_read(0x64, 1, 1, kbd_read_status, s);

register_ioport_write(0x64, 1, 1, kbd_write_command, s);

qemu_add_kbd_event_handler(pc_kbd_put_keycode, s);

qemu_add_mouse_event_handler(pc_kbd_mouse_event, s);

qemu_register_reset(kbd_reset, s);

}

#endif /* !VBOX */

#endif /* IN_RING3 */

#ifdef VBOX /* VirtualBox code start */

PDMBOTHCBDECL(int) kbdIOPortDataRead(PPDMDEVINS pDevIns, void *pvUser, RTIOPORT Port, uint32_t *pu32, unsigned cb)

{

NOREF(pvUser);

if (cb == 1)

{

KBDState *pThis = PDMINS_2_DATA(pDevIns, KBDState *);

int rc = PDMCritSectEnter(&pThis->CritSect, VINF_IOM_HC_IOPORT_READ);

if (RT_LIKELY(rc == VINF_SUCCESS))

{

*pu32 = kbd_read_data(pThis, Port);

PDMCritSectLeave(&pThis->CritSect);

Log2(("kbdIOPortDataRead: Port=%#x cb=%d *pu32=%#x\n", Port, cb, *pu32));

}

return rc;

}

AssertMsgFailed(("Port=%#x cb=%d\n", Port, cb));

return VERR_IOM_IOPORT_UNUSED;

}