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
26
27
28#include "hw/hw.h"
29#include "ui/console.h"
30#include "hw/usb.h"
31#include "hw/usb/desc.h"
32
33
34#define WACOM_GET_REPORT 0x2101
35#define WACOM_SET_REPORT 0x2109
36
37
38#define HID_GET_REPORT 0xa101
39#define HID_GET_IDLE 0xa102
40#define HID_GET_PROTOCOL 0xa103
41#define HID_SET_IDLE 0x210a
42#define HID_SET_PROTOCOL 0x210b
43
44typedef struct USBWacomState {
45 USBDevice dev;
46 USBEndpoint *intr;
47 QEMUPutMouseEntry *eh_entry;
48 int dx, dy, dz, buttons_state;
49 int x, y;
50 int mouse_grabbed;
51 enum {
52 WACOM_MODE_HID = 1,
53 WACOM_MODE_WACOM = 2,
54 } mode;
55 uint8_t idle;
56 int changed;
57} USBWacomState;
58
59enum {
60 STR_MANUFACTURER = 1,
61 STR_PRODUCT,
62 STR_SERIALNUMBER,
63};
64
65static const USBDescStrings desc_strings = {
66 [STR_MANUFACTURER] = "QEMU",
67 [STR_PRODUCT] = "Wacom PenPartner",
68 [STR_SERIALNUMBER] = "1",
69};
70
71static const USBDescIface desc_iface_wacom = {
72 .bInterfaceNumber = 0,
73 .bNumEndpoints = 1,
74 .bInterfaceClass = USB_CLASS_HID,
75 .bInterfaceSubClass = 0x01,
76 .bInterfaceProtocol = 0x02,
77 .ndesc = 1,
78 .descs = (USBDescOther[]) {
79 {
80
81 .data = (uint8_t[]) {
82 0x09,
83 0x21,
84 0x01, 0x10,
85 0x00,
86 0x01,
87 0x22,
88 0x6e, 0,
89 },
90 },
91 },
92 .eps = (USBDescEndpoint[]) {
93 {
94 .bEndpointAddress = USB_DIR_IN | 0x01,
95 .bmAttributes = USB_ENDPOINT_XFER_INT,
96 .wMaxPacketSize = 8,
97 .bInterval = 0x0a,
98 },
99 },
100};
101
102static const USBDescDevice desc_device_wacom = {
103 .bcdUSB = 0x0110,
104 .bMaxPacketSize0 = 8,
105 .bNumConfigurations = 1,
106 .confs = (USBDescConfig[]) {
107 {
108 .bNumInterfaces = 1,
109 .bConfigurationValue = 1,
110 .bmAttributes = 0x80,
111 .bMaxPower = 40,
112 .nif = 1,
113 .ifs = &desc_iface_wacom,
114 },
115 },
116};
117
118static const USBDesc desc_wacom = {
119 .id = {
120 .idVendor = 0x056a,
121 .idProduct = 0x0000,
122 .bcdDevice = 0x4210,
123 .iManufacturer = STR_MANUFACTURER,
124 .iProduct = STR_PRODUCT,
125 .iSerialNumber = STR_SERIALNUMBER,
126 },
127 .full = &desc_device_wacom,
128 .str = desc_strings,
129};
130
131static void usb_mouse_event(void *opaque,
132 int dx1, int dy1, int dz1, int buttons_state)
133{
134 USBWacomState *s = opaque;
135
136 s->dx += dx1;
137 s->dy += dy1;
138 s->dz += dz1;
139 s->buttons_state = buttons_state;
140 s->changed = 1;
141 usb_wakeup(s->intr);
142}
143
144static void usb_wacom_event(void *opaque,
145 int x, int y, int dz, int buttons_state)
146{
147 USBWacomState *s = opaque;
148
149
150 s->x = (x * 5040 / 0x7FFF);
151 s->y = (y * 3780 / 0x7FFF);
152 s->dz += dz;
153 s->buttons_state = buttons_state;
154 s->changed = 1;
155 usb_wakeup(s->intr);
156}
157
158static inline int int_clamp(int val, int vmin, int vmax)
159{
160 if (val < vmin)
161 return vmin;
162 else if (val > vmax)
163 return vmax;
164 else
165 return val;
166}
167
168static int usb_mouse_poll(USBWacomState *s, uint8_t *buf, int len)
169{
170 int dx, dy, dz, b, l;
171
172 if (!s->mouse_grabbed) {
173 s->eh_entry = qemu_add_mouse_event_handler(usb_mouse_event, s, 0,
174 "QEMU PenPartner tablet");
175 qemu_activate_mouse_event_handler(s->eh_entry);
176 s->mouse_grabbed = 1;
177 }
178
179 dx = int_clamp(s->dx, -128, 127);
180 dy = int_clamp(s->dy, -128, 127);
181 dz = int_clamp(s->dz, -128, 127);
182
183 s->dx -= dx;
184 s->dy -= dy;
185 s->dz -= dz;
186
187 b = 0;
188 if (s->buttons_state & MOUSE_EVENT_LBUTTON)
189 b |= 0x01;
190 if (s->buttons_state & MOUSE_EVENT_RBUTTON)
191 b |= 0x02;
192 if (s->buttons_state & MOUSE_EVENT_MBUTTON)
193 b |= 0x04;
194
195 buf[0] = b;
196 buf[1] = dx;
197 buf[2] = dy;
198 l = 3;
199 if (len >= 4) {
200 buf[3] = dz;
201 l = 4;
202 }
203 return l;
204}
205
206static int usb_wacom_poll(USBWacomState *s, uint8_t *buf, int len)
207{
208 int b;
209
210 if (!s->mouse_grabbed) {
211 s->eh_entry = qemu_add_mouse_event_handler(usb_wacom_event, s, 1,
212 "QEMU PenPartner tablet");
213 qemu_activate_mouse_event_handler(s->eh_entry);
214 s->mouse_grabbed = 1;
215 }
216
217 b = 0;
218 if (s->buttons_state & MOUSE_EVENT_LBUTTON)
219 b |= 0x01;
220 if (s->buttons_state & MOUSE_EVENT_RBUTTON)
221 b |= 0x40;
222 if (s->buttons_state & MOUSE_EVENT_MBUTTON)
223 b |= 0x20;
224
225 if (len < 7)
226 return 0;
227
228 buf[0] = s->mode;
229 buf[5] = 0x00 | (b & 0xf0);
230 buf[1] = s->x & 0xff;
231 buf[2] = s->x >> 8;
232 buf[3] = s->y & 0xff;
233 buf[4] = s->y >> 8;
234 if (b & 0x3f) {
235 buf[6] = 0;
236 } else {
237 buf[6] = (unsigned char) -127;
238 }
239
240 return 7;
241}
242
243static void usb_wacom_handle_reset(USBDevice *dev)
244{
245 USBWacomState *s = (USBWacomState *) dev;
246
247 s->dx = 0;
248 s->dy = 0;
249 s->dz = 0;
250 s->x = 0;
251 s->y = 0;
252 s->buttons_state = 0;
253 s->mode = WACOM_MODE_HID;
254}
255
256static void usb_wacom_handle_control(USBDevice *dev, USBPacket *p,
257 int request, int value, int index, int length, uint8_t *data)
258{
259 USBWacomState *s = (USBWacomState *) dev;
260 int ret;
261
262 ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
263 if (ret >= 0) {
264 return;
265 }
266
267 switch (request) {
268 case WACOM_SET_REPORT:
269 if (s->mouse_grabbed) {
270 qemu_remove_mouse_event_handler(s->eh_entry);
271 s->mouse_grabbed = 0;
272 }
273 s->mode = data[0];
274 break;
275 case WACOM_GET_REPORT:
276 data[0] = 0;
277 data[1] = s->mode;
278 p->actual_length = 2;
279 break;
280
281 case HID_GET_REPORT:
282 if (s->mode == WACOM_MODE_HID)
283 p->actual_length = usb_mouse_poll(s, data, length);
284 else if (s->mode == WACOM_MODE_WACOM)
285 p->actual_length = usb_wacom_poll(s, data, length);
286 break;
287 case HID_GET_IDLE:
288 data[0] = s->idle;
289 p->actual_length = 1;
290 break;
291 case HID_SET_IDLE:
292 s->idle = (uint8_t) (value >> 8);
293 break;
294 default:
295 p->status = USB_RET_STALL;
296 break;
297 }
298}
299
300static void usb_wacom_handle_data(USBDevice *dev, USBPacket *p)
301{
302 USBWacomState *s = (USBWacomState *) dev;
303 uint8_t buf[p->iov.size];
304 int len = 0;
305
306 switch (p->pid) {
307 case USB_TOKEN_IN:
308 if (p->ep->nr == 1) {
309 if (!(s->changed || s->idle)) {
310 p->status = USB_RET_NAK;
311 return;
312 }
313 s->changed = 0;
314 if (s->mode == WACOM_MODE_HID)
315 len = usb_mouse_poll(s, buf, p->iov.size);
316 else if (s->mode == WACOM_MODE_WACOM)
317 len = usb_wacom_poll(s, buf, p->iov.size);
318 usb_packet_copy(p, buf, len);
319 break;
320 }
321
322 case USB_TOKEN_OUT:
323 default:
324 p->status = USB_RET_STALL;
325 }
326}
327
328static void usb_wacom_handle_destroy(USBDevice *dev)
329{
330 USBWacomState *s = (USBWacomState *) dev;
331
332 if (s->mouse_grabbed) {
333 qemu_remove_mouse_event_handler(s->eh_entry);
334 s->mouse_grabbed = 0;
335 }
336}
337
338static int usb_wacom_initfn(USBDevice *dev)
339{
340 USBWacomState *s = DO_UPCAST(USBWacomState, dev, dev);
341 usb_desc_create_serial(dev);
342 usb_desc_init(dev);
343 s->intr = usb_ep_get(dev, USB_TOKEN_IN, 1);
344 s->changed = 1;
345 return 0;
346}
347
348static const VMStateDescription vmstate_usb_wacom = {
349 .name = "usb-wacom",
350 .unmigratable = 1,
351};
352
353static void usb_wacom_class_init(ObjectClass *klass, void *data)
354{
355 DeviceClass *dc = DEVICE_CLASS(klass);
356 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
357
358 uc->product_desc = "QEMU PenPartner Tablet";
359 uc->usb_desc = &desc_wacom;
360 uc->init = usb_wacom_initfn;
361 uc->handle_reset = usb_wacom_handle_reset;
362 uc->handle_control = usb_wacom_handle_control;
363 uc->handle_data = usb_wacom_handle_data;
364 uc->handle_destroy = usb_wacom_handle_destroy;
365 dc->desc = "QEMU PenPartner Tablet";
366 dc->vmsd = &vmstate_usb_wacom;
367}
368
369static const TypeInfo wacom_info = {
370 .name = "usb-wacom-tablet",
371 .parent = TYPE_USB_DEVICE,
372 .instance_size = sizeof(USBWacomState),
373 .class_init = usb_wacom_class_init,
374};
375
376static void usb_wacom_register_types(void)
377{
378 type_register_static(&wacom_info);
379 usb_legacy_register("usb-wacom-tablet", "wacom-tablet", NULL);
380}
381
382type_init(usb_wacom_register_types)
383
