1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "qemu/osdep.h"
26#include "ui/console.h"
27#include "hw/i386/pc.h"
28#include "hw/input/i8042.h"
29#include "hw/qdev-properties.h"
30#include "migration/vmstate.h"
31
32
33
34
35
36#define VMMOUSE_GETVERSION 10
37#define VMMOUSE_DATA 39
38#define VMMOUSE_STATUS 40
39#define VMMOUSE_COMMAND 41
40
41#define VMMOUSE_READ_ID 0x45414552
42#define VMMOUSE_DISABLE 0x000000f5
43#define VMMOUSE_REQUEST_RELATIVE 0x4c455252
44#define VMMOUSE_REQUEST_ABSOLUTE 0x53424152
45
46#define VMMOUSE_QUEUE_SIZE 1024
47
48#define VMMOUSE_VERSION 0x3442554a
49
50#ifdef DEBUG_VMMOUSE
51#define DPRINTF(fmt, ...) printf(fmt, ## __VA_ARGS__)
52#else
53#define DPRINTF(fmt, ...) do { } while (0)
54#endif
55
56#define TYPE_VMMOUSE "vmmouse"
57#define VMMOUSE(obj) OBJECT_CHECK(VMMouseState, (obj), TYPE_VMMOUSE)
58
59typedef struct VMMouseState
60{
61 ISADevice parent_obj;
62
63 uint32_t queue[VMMOUSE_QUEUE_SIZE];
64 int32_t queue_size;
65 uint16_t nb_queue;
66 uint16_t status;
67 uint8_t absolute;
68 QEMUPutMouseEntry *entry;
69 void *ps2_mouse;
70} VMMouseState;
71
72static uint32_t vmmouse_get_status(VMMouseState *s)
73{
74 DPRINTF("vmmouse_get_status()\n");
75 return (s->status << 16) | s->nb_queue;
76}
77
78static void vmmouse_mouse_event(void *opaque, int x, int y, int dz, int buttons_state)
79{
80 VMMouseState *s = opaque;
81 int buttons = 0;
82
83 if (s->nb_queue > (VMMOUSE_QUEUE_SIZE - 4))
84 return;
85
86 DPRINTF("vmmouse_mouse_event(%d, %d, %d, %d)\n",
87 x, y, dz, buttons_state);
88
89 if ((buttons_state & MOUSE_EVENT_LBUTTON))
90 buttons |= 0x20;
91 if ((buttons_state & MOUSE_EVENT_RBUTTON))
92 buttons |= 0x10;
93 if ((buttons_state & MOUSE_EVENT_MBUTTON))
94 buttons |= 0x08;
95
96 if (s->absolute) {
97 x <<= 1;
98 y <<= 1;
99 }
100
101 s->queue[s->nb_queue++] = buttons;
102 s->queue[s->nb_queue++] = x;
103 s->queue[s->nb_queue++] = y;
104 s->queue[s->nb_queue++] = dz;
105
106
107
108 i8042_isa_mouse_fake_event(s->ps2_mouse);
109}
110
111static void vmmouse_remove_handler(VMMouseState *s)
112{
113 if (s->entry) {
114 qemu_remove_mouse_event_handler(s->entry);
115 s->entry = NULL;
116 }
117}
118
119static void vmmouse_update_handler(VMMouseState *s, int absolute)
120{
121 if (s->status != 0) {
122 return;
123 }
124 if (s->absolute != absolute) {
125 s->absolute = absolute;
126 vmmouse_remove_handler(s);
127 }
128 if (s->entry == NULL) {
129 s->entry = qemu_add_mouse_event_handler(vmmouse_mouse_event,
130 s, s->absolute,
131 "vmmouse");
132 qemu_activate_mouse_event_handler(s->entry);
133 }
134}
135
136static void vmmouse_read_id(VMMouseState *s)
137{
138 DPRINTF("vmmouse_read_id()\n");
139
140 if (s->nb_queue == VMMOUSE_QUEUE_SIZE)
141 return;
142
143 s->queue[s->nb_queue++] = VMMOUSE_VERSION;
144 s->status = 0;
145}
146
147static void vmmouse_request_relative(VMMouseState *s)
148{
149 DPRINTF("vmmouse_request_relative()\n");
150 vmmouse_update_handler(s, 0);
151}
152
153static void vmmouse_request_absolute(VMMouseState *s)
154{
155 DPRINTF("vmmouse_request_absolute()\n");
156 vmmouse_update_handler(s, 1);
157}
158
159static void vmmouse_disable(VMMouseState *s)
160{
161 DPRINTF("vmmouse_disable()\n");
162 s->status = 0xffff;
163 vmmouse_remove_handler(s);
164}
165
166static void vmmouse_data(VMMouseState *s, uint32_t *data, uint32_t size)
167{
168 int i;
169
170 DPRINTF("vmmouse_data(%d)\n", size);
171
172 if (size == 0 || size > 6 || size > s->nb_queue) {
173 printf("vmmouse: driver requested too much data %d\n", size);
174 s->status = 0xffff;
175 vmmouse_remove_handler(s);
176 return;
177 }
178
179 for (i = 0; i < size; i++)
180 data[i] = s->queue[i];
181
182 s->nb_queue -= size;
183 if (s->nb_queue)
184 memmove(s->queue, &s->queue[size], sizeof(s->queue[0]) * s->nb_queue);
185}
186
187static uint32_t vmmouse_ioport_read(void *opaque, uint32_t addr)
188{
189 VMMouseState *s = opaque;
190 uint32_t data[6];
191 uint16_t command;
192
193 vmmouse_get_data(data);
194
195 command = data[2] & 0xFFFF;
196
197 switch (command) {
198 case VMMOUSE_STATUS:
199 data[0] = vmmouse_get_status(s);
200 break;
201 case VMMOUSE_COMMAND:
202 switch (data[1]) {
203 case VMMOUSE_DISABLE:
204 vmmouse_disable(s);
205 break;
206 case VMMOUSE_READ_ID:
207 vmmouse_read_id(s);
208 break;
209 case VMMOUSE_REQUEST_RELATIVE:
210 vmmouse_request_relative(s);
211 break;
212 case VMMOUSE_REQUEST_ABSOLUTE:
213 vmmouse_request_absolute(s);
214 break;
215 default:
216 printf("vmmouse: unknown command %x\n", data[1]);
217 break;
218 }
219 break;
220 case VMMOUSE_DATA:
221 vmmouse_data(s, data, data[1]);
222 break;
223 default:
224 printf("vmmouse: unknown command %x\n", command);
225 break;
226 }
227
228 vmmouse_set_data(data);
229 return data[0];
230}
231
232static int vmmouse_post_load(void *opaque, int version_id)
233{
234 VMMouseState *s = opaque;
235
236 vmmouse_remove_handler(s);
237 vmmouse_update_handler(s, s->absolute);
238 return 0;
239}
240
241static const VMStateDescription vmstate_vmmouse = {
242 .name = "vmmouse",
243 .version_id = 0,
244 .minimum_version_id = 0,
245 .post_load = vmmouse_post_load,
246 .fields = (VMStateField[]) {
247 VMSTATE_INT32_EQUAL(queue_size, VMMouseState, NULL),
248 VMSTATE_UINT32_ARRAY(queue, VMMouseState, VMMOUSE_QUEUE_SIZE),
249 VMSTATE_UINT16(nb_queue, VMMouseState),
250 VMSTATE_UINT16(status, VMMouseState),
251 VMSTATE_UINT8(absolute, VMMouseState),
252 VMSTATE_END_OF_LIST()
253 }
254};
255
256static void vmmouse_reset(DeviceState *d)
257{
258 VMMouseState *s = VMMOUSE(d);
259
260 s->queue_size = VMMOUSE_QUEUE_SIZE;
261 s->nb_queue = 0;
262
263 vmmouse_disable(s);
264}
265
266static void vmmouse_realizefn(DeviceState *dev, Error **errp)
267{
268 VMMouseState *s = VMMOUSE(dev);
269
270 DPRINTF("vmmouse_init\n");
271
272 vmport_register(VMMOUSE_STATUS, vmmouse_ioport_read, s);
273 vmport_register(VMMOUSE_COMMAND, vmmouse_ioport_read, s);
274 vmport_register(VMMOUSE_DATA, vmmouse_ioport_read, s);
275}
276
277static Property vmmouse_properties[] = {
278 DEFINE_PROP_PTR("ps2_mouse", VMMouseState, ps2_mouse),
279 DEFINE_PROP_END_OF_LIST(),
280};
281
282static void vmmouse_class_initfn(ObjectClass *klass, void *data)
283{
284 DeviceClass *dc = DEVICE_CLASS(klass);
285
286 dc->realize = vmmouse_realizefn;
287 dc->reset = vmmouse_reset;
288 dc->vmsd = &vmstate_vmmouse;
289 dc->props = vmmouse_properties;
290
291 dc->user_creatable = false;
292}
293
294static const TypeInfo vmmouse_info = {
295 .name = TYPE_VMMOUSE,
296 .parent = TYPE_ISA_DEVICE,
297 .instance_size = sizeof(VMMouseState),
298 .class_init = vmmouse_class_initfn,
299};
300
301static void vmmouse_register_types(void)
302{
303 type_register_static(&vmmouse_info);
304}
305
306type_init(vmmouse_register_types)
307
