294 lines
9.0 KiB
C
294 lines
9.0 KiB
C
/*
|
|
* QEMU Microsoft serial mouse emulation
|
|
*
|
|
* Copyright (c) 2008 Lubomir Rintel
|
|
*
|
|
* 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 "qemu/osdep.h"
|
|
#include "qemu/module.h"
|
|
#include "qemu/fifo8.h"
|
|
#include "chardev/char.h"
|
|
#include "chardev/char-serial.h"
|
|
#include "ui/console.h"
|
|
#include "ui/input.h"
|
|
#include "qom/object.h"
|
|
|
|
#define MSMOUSE_LO6(n) ((n) & 0x3f)
|
|
#define MSMOUSE_HI2(n) (((n) & 0xc0) >> 6)
|
|
#define MSMOUSE_PWR(cm) (cm & (CHR_TIOCM_RTS | CHR_TIOCM_DTR))
|
|
|
|
/* Serial PnP for 6 bit devices/mice sends all ASCII chars - 0x20 */
|
|
#define M(c) (c - 0x20)
|
|
/* Serial fifo size. */
|
|
#define MSMOUSE_BUF_SZ 64
|
|
|
|
/* Mouse ID: Send "M3" cause we behave like a 3 button logitech mouse. */
|
|
const uint8_t mouse_id[] = {'M', '3'};
|
|
/*
|
|
* PnP start "(", PnP version (1.0), vendor ID, product ID, '\\',
|
|
* serial ID (omitted), '\\', MS class name, '\\', driver ID (omitted), '\\',
|
|
* product description, checksum, ")"
|
|
* Missing parts are inserted later.
|
|
*/
|
|
const uint8_t pnp_data[] = {M('('), 1, '$', M('Q'), M('M'), M('U'),
|
|
M('0'), M('0'), M('0'), M('1'),
|
|
M('\\'), M('\\'),
|
|
M('M'), M('O'), M('U'), M('S'), M('E'),
|
|
M('\\'), M('\\')};
|
|
|
|
struct MouseChardev {
|
|
Chardev parent;
|
|
|
|
QemuInputHandlerState *hs;
|
|
int tiocm;
|
|
int axis[INPUT_AXIS__MAX];
|
|
bool btns[INPUT_BUTTON__MAX];
|
|
bool btnc[INPUT_BUTTON__MAX];
|
|
Fifo8 outbuf;
|
|
};
|
|
typedef struct MouseChardev MouseChardev;
|
|
|
|
#define TYPE_CHARDEV_MSMOUSE "chardev-msmouse"
|
|
DECLARE_INSTANCE_CHECKER(MouseChardev, MOUSE_CHARDEV,
|
|
TYPE_CHARDEV_MSMOUSE)
|
|
|
|
static void msmouse_chr_accept_input(Chardev *chr)
|
|
{
|
|
MouseChardev *mouse = MOUSE_CHARDEV(chr);
|
|
uint32_t len, avail;
|
|
|
|
len = qemu_chr_be_can_write(chr);
|
|
avail = fifo8_num_used(&mouse->outbuf);
|
|
while (len > 0 && avail > 0) {
|
|
const uint8_t *buf;
|
|
uint32_t size;
|
|
|
|
buf = fifo8_pop_buf(&mouse->outbuf, MIN(len, avail), &size);
|
|
qemu_chr_be_write(chr, buf, size);
|
|
len = qemu_chr_be_can_write(chr);
|
|
avail -= size;
|
|
}
|
|
}
|
|
|
|
static void msmouse_queue_event(MouseChardev *mouse)
|
|
{
|
|
unsigned char bytes[4] = { 0x40, 0x00, 0x00, 0x00 };
|
|
int dx, dy, count = 3;
|
|
|
|
dx = mouse->axis[INPUT_AXIS_X];
|
|
mouse->axis[INPUT_AXIS_X] = 0;
|
|
|
|
dy = mouse->axis[INPUT_AXIS_Y];
|
|
mouse->axis[INPUT_AXIS_Y] = 0;
|
|
|
|
/* Movement deltas */
|
|
bytes[0] |= (MSMOUSE_HI2(dy) << 2) | MSMOUSE_HI2(dx);
|
|
bytes[1] |= MSMOUSE_LO6(dx);
|
|
bytes[2] |= MSMOUSE_LO6(dy);
|
|
|
|
/* Buttons */
|
|
bytes[0] |= (mouse->btns[INPUT_BUTTON_LEFT] ? 0x20 : 0x00);
|
|
bytes[0] |= (mouse->btns[INPUT_BUTTON_RIGHT] ? 0x10 : 0x00);
|
|
if (mouse->btns[INPUT_BUTTON_MIDDLE] ||
|
|
mouse->btnc[INPUT_BUTTON_MIDDLE]) {
|
|
bytes[3] |= (mouse->btns[INPUT_BUTTON_MIDDLE] ? 0x20 : 0x00);
|
|
mouse->btnc[INPUT_BUTTON_MIDDLE] = false;
|
|
count++;
|
|
}
|
|
|
|
if (fifo8_num_free(&mouse->outbuf) >= count) {
|
|
fifo8_push_all(&mouse->outbuf, bytes, count);
|
|
} else {
|
|
/* queue full -> drop event */
|
|
}
|
|
}
|
|
|
|
static void msmouse_input_event(DeviceState *dev, QemuConsole *src,
|
|
InputEvent *evt)
|
|
{
|
|
MouseChardev *mouse = MOUSE_CHARDEV(dev);
|
|
InputMoveEvent *move;
|
|
InputBtnEvent *btn;
|
|
|
|
/* Ignore events if serial mouse powered down. */
|
|
if (!MSMOUSE_PWR(mouse->tiocm)) {
|
|
return;
|
|
}
|
|
|
|
switch (evt->type) {
|
|
case INPUT_EVENT_KIND_REL:
|
|
move = evt->u.rel.data;
|
|
mouse->axis[move->axis] += move->value;
|
|
break;
|
|
|
|
case INPUT_EVENT_KIND_BTN:
|
|
btn = evt->u.btn.data;
|
|
mouse->btns[btn->button] = btn->down;
|
|
mouse->btnc[btn->button] = true;
|
|
break;
|
|
|
|
default:
|
|
/* keep gcc happy */
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void msmouse_input_sync(DeviceState *dev)
|
|
{
|
|
MouseChardev *mouse = MOUSE_CHARDEV(dev);
|
|
Chardev *chr = CHARDEV(dev);
|
|
|
|
/* Ignore events if serial mouse powered down. */
|
|
if (!MSMOUSE_PWR(mouse->tiocm)) {
|
|
return;
|
|
}
|
|
|
|
msmouse_queue_event(mouse);
|
|
msmouse_chr_accept_input(chr);
|
|
}
|
|
|
|
static int msmouse_chr_write(struct Chardev *s, const uint8_t *buf, int len)
|
|
{
|
|
/* Ignore writes to mouse port */
|
|
return len;
|
|
}
|
|
|
|
static QemuInputHandler msmouse_handler = {
|
|
.name = "QEMU Microsoft Mouse",
|
|
.mask = INPUT_EVENT_MASK_BTN | INPUT_EVENT_MASK_REL,
|
|
.event = msmouse_input_event,
|
|
.sync = msmouse_input_sync,
|
|
};
|
|
|
|
static int msmouse_ioctl(Chardev *chr, int cmd, void *arg)
|
|
{
|
|
MouseChardev *mouse = MOUSE_CHARDEV(chr);
|
|
int c, i, j;
|
|
uint8_t bytes[MSMOUSE_BUF_SZ / 2];
|
|
int *targ = (int *)arg;
|
|
const uint8_t hexchr[16] = {M('0'), M('1'), M('2'), M('3'), M('4'), M('5'),
|
|
M('6'), M('7'), M('8'), M('9'), M('A'), M('B'),
|
|
M('C'), M('D'), M('E'), M('F')};
|
|
|
|
switch (cmd) {
|
|
case CHR_IOCTL_SERIAL_SET_TIOCM:
|
|
c = mouse->tiocm;
|
|
mouse->tiocm = *(int *)arg;
|
|
if (MSMOUSE_PWR(mouse->tiocm)) {
|
|
if (!MSMOUSE_PWR(c)) {
|
|
/*
|
|
* Power on after reset: Send ID and PnP data
|
|
* No need to check fifo space as it is empty at this point.
|
|
*/
|
|
fifo8_push_all(&mouse->outbuf, mouse_id, sizeof(mouse_id));
|
|
/* Add PnP data: */
|
|
fifo8_push_all(&mouse->outbuf, pnp_data, sizeof(pnp_data));
|
|
/*
|
|
* Add device description from qemu handler name.
|
|
* Make sure this all fits into the queue beforehand!
|
|
*/
|
|
c = M(')');
|
|
for (i = 0; msmouse_handler.name[i]; i++) {
|
|
bytes[i] = M(msmouse_handler.name[i]);
|
|
c += bytes[i];
|
|
}
|
|
/* Calc more of checksum */
|
|
for (j = 0; j < sizeof(pnp_data); j++) {
|
|
c += pnp_data[j];
|
|
}
|
|
c &= 0xff;
|
|
bytes[i++] = hexchr[c >> 4];
|
|
bytes[i++] = hexchr[c & 0x0f];
|
|
bytes[i++] = M(')');
|
|
fifo8_push_all(&mouse->outbuf, bytes, i);
|
|
/* Start sending data to serial. */
|
|
msmouse_chr_accept_input(chr);
|
|
}
|
|
break;
|
|
}
|
|
/*
|
|
* Reset mouse buffers on power down.
|
|
* Mouse won't send anything without power.
|
|
*/
|
|
fifo8_reset(&mouse->outbuf);
|
|
memset(mouse->axis, 0, sizeof(mouse->axis));
|
|
memset(mouse->btns, false, sizeof(mouse->btns));
|
|
memset(mouse->btnc, false, sizeof(mouse->btns));
|
|
break;
|
|
case CHR_IOCTL_SERIAL_GET_TIOCM:
|
|
/* Remember line control status. */
|
|
*targ = mouse->tiocm;
|
|
break;
|
|
default:
|
|
return -ENOTSUP;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void char_msmouse_finalize(Object *obj)
|
|
{
|
|
MouseChardev *mouse = MOUSE_CHARDEV(obj);
|
|
|
|
if (mouse->hs) {
|
|
qemu_input_handler_unregister(mouse->hs);
|
|
}
|
|
fifo8_destroy(&mouse->outbuf);
|
|
}
|
|
|
|
static void msmouse_chr_open(Chardev *chr,
|
|
ChardevBackend *backend,
|
|
bool *be_opened,
|
|
Error **errp)
|
|
{
|
|
MouseChardev *mouse = MOUSE_CHARDEV(chr);
|
|
|
|
*be_opened = false;
|
|
mouse->hs = qemu_input_handler_register((DeviceState *)mouse,
|
|
&msmouse_handler);
|
|
mouse->tiocm = 0;
|
|
fifo8_create(&mouse->outbuf, MSMOUSE_BUF_SZ);
|
|
}
|
|
|
|
static void char_msmouse_class_init(ObjectClass *oc, void *data)
|
|
{
|
|
ChardevClass *cc = CHARDEV_CLASS(oc);
|
|
|
|
cc->open = msmouse_chr_open;
|
|
cc->chr_write = msmouse_chr_write;
|
|
cc->chr_accept_input = msmouse_chr_accept_input;
|
|
cc->chr_ioctl = msmouse_ioctl;
|
|
}
|
|
|
|
static const TypeInfo char_msmouse_type_info = {
|
|
.name = TYPE_CHARDEV_MSMOUSE,
|
|
.parent = TYPE_CHARDEV,
|
|
.instance_size = sizeof(MouseChardev),
|
|
.instance_finalize = char_msmouse_finalize,
|
|
.class_init = char_msmouse_class_init,
|
|
};
|
|
|
|
static void register_types(void)
|
|
{
|
|
type_register_static(&char_msmouse_type_info);
|
|
}
|
|
|
|
type_init(register_types);
|