chardev/msmouse.c - qemu - Git at Google

 /*
  * 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 const 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);
	/*
	* 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 const 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);