This commit is contained in:
commit
b6b7d72717
96 changed files with 37739 additions and 0 deletions
162
vmmouse.c
Normal file
162
vmmouse.c
Normal file
|
|
@ -0,0 +1,162 @@
|
|||
/*
|
||||
* VM mouse emulation
|
||||
*
|
||||
* Copyright (c) 2017 Fabrice Bellard
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||
* of this software and associated documentation files (the "Software"), to deal
|
||||
* in the Software without restriction, including without limitation the rights
|
||||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||
* copies of the Software, and to permit persons to whom the Software is
|
||||
* furnished to do so, subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be included in
|
||||
* all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
||||
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
||||
* THE SOFTWARE.
|
||||
*/
|
||||
#include <stdlib.h>
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <inttypes.h>
|
||||
#include <assert.h>
|
||||
|
||||
#include "cutils.h"
|
||||
#include "iomem.h"
|
||||
#include "ps2.h"
|
||||
|
||||
#define VMPORT_MAGIC 0x564D5868
|
||||
|
||||
#define REG_EAX 0
|
||||
#define REG_EBX 1
|
||||
#define REG_ECX 2
|
||||
#define REG_EDX 3
|
||||
#define REG_ESI 4
|
||||
#define REG_EDI 5
|
||||
|
||||
#define FIFO_SIZE (4 * 16)
|
||||
|
||||
struct VMMouseState {
|
||||
PS2MouseState *ps2_mouse;
|
||||
int fifo_count, fifo_rindex, fifo_windex;
|
||||
BOOL enabled;
|
||||
BOOL absolute;
|
||||
uint32_t fifo_buf[FIFO_SIZE];
|
||||
};
|
||||
|
||||
static void put_queue(VMMouseState *s, uint32_t val)
|
||||
{
|
||||
if (s->fifo_count >= FIFO_SIZE)
|
||||
return;
|
||||
s->fifo_buf[s->fifo_windex] = val;
|
||||
if (++s->fifo_windex == FIFO_SIZE)
|
||||
s->fifo_windex = 0;
|
||||
s->fifo_count++;
|
||||
}
|
||||
|
||||
static void read_data(VMMouseState *s, uint32_t *regs, int size)
|
||||
{
|
||||
int i;
|
||||
if (size > 6 || size > s->fifo_count) {
|
||||
// printf("vmmouse: read error req=%d count=%d\n", size, s->fifo_count);
|
||||
s->enabled = FALSE;
|
||||
return;
|
||||
}
|
||||
for(i = 0; i < size; i++) {
|
||||
regs[i] = s->fifo_buf[s->fifo_rindex];
|
||||
if (++s->fifo_rindex == FIFO_SIZE)
|
||||
s->fifo_rindex = 0;
|
||||
}
|
||||
s->fifo_count -= size;
|
||||
}
|
||||
|
||||
void vmmouse_send_mouse_event(VMMouseState *s, int x, int y, int dz,
|
||||
int buttons)
|
||||
{
|
||||
int state;
|
||||
|
||||
if (!s->enabled) {
|
||||
ps2_mouse_event(s->ps2_mouse, x, y, dz, buttons);
|
||||
return;
|
||||
}
|
||||
|
||||
if ((s->fifo_count + 4) > FIFO_SIZE)
|
||||
return;
|
||||
|
||||
state = 0;
|
||||
if (buttons & 1)
|
||||
state |= 0x20;
|
||||
if (buttons & 2)
|
||||
state |= 0x10;
|
||||
if (buttons & 4)
|
||||
state |= 0x08;
|
||||
if (s->absolute) {
|
||||
/* range = 0 ... 65535 */
|
||||
x *= 2;
|
||||
y *= 2;
|
||||
}
|
||||
|
||||
put_queue(s, state);
|
||||
put_queue(s, x);
|
||||
put_queue(s, y);
|
||||
put_queue(s, -dz);
|
||||
|
||||
/* send PS/2 mouse event */
|
||||
ps2_mouse_event(s->ps2_mouse, 1, 0, 0, 0);
|
||||
}
|
||||
|
||||
void vmmouse_handler(VMMouseState *s, uint32_t *regs)
|
||||
{
|
||||
uint32_t cmd;
|
||||
|
||||
cmd = regs[REG_ECX] & 0xff;
|
||||
switch(cmd) {
|
||||
case 10: /* get version */
|
||||
regs[REG_EBX] = VMPORT_MAGIC;
|
||||
break;
|
||||
case 39: /* VMMOUSE_DATA */
|
||||
read_data(s, regs, regs[REG_EBX]);
|
||||
break;
|
||||
case 40: /* VMMOUSE_STATUS */
|
||||
regs[REG_EAX] = ((s->enabled ? 0 : 0xffff) << 16) | s->fifo_count;
|
||||
break;
|
||||
case 41: /* VMMOUSE_COMMAND */
|
||||
switch(regs[REG_EBX]) {
|
||||
case 0x45414552: /* read id */
|
||||
if (s->fifo_count < FIFO_SIZE) {
|
||||
put_queue(s, 0x3442554a);
|
||||
s->enabled = TRUE;
|
||||
}
|
||||
break;
|
||||
case 0x000000f5: /* disable */
|
||||
s->enabled = FALSE;
|
||||
break;
|
||||
case 0x4c455252: /* set relative */
|
||||
s->absolute = 0;
|
||||
break;
|
||||
case 0x53424152: /* set absolute */
|
||||
s->absolute = 1;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
BOOL vmmouse_is_absolute(VMMouseState *s)
|
||||
{
|
||||
return s->absolute;
|
||||
}
|
||||
|
||||
VMMouseState *vmmouse_init(PS2MouseState *ps2_mouse)
|
||||
{
|
||||
VMMouseState *s;
|
||||
s = mallocz(sizeof(*s));
|
||||
s->ps2_mouse = ps2_mouse;
|
||||
return s;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue