?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
server: Clip visible region to the surface rectangle instead of the desktop.
[wine.git] / dlls / winebus.sys / bus_udev.c
blobd34e18c71c72c681871c64c3f867f5daa5eb7bec
1 /*
2 * Plug and Play support for hid devices found through udev
3 *
4 * Copyright 2016 CodeWeavers, Aric Stewart
5 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2.1 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
19 */
20
21 #include "config.h"
22 #include <errno.h>
23 #include <fcntl.h>
24 #include <stdarg.h>
25 #include <stdlib.h>
26 #include <stdio.h>
27 #ifdef HAVE_UNISTD_H
28 # include <unistd.h>
29 #endif
30 #ifdef HAVE_POLL_H
31 # include <poll.h>
32 #endif
33 #ifdef HAVE_SYS_POLL_H
34 # include <sys/poll.h>
35 #endif
36 #ifdef HAVE_LIBUDEV_H
37 # include <libudev.h>
38 #endif
39 #ifdef HAVE_LINUX_HIDRAW_H
40 # include <linux/hidraw.h>
41 #endif
42 #ifdef HAVE_SYS_IOCTL_H
43 # include <sys/ioctl.h>
44 #endif
45
46 #ifdef HAVE_LINUX_INPUT_H
47 # include <linux/input.h>
48 # undef SW_MAX
49 # if defined(EVIOCGBIT) && defined(EV_ABS) && defined(BTN_PINKIE)
50 # define HAS_PROPER_INPUT_HEADER
51 # endif
52 # ifndef SYN_DROPPED
53 # define SYN_DROPPED 3
54 # endif
55 #endif
56
57 #define NONAMELESSUNION
58
59 #include "ntstatus.h"
60 #define WIN32_NO_STATUS
61 #include "windef.h"
62 #include "winbase.h"
63 #include "winnls.h"
64 #include "winternl.h"
65 #include "ddk/wdm.h"
66 #include "ddk/hidtypes.h"
67 #include "wine/debug.h"
68 #include "wine/unicode.h"
69
70 #ifdef HAS_PROPER_INPUT_HEADER
71 # include "hidusage.h"
72 #endif
73
74 #ifdef WORDS_BIGENDIAN
75 #define LE_WORD(x) RtlUshortByteSwap(x)
76 #define LE_DWORD(x) RtlUlongByteSwap(x)
77 #else
78 #define LE_WORD(x) (x)
79 #define LE_DWORD(x) (x)
80 #endif
81
82 #include "controller.h"
83 #include "bus.h"
84
85 WINE_DEFAULT_DEBUG_CHANNEL(plugplay);
86
87 #ifdef HAVE_UDEV
88
89 WINE_DECLARE_DEBUG_CHANNEL(hid_report);
90
91 static struct udev *udev_context = NULL;
92 static DRIVER_OBJECT *udev_driver_obj = NULL;
93 static DWORD disable_hidraw = 0;
94 static DWORD disable_input = 0;
95
96 static const WCHAR hidraw_busidW[] = {'H','I','D','R','A','W',0};
97 static const WCHAR lnxev_busidW[] = {'L','N','X','E','V',0};
98
99 #include "initguid.h"
100 DEFINE_GUID(GUID_DEVCLASS_HIDRAW, 0x3def44ad,0x242e,0x46e5,0x82,0x6d,0x70,0x72,0x13,0xf3,0xaa,0x81);
101 DEFINE_GUID(GUID_DEVCLASS_LINUXEVENT, 0x1b932c0d,0xfea7,0x42cd,0x8e,0xaa,0x0e,0x48,0x79,0xb6,0x9e,0xaa);
102
103 struct platform_private
104 {
105 struct udev_device *udev_device;
106 int device_fd;
107
108 HANDLE report_thread;
109 int control_pipe[2];
110 };
111
112 static inline struct platform_private *impl_from_DEVICE_OBJECT(DEVICE_OBJECT *device)
113 {
114 return (struct platform_private *)get_platform_private(device);
115 }
116
117 #ifdef HAS_PROPER_INPUT_HEADER
118
119 static const BYTE REPORT_ABS_AXIS_TAIL[] = {
120 0x17, 0x00, 0x00, 0x00, 0x00, /* LOGICAL_MINIMUM (0) */
121 0x27, 0xff, 0x00, 0x00, 0x00, /* LOGICAL_MAXIMUM (0xff) */
122 0x37, 0x00, 0x00, 0x00, 0x00, /* PHYSICAL_MINIMUM (0) */
123 0x47, 0xff, 0x00, 0x00, 0x00, /* PHYSICAL_MAXIMUM (256) */
124 0x75, 0x20, /* REPORT_SIZE (32) */
125 0x95, 0x00, /* REPORT_COUNT (2) */
126 0x81, 0x02, /* INPUT (Data,Var,Abs) */
127 };
128 #define IDX_ABS_LOG_MINIMUM 1
129 #define IDX_ABS_LOG_MAXIMUM 6
130 #define IDX_ABS_PHY_MINIMUM 11
131 #define IDX_ABS_PHY_MAXIMUM 16
132 #define IDX_ABS_AXIS_COUNT 23
133
134 static const BYTE ABS_TO_HID_MAP[][2] = {
135 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_X}, /*ABS_X*/
136 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_Y}, /*ABS_Y*/
137 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_Z}, /*ABS_Z*/
138 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_RX}, /*ABS_RX*/
139 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_RY}, /*ABS_RY*/
140 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_RZ}, /*ABS_RZ*/
141 {HID_USAGE_PAGE_SIMULATION, HID_USAGE_SIMULATION_THROTTLE}, /*ABS_THROTTLE*/
142 {HID_USAGE_PAGE_SIMULATION, HID_USAGE_SIMULATION_RUDDER}, /*ABS_RUDDER*/
143 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_WHEEL}, /*ABS_WHEEL*/
144 {HID_USAGE_PAGE_SIMULATION, 0xC4}, /*ABS_GAS*/
145 {HID_USAGE_PAGE_SIMULATION, 0xC5}, /*ABS_BRAKE*/
146 {0,0}, /*ABS_HAT0X*/
147 {0,0}, /*ABS_HAT0Y*/
148 {0,0}, /*ABS_HAT1X*/
149 {0,0}, /*ABS_HAT1Y*/
150 {0,0}, /*ABS_HAT2X*/
151 {0,0}, /*ABS_HAT2Y*/
152 {0,0}, /*ABS_HAT3X*/
153 {0,0}, /*ABS_HAT3Y*/
154 {HID_USAGE_PAGE_DIGITIZER, 0x30}, /*ABS_PRESSURE*/
155 {0, 0}, /*ABS_DISTANCE*/
156 {HID_USAGE_PAGE_DIGITIZER, 0x3D}, /*ABS_TILT_X*/
157 {HID_USAGE_PAGE_DIGITIZER, 0x3F}, /*ABS_TILT_Y*/
158 {0, 0}, /*ABS_TOOL_WIDTH*/
159 {0, 0},
160 {0, 0},
161 {0, 0},
162 {HID_USAGE_PAGE_CONSUMER, 0xE0} /*ABS_VOLUME*/
163 };
164 #define HID_ABS_MAX (ABS_VOLUME+1)
165 #define TOP_ABS_PAGE (HID_USAGE_PAGE_DIGITIZER+1)
166
167 static const BYTE REL_TO_HID_MAP[][2] = {
168 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_X}, /* REL_X */
169 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_Y}, /* REL_Y */
170 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_Z}, /* REL_Z */
171 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_RX}, /* REL_RX */
172 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_RY}, /* REL_RY */
173 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_RZ}, /* REL_RZ */
174 {0, 0}, /* REL_HWHEEL */
175 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_DIAL}, /* REL_DIAL */
176 {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_WHEEL}, /* REL_WHEEL */
177 {0, 0} /* REL_MISC */
178 };
179
180 #define HID_REL_MAX (REL_MISC+1)
181 #define TOP_REL_PAGE (HID_USAGE_PAGE_CONSUMER+1)
182
183 struct wine_input_absinfo {
184 struct input_absinfo info;
185 BYTE report_index;
186 };
187
188 struct wine_input_private {
189 struct platform_private base;
190
191 int buffer_length;
192 BYTE *last_report_buffer;
193 BYTE *current_report_buffer;
194 enum { FIRST, NORMAL, DROPPED } report_state;
195
196 int report_descriptor_size;
197 BYTE *report_descriptor;
198
199 BYTE button_map[KEY_MAX];
200 BYTE rel_map[HID_REL_MAX];
201 BYTE hat_map[8];
202 int hat_values[8];
203 struct wine_input_absinfo abs_map[HID_ABS_MAX];
204 };
205
206 #define test_bit(arr,bit) (((BYTE*)(arr))[(bit)>>3]&(1<<((bit)&7)))
207
208 static BYTE *add_axis_block(BYTE *report_ptr, BYTE count, BYTE page, BYTE *usages, BOOL absolute, const struct wine_input_absinfo *absinfo)
209 {
210 int i;
211 memcpy(report_ptr, REPORT_AXIS_HEADER, sizeof(REPORT_AXIS_HEADER));
212 report_ptr[IDX_AXIS_PAGE] = page;
213 report_ptr += sizeof(REPORT_AXIS_HEADER);
214 for (i = 0; i < count; i++)
215 {
216 memcpy(report_ptr, REPORT_AXIS_USAGE, sizeof(REPORT_AXIS_USAGE));
217 report_ptr[IDX_AXIS_USAGE] = usages[i];
218 report_ptr += sizeof(REPORT_AXIS_USAGE);
219 }
220 if (absolute)
221 {
222 memcpy(report_ptr, REPORT_ABS_AXIS_TAIL, sizeof(REPORT_ABS_AXIS_TAIL));
223 if (absinfo)
224 {
225 *((int*)&report_ptr[IDX_ABS_LOG_MINIMUM]) = LE_DWORD(absinfo->info.minimum);
226 *((int*)&report_ptr[IDX_ABS_LOG_MAXIMUM]) = LE_DWORD(absinfo->info.maximum);
227 *((int*)&report_ptr[IDX_ABS_PHY_MINIMUM]) = LE_DWORD(absinfo->info.minimum);
228 *((int*)&report_ptr[IDX_ABS_PHY_MAXIMUM]) = LE_DWORD(absinfo->info.maximum);
229 }
230 report_ptr[IDX_ABS_AXIS_COUNT] = count;
231 report_ptr += sizeof(REPORT_ABS_AXIS_TAIL);
232 }
233 else
234 {
235 memcpy(report_ptr, REPORT_REL_AXIS_TAIL, sizeof(REPORT_REL_AXIS_TAIL));
236 report_ptr[IDX_REL_AXIS_COUNT] = count;
237 report_ptr += sizeof(REPORT_REL_AXIS_TAIL);
238 }
239 return report_ptr;
240 }
241
242 static const BYTE* what_am_I(struct udev_device *dev)
243 {
244 static const BYTE Unknown[2] = {HID_USAGE_PAGE_GENERIC, 0};
245 static const BYTE Mouse[2] = {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_MOUSE};
246 static const BYTE Keyboard[2] = {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_KEYBOARD};
247 static const BYTE Gamepad[2] = {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_GAMEPAD};
248 static const BYTE Keypad[2] = {HID_USAGE_PAGE_GENERIC, HID_USAGE_GENERIC_KEYPAD};
249 static const BYTE Tablet[2] = {HID_USAGE_PAGE_DIGITIZER, 0x2};
250 static const BYTE Touchscreen[2] = {HID_USAGE_PAGE_DIGITIZER, 0x4};
251 static const BYTE Touchpad[2] = {HID_USAGE_PAGE_DIGITIZER, 0x5};
252
253 struct udev_device *parent = dev;
254
255 /* Look to the parents until we get a clue */
256 while (parent)
257 {
258 if (udev_device_get_property_value(parent, "ID_INPUT_MOUSE"))
259 return Mouse;
260 else if (udev_device_get_property_value(parent, "ID_INPUT_KEYBOARD"))
261 return Keyboard;
262 else if (udev_device_get_property_value(parent, "ID_INPUT_JOYSTICK"))
263 return Gamepad;
264 else if (udev_device_get_property_value(parent, "ID_INPUT_KEY"))
265 return Keypad;
266 else if (udev_device_get_property_value(parent, "ID_INPUT_TOUCHPAD"))
267 return Touchpad;
268 else if (udev_device_get_property_value(parent, "ID_INPUT_TOUCHSCREEN"))
269 return Touchscreen;
270 else if (udev_device_get_property_value(parent, "ID_INPUT_TABLET"))
271 return Tablet;
272
273 parent = udev_device_get_parent_with_subsystem_devtype(parent, "input", NULL);
274 }
275 return Unknown;
276 }
277
278 static void set_abs_axis_value(struct wine_input_private *ext, int code, int value)
279 {
280 int index;
281 /* check for hatswitches */
282 if (code <= ABS_HAT3Y && code >= ABS_HAT0X)
283 {
284 index = code - ABS_HAT0X;
285 ext->hat_values[index] = value;
286 if ((code - ABS_HAT0X) % 2)
287 index--;
288 if (ext->hat_values[index] == 0)
289 {
290 if (ext->hat_values[index+1] == 0)
291 value = 8;
292 else if (ext->hat_values[index+1] < 0)
293 value = 0;
294 else
295 value = 4;
296 }
297 else if (ext->hat_values[index] > 0)
298 {
299 if (ext->hat_values[index+1] == 0)
300 value = 2;
301 else if (ext->hat_values[index+1] < 0)
302 value = 1;
303 else
304 value = 3;
305 }
306 else
307 {
308 if (ext->hat_values[index+1] == 0)
309 value = 6;
310 else if (ext->hat_values[index+1] < 0)
311 value = 7;
312 else
313 value = 5;
314 }
315 ext->current_report_buffer[ext->hat_map[index]] = value;
316 }
317 else if (code < HID_ABS_MAX && ABS_TO_HID_MAP[code][0] != 0)
318 {
319 index = ext->abs_map[code].report_index;
320 *((DWORD*)&ext->current_report_buffer[index]) = LE_DWORD(value);
321 }
322 }
323
324 static void set_rel_axis_value(struct wine_input_private *ext, int code, int value)
325 {
326 int index;
327 if (code < HID_REL_MAX && REL_TO_HID_MAP[code][0] != 0)
328 {
329 index = ext->rel_map[code];
330 if (value > 127) value = 127;
331 if (value < -127) value = -127;
332 ext->current_report_buffer[index] = value;
333 }
334 }
335
336 static INT count_buttons(int device_fd, BYTE *map)
337 {
338 int i;
339 int button_count = 0;
340 BYTE keybits[(KEY_MAX+7)/8];
341
342 if (ioctl(device_fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits) == -1)
343 {
344 WARN("ioctl(EVIOCGBIT, EV_KEY) failed: %d %s\n", errno, strerror(errno));
345 return FALSE;
346 }
347
348 for (i = BTN_MISC; i < KEY_MAX; i++)
349 {
350 if (test_bit(keybits, i))
351 {
352 if (map) map[i] = button_count;
353 button_count++;
354 }
355 }
356 return button_count;
357 }
358
359 static INT count_abs_axis(int device_fd)
360 {
361 BYTE absbits[(ABS_MAX+7)/8];
362 int abs_count = 0;
363 int i;
364
365 if (ioctl(device_fd, EVIOCGBIT(EV_ABS, sizeof(absbits)), absbits) == -1)
366 {
367 WARN("ioctl(EVIOCGBIT, EV_ABS) failed: %d %s\n", errno, strerror(errno));
368 return 0;
369 }
370
371 for (i = 0; i < HID_ABS_MAX; i++)
372 if (test_bit(absbits, i) &&
373 (ABS_TO_HID_MAP[i][1] >= HID_USAGE_GENERIC_X &&
374 ABS_TO_HID_MAP[i][1] <= HID_USAGE_GENERIC_WHEEL))
375 abs_count++;
376 return abs_count;
377 }
378
379 static BOOL build_report_descriptor(struct wine_input_private *ext, struct udev_device *dev)
380 {
381 int abs_pages[TOP_ABS_PAGE][HID_ABS_MAX+1];
382 int rel_pages[TOP_REL_PAGE][HID_REL_MAX+1];
383 BYTE absbits[(ABS_MAX+7)/8];
384 BYTE relbits[(REL_MAX+7)/8];
385 BYTE *report_ptr;
386 INT i, descript_size;
387 INT report_size;
388 INT button_count, abs_count, rel_count, hat_count;
389 const BYTE *device_usage = what_am_I(dev);
390
391 if (ioctl(ext->base.device_fd, EVIOCGBIT(EV_REL, sizeof(relbits)), relbits) == -1)
392 {
393 WARN("ioctl(EVIOCGBIT, EV_REL) failed: %d %s\n", errno, strerror(errno));
394 return FALSE;
395 }
396 if (ioctl(ext->base.device_fd, EVIOCGBIT(EV_ABS, sizeof(absbits)), absbits) == -1)
397 {
398 WARN("ioctl(EVIOCGBIT, EV_ABS) failed: %d %s\n", errno, strerror(errno));
399 return FALSE;
400 }
401
402 descript_size = sizeof(REPORT_HEADER) + sizeof(REPORT_TAIL);
403 report_size = 0;
404
405 /* For now lump all buttons just into incremental usages, Ignore Keys */
406 button_count = count_buttons(ext->base.device_fd, ext->button_map);
407 if (button_count)
408 {
409 descript_size += sizeof(REPORT_BUTTONS);
410 if (button_count % 8)
411 descript_size += sizeof(REPORT_PADDING);
412 report_size = (button_count + 7) / 8;
413 }
414
415 abs_count = 0;
416 memset(abs_pages, 0, sizeof(abs_pages));
417 for (i = 0; i < HID_ABS_MAX; i++)
418 if (test_bit(absbits, i))
419 {
420 abs_pages[ABS_TO_HID_MAP[i][0]][0]++;
421 abs_pages[ABS_TO_HID_MAP[i][0]][abs_pages[ABS_TO_HID_MAP[i][0]][0]] = i;
422
423 ioctl(ext->base.device_fd, EVIOCGABS(i), &(ext->abs_map[i]));
424 if (abs_pages[ABS_TO_HID_MAP[i][0]][0] == 1)
425 {
426 descript_size += sizeof(REPORT_AXIS_HEADER);
427 descript_size += sizeof(REPORT_ABS_AXIS_TAIL);
428 }
429 }
430 /* Skip page 0, aka HID_USAGE_PAGE_UNDEFINED */
431 for (i = 1; i < TOP_ABS_PAGE; i++)
432 if (abs_pages[i][0] > 0)
433 {
434 int j;
435 descript_size += sizeof(REPORT_AXIS_USAGE) * abs_pages[i][0];
436 for (j = 1; j <= abs_pages[i][0]; j++)
437 {
438 ext->abs_map[abs_pages[i][j]].report_index = report_size;
439 report_size+=4;
440 }
441 abs_count++;
442 }
443
444 rel_count = 0;
445 memset(rel_pages, 0, sizeof(rel_pages));
446 for (i = 0; i < HID_REL_MAX; i++)
447 if (test_bit(relbits, i))
448 {
449 rel_pages[REL_TO_HID_MAP[i][0]][0]++;
450 rel_pages[REL_TO_HID_MAP[i][0]][rel_pages[REL_TO_HID_MAP[i][0]][0]] = i;
451 if (rel_pages[REL_TO_HID_MAP[i][0]][0] == 1)
452 {
453 descript_size += sizeof(REPORT_AXIS_HEADER);
454 descript_size += sizeof(REPORT_REL_AXIS_TAIL);
455 }
456 }
457 /* Skip page 0, aka HID_USAGE_PAGE_UNDEFINED */
458 for (i = 1; i < TOP_REL_PAGE; i++)
459 if (rel_pages[i][0] > 0)
460 {
461 int j;
462 descript_size += sizeof(REPORT_AXIS_USAGE) * rel_pages[i][0];
463 for (j = 1; j <= rel_pages[i][0]; j++)
464 {
465 ext->rel_map[rel_pages[i][j]] = report_size;
466 report_size++;
467 }
468 rel_count++;
469 }
470
471 hat_count = 0;
472 for (i = ABS_HAT0X; i <=ABS_HAT3X; i+=2)
473 if (test_bit(absbits, i))
474 {
475 ext->hat_map[i - ABS_HAT0X] = report_size;
476 ext->hat_values[i - ABS_HAT0X] = 0;
477 ext->hat_values[i - ABS_HAT0X + 1] = 0;
478 report_size++;
479 hat_count++;
480 }
481
482 TRACE("Report Descriptor will be %i bytes\n", descript_size);
483 TRACE("Report will be %i bytes\n", report_size);
484
485 ext->report_descriptor = HeapAlloc(GetProcessHeap(), 0, descript_size);
486 if (!ext->report_descriptor)
487 {
488 ERR("Failed to alloc report descriptor\n");
489 return FALSE;
490 }
491 report_ptr = ext->report_descriptor;
492
493 memcpy(report_ptr, REPORT_HEADER, sizeof(REPORT_HEADER));
494 report_ptr[IDX_HEADER_PAGE] = device_usage[0];
495 report_ptr[IDX_HEADER_USAGE] = device_usage[1];
496 report_ptr += sizeof(REPORT_HEADER);
497 if (button_count)
498 {
499 report_ptr = add_button_block(report_ptr, 1, button_count);
500 if (button_count % 8)
501 {
502 BYTE padding = 8 - (button_count % 8);
503 report_ptr = add_padding_block(report_ptr, padding);
504 }
505 }
506 if (abs_count)
507 {
508 for (i = 1; i < TOP_ABS_PAGE; i++)
509 {
510 if (abs_pages[i][0])
511 {
512 BYTE usages[HID_ABS_MAX];
513 int j;
514 for (j = 0; j < abs_pages[i][0]; j++)
515 usages[j] = ABS_TO_HID_MAP[abs_pages[i][j+1]][1];
516 report_ptr = add_axis_block(report_ptr, abs_pages[i][0], i, usages, TRUE, &ext->abs_map[abs_pages[i][1]]);
517 }
518 }
519 }
520 if (rel_count)
521 {
522 for (i = 1; i < TOP_REL_PAGE; i++)
523 {
524 if (rel_pages[i][0])
525 {
526 BYTE usages[HID_REL_MAX];
527 int j;
528 for (j = 0; j < rel_pages[i][0]; j++)
529 usages[j] = REL_TO_HID_MAP[rel_pages[i][j+1]][1];
530 report_ptr = add_axis_block(report_ptr, rel_pages[i][0], i, usages, FALSE, NULL);
531 }
532 }
533 }
534 if (hat_count)
535 report_ptr = add_hatswitch(report_ptr, hat_count);
536
537 memcpy(report_ptr, REPORT_TAIL, sizeof(REPORT_TAIL));
538
539 ext->report_descriptor_size = descript_size;
540 ext->buffer_length = report_size;
541 ext->current_report_buffer = HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY, report_size);
542 if (ext->current_report_buffer == NULL)
543 {
544 ERR("Failed to alloc report buffer\n");
545 HeapFree(GetProcessHeap(), 0, ext->report_descriptor);
546 return FALSE;
547 }
548 ext->last_report_buffer = HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY, report_size);
549 if (ext->last_report_buffer == NULL)
550 {
551 ERR("Failed to alloc report buffer\n");
552 HeapFree(GetProcessHeap(), 0, ext->report_descriptor);
553 HeapFree(GetProcessHeap(), 0, ext->current_report_buffer);
554 return FALSE;
555 }
556 ext->report_state = FIRST;
557
558 /* Initialize axis in the report */
559 for (i = 0; i < HID_ABS_MAX; i++)
560 if (test_bit(absbits, i))
561 set_abs_axis_value(ext, i, ext->abs_map[i].info.value);
562
563 return TRUE;
564 }
565
566 static BOOL set_report_from_event(struct wine_input_private *ext, struct input_event *ie)
567 {
568 switch(ie->type)
569 {
570 #ifdef EV_SYN
571 case EV_SYN:
572 switch (ie->code)
573 {
574 case SYN_REPORT:
575 if (ext->report_state == NORMAL)
576 {
577 memcpy(ext->last_report_buffer, ext->current_report_buffer, ext->buffer_length);
578 return TRUE;
579 }
580 else
581 {
582 if (ext->report_state == DROPPED)
583 memcpy(ext->current_report_buffer, ext->last_report_buffer, ext->buffer_length);
584 ext->report_state = NORMAL;
585 }
586 break;
587 case SYN_DROPPED:
588 TRACE_(hid_report)("received SY_DROPPED\n");
589 ext->report_state = DROPPED;
590 }
591 return FALSE;
592 #endif
593 #ifdef EV_MSC
594 case EV_MSC:
595 return FALSE;
596 #endif
597 case EV_KEY:
598 set_button_value(ext->button_map[ie->code], ie->value, ext->current_report_buffer);
599 return FALSE;
600 case EV_ABS:
601 set_abs_axis_value(ext, ie->code, ie->value);
602 return FALSE;
603 case EV_REL:
604 set_rel_axis_value(ext, ie->code, ie->value);
605 return FALSE;
606 default:
607 ERR("TODO: Process Report (%i, %i)\n",ie->type, ie->code);
608 return FALSE;
609 }
610 }
611 #endif
612
613 static inline WCHAR *strdupAtoW(const char *src)
614 {
615 WCHAR *dst;
616 DWORD len;
617 if (!src) return NULL;
618 len = MultiByteToWideChar(CP_UNIXCP, 0, src, -1, NULL, 0);
619 if ((dst = HeapAlloc(GetProcessHeap(), 0, len * sizeof(WCHAR))))
620 MultiByteToWideChar(CP_UNIXCP, 0, src, -1, dst, len);
621 return dst;
622 }
623
624 static WCHAR *get_sysattr_string(struct udev_device *dev, const char *sysattr)
625 {
626 const char *attr = udev_device_get_sysattr_value(dev, sysattr);
627 if (!attr)
628 {
629 WARN("Could not get %s from device\n", sysattr);
630 return NULL;
631 }
632 return strdupAtoW(attr);
633 }
634
635 static int compare_platform_device(DEVICE_OBJECT *device, void *platform_dev)
636 {
637 struct udev_device *dev1 = impl_from_DEVICE_OBJECT(device)->udev_device;
638 struct udev_device *dev2 = platform_dev;
639 return strcmp(udev_device_get_syspath(dev1), udev_device_get_syspath(dev2));
640 }
641
642 static NTSTATUS hidraw_get_reportdescriptor(DEVICE_OBJECT *device, BYTE *buffer, DWORD length, DWORD *out_length)
643 {
644 #ifdef HAVE_LINUX_HIDRAW_H
645 struct hidraw_report_descriptor descriptor;
646 struct platform_private *private = impl_from_DEVICE_OBJECT(device);
647
648 if (ioctl(private->device_fd, HIDIOCGRDESCSIZE, &descriptor.size) == -1)
649 {
650 WARN("ioctl(HIDIOCGRDESCSIZE) failed: %d %s\n", errno, strerror(errno));
651 return STATUS_UNSUCCESSFUL;
652 }
653
654 *out_length = descriptor.size;
655
656 if (length < descriptor.size)
657 return STATUS_BUFFER_TOO_SMALL;
658 if (!descriptor.size)
659 return STATUS_SUCCESS;
660
661 if (ioctl(private->device_fd, HIDIOCGRDESC, &descriptor) == -1)
662 {
663 WARN("ioctl(HIDIOCGRDESC) failed: %d %s\n", errno, strerror(errno));
664 return STATUS_UNSUCCESSFUL;
665 }
666
667 memcpy(buffer, descriptor.value, descriptor.size);
668 return STATUS_SUCCESS;
669 #else
670 return STATUS_NOT_IMPLEMENTED;
671 #endif
672 }
673
674 static NTSTATUS hidraw_get_string(DEVICE_OBJECT *device, DWORD index, WCHAR *buffer, DWORD length)
675 {
676 struct udev_device *hiddev;
677 struct platform_private *private = impl_from_DEVICE_OBJECT(device);
678 WCHAR *str = NULL;
679
680 hiddev = udev_device_get_parent_with_subsystem_devtype(private->udev_device, "hid", NULL);
681 if (hiddev)
682 {
683 switch (index)
684 {
685 case HID_STRING_ID_IPRODUCT:
686 str = get_sysattr_string(hiddev, "product");
687 break;
688 case HID_STRING_ID_IMANUFACTURER:
689 str = get_sysattr_string(hiddev, "manufacturer");
690 break;
691 case HID_STRING_ID_ISERIALNUMBER:
692 str = get_sysattr_string(hiddev, "serial");
693 break;
694 default:
695 ERR("Unhandled string index %08x\n", index);
696 return STATUS_NOT_IMPLEMENTED;
697 }
698 }
699 else
700 {
701 #ifdef HAVE_LINUX_HIDRAW_H
702 switch (index)
703 {
704 case HID_STRING_ID_IPRODUCT:
705 {
706 char buf[MAX_PATH];
707 if (ioctl(private->device_fd, HIDIOCGRAWNAME(MAX_PATH), buf) == -1)
708 WARN("ioctl(HIDIOCGRAWNAME) failed: %d %s\n", errno, strerror(errno));
709 else
710 str = strdupAtoW(buf);
711 break;
712 }
713 case HID_STRING_ID_IMANUFACTURER:
714 break;
715 case HID_STRING_ID_ISERIALNUMBER:
716 break;
717 default:
718 ERR("Unhandled string index %08x\n", index);
719 return STATUS_NOT_IMPLEMENTED;
720 }
721 #else
722 return STATUS_NOT_IMPLEMENTED;
723 #endif
724 }
725
726 if (!str)
727 {
728 if (!length) return STATUS_BUFFER_TOO_SMALL;
729 buffer[0] = 0;
730 return STATUS_SUCCESS;
731 }
732
733 if (length <= strlenW(str))
734 {
735 HeapFree(GetProcessHeap(), 0, str);
736 return STATUS_BUFFER_TOO_SMALL;
737 }
738
739 strcpyW(buffer, str);
740 HeapFree(GetProcessHeap(), 0, str);
741 return STATUS_SUCCESS;
742 }
743
744 static DWORD CALLBACK device_report_thread(void *args)
745 {
746 DEVICE_OBJECT *device = (DEVICE_OBJECT*)args;
747 struct platform_private *private = impl_from_DEVICE_OBJECT(device);
748 struct pollfd plfds[2];
749
750 plfds[0].fd = private->device_fd;
751 plfds[0].events = POLLIN;
752 plfds[0].revents = 0;
753 plfds[1].fd = private->control_pipe[0];
754 plfds[1].events = POLLIN;
755 plfds[1].revents = 0;
756
757 while (1)
758 {
759 int size;
760 BYTE report_buffer[1024];
761
762 if (poll(plfds, 2, -1) <= 0) continue;
763 if (plfds[1].revents)
764 break;
765 size = read(plfds[0].fd, report_buffer, sizeof(report_buffer));
766 if (size == -1)
767 TRACE_(hid_report)("Read failed. Likely an unplugged device\n");
768 else if (size == 0)
769 TRACE_(hid_report)("Failed to read report\n");
770 else
771 process_hid_report(device, report_buffer, size);
772 }
773 return 0;
774 }
775
776 static NTSTATUS begin_report_processing(DEVICE_OBJECT *device)
777 {
778 struct platform_private *private = impl_from_DEVICE_OBJECT(device);
779
780 if (private->report_thread)
781 return STATUS_SUCCESS;
782
783 if (pipe(private->control_pipe) != 0)
784 {
785 ERR("Control pipe creation failed\n");
786 return STATUS_UNSUCCESSFUL;
787 }
788
789 private->report_thread = CreateThread(NULL, 0, device_report_thread, device, 0, NULL);
790 if (!private->report_thread)
791 {
792 ERR("Unable to create device report thread\n");
793 close(private->control_pipe[0]);
794 close(private->control_pipe[1]);
795 return STATUS_UNSUCCESSFUL;
796 }
797 else
798 return STATUS_SUCCESS;
799 }
800
801 static NTSTATUS hidraw_set_output_report(DEVICE_OBJECT *device, UCHAR id, BYTE *report, DWORD length, ULONG_PTR *written)
802 {
803 struct platform_private* ext = impl_from_DEVICE_OBJECT(device);
804 ssize_t rc;
805
806 if (id != 0)
807 rc = write(ext->device_fd, report, length);
808 else
809 {
810 BYTE report_buffer[1024];
811
812 if (length + 1 > sizeof(report_buffer))
813 {
814 ERR("Output report buffer too small\n");
815 return STATUS_UNSUCCESSFUL;
816 }
817
818 report_buffer[0] = 0;
819 memcpy(&report_buffer[1], report, length);
820 rc = write(ext->device_fd, report_buffer, length + 1);
821 }
822 if (rc > 0)
823 {
824 *written = rc;
825 return STATUS_SUCCESS;
826 }
827 else
828 {
829 *written = 0;
830 return STATUS_UNSUCCESSFUL;
831 }
832 }
833
834 static NTSTATUS hidraw_get_feature_report(DEVICE_OBJECT *device, UCHAR id, BYTE *report, DWORD length, ULONG_PTR *read)
835 {
836 #if defined(HAVE_LINUX_HIDRAW_H) && defined(HIDIOCGFEATURE)
837 int rc;
838 struct platform_private* ext = impl_from_DEVICE_OBJECT(device);
839 report[0] = id;
840 length = min(length, 0x1fff);
841 rc = ioctl(ext->device_fd, HIDIOCGFEATURE(length), report);
842 if (rc >= 0)
843 {
844 *read = rc;
845 return STATUS_SUCCESS;
846 }
847 else
848 {
849 *read = 0;
850 return STATUS_UNSUCCESSFUL;
851 }
852 #else
853 *read = 0;
854 return STATUS_NOT_IMPLEMENTED;
855 #endif
856 }
857
858 static NTSTATUS hidraw_set_feature_report(DEVICE_OBJECT *device, UCHAR id, BYTE *report, DWORD length, ULONG_PTR *written)
859 {
860 #if defined(HAVE_LINUX_HIDRAW_H) && defined(HIDIOCSFEATURE)
861 int rc;
862 struct platform_private* ext = impl_from_DEVICE_OBJECT(device);
863 BYTE *feature_buffer;
864 BYTE buffer[1024];
865
866 if (id == 0)
867 {
868 if (length + 1 > sizeof(buffer))
869 {
870 ERR("Output feature buffer too small\n");
871 return STATUS_UNSUCCESSFUL;
872 }
873 buffer[0] = 0;
874 memcpy(&buffer[1], report, length);
875 feature_buffer = buffer;
876 length = length + 1;
877 }
878 else
879 feature_buffer = report;
880 length = min(length, 0x1fff);
881 rc = ioctl(ext->device_fd, HIDIOCSFEATURE(length), feature_buffer);
882 if (rc >= 0)
883 {
884 *written = rc;
885 return STATUS_SUCCESS;
886 }
887 else
888 {
889 *written = 0;
890 return STATUS_UNSUCCESSFUL;
891 }
892 #else
893 *written = 0;
894 return STATUS_NOT_IMPLEMENTED;
895 #endif
896 }
897
898 static const platform_vtbl hidraw_vtbl =
899 {
900 compare_platform_device,
901 hidraw_get_reportdescriptor,
902 hidraw_get_string,
903 begin_report_processing,
904 hidraw_set_output_report,
905 hidraw_get_feature_report,
906 hidraw_set_feature_report,
907 };
908
909 #ifdef HAS_PROPER_INPUT_HEADER
910
911 static inline struct wine_input_private *input_impl_from_DEVICE_OBJECT(DEVICE_OBJECT *device)
912 {
913 return (struct wine_input_private*)get_platform_private(device);
914 }
915
916 static NTSTATUS lnxev_get_reportdescriptor(DEVICE_OBJECT *device, BYTE *buffer, DWORD length, DWORD *out_length)
917 {
918 struct wine_input_private *ext = input_impl_from_DEVICE_OBJECT(device);
919
920 *out_length = ext->report_descriptor_size;
921
922 if (length < ext->report_descriptor_size)
923 return STATUS_BUFFER_TOO_SMALL;
924
925 memcpy(buffer, ext->report_descriptor, ext->report_descriptor_size);
926
927 return STATUS_SUCCESS;
928 }
929
930 static NTSTATUS lnxev_get_string(DEVICE_OBJECT *device, DWORD index, WCHAR *buffer, DWORD length)
931 {
932 struct wine_input_private *ext = input_impl_from_DEVICE_OBJECT(device);
933 char str[255];
934
935 str[0] = 0;
936 switch (index)
937 {
938 case HID_STRING_ID_IPRODUCT:
939 ioctl(ext->base.device_fd, EVIOCGNAME(sizeof(str)), str);
940 break;
941 case HID_STRING_ID_IMANUFACTURER:
942 strcpy(str,"evdev");
943 break;
944 case HID_STRING_ID_ISERIALNUMBER:
945 ioctl(ext->base.device_fd, EVIOCGUNIQ(sizeof(str)), str);
946 break;
947 default:
948 ERR("Unhandled string index %i\n", index);
949 }
950
951 MultiByteToWideChar(CP_ACP, 0, str, -1, buffer, length);
952 return STATUS_SUCCESS;
953 }
954
955 static DWORD CALLBACK lnxev_device_report_thread(void *args)
956 {
957 DEVICE_OBJECT *device = (DEVICE_OBJECT*)args;
958 struct wine_input_private *private = input_impl_from_DEVICE_OBJECT(device);
959 struct pollfd plfds[2];
960
961 plfds[0].fd = private->base.device_fd;
962 plfds[0].events = POLLIN;
963 plfds[0].revents = 0;
964 plfds[1].fd = private->base.control_pipe[0];
965 plfds[1].events = POLLIN;
966 plfds[1].revents = 0;
967
968 while (1)
969 {
970 int size;
971 struct input_event ie;
972
973 if (poll(plfds, 2, -1) <= 0) continue;
974 if (plfds[1].revents || !private->current_report_buffer || private->buffer_length == 0)
975 break;
976 size = read(plfds[0].fd, &ie, sizeof(ie));
977 if (size == -1)
978 TRACE_(hid_report)("Read failed. Likely an unplugged device\n");
979 else if (size == 0)
980 TRACE_(hid_report)("Failed to read report\n");
981 else if (set_report_from_event(private, &ie))
982 process_hid_report(device, private->current_report_buffer, private->buffer_length);
983 }
984 return 0;
985 }
986
987 static NTSTATUS lnxev_begin_report_processing(DEVICE_OBJECT *device)
988 {
989 struct wine_input_private *private = input_impl_from_DEVICE_OBJECT(device);
990
991 if (private->base.report_thread)
992 return STATUS_SUCCESS;
993
994 if (pipe(private->base.control_pipe) != 0)
995 {
996 ERR("Control pipe creation failed\n");
997 return STATUS_UNSUCCESSFUL;
998 }
999
1000 private->base.report_thread = CreateThread(NULL, 0, lnxev_device_report_thread, device, 0, NULL);
1001 if (!private->base.report_thread)
1002 {
1003 ERR("Unable to create device report thread\n");
1004 close(private->base.control_pipe[0]);
1005 close(private->base.control_pipe[1]);
1006 return STATUS_UNSUCCESSFUL;
1007 }
1008 return STATUS_SUCCESS;
1009 }
1010
1011 static NTSTATUS lnxev_set_output_report(DEVICE_OBJECT *device, UCHAR id, BYTE *report, DWORD length, ULONG_PTR *written)
1012 {
1013 *written = 0;
1014 return STATUS_NOT_IMPLEMENTED;
1015 }
1016
1017 static NTSTATUS lnxev_get_feature_report(DEVICE_OBJECT *device, UCHAR id, BYTE *report, DWORD length, ULONG_PTR *read)
1018 {
1019 *read = 0;
1020 return STATUS_NOT_IMPLEMENTED;
1021 }
1022
1023 static NTSTATUS lnxev_set_feature_report(DEVICE_OBJECT *device, UCHAR id, BYTE *report, DWORD length, ULONG_PTR *written)
1024 {
1025 *written = 0;
1026 return STATUS_NOT_IMPLEMENTED;
1027 }
1028
1029 static const platform_vtbl lnxev_vtbl = {
1030 compare_platform_device,
1031 lnxev_get_reportdescriptor,
1032 lnxev_get_string,
1033 lnxev_begin_report_processing,
1034 lnxev_set_output_report,
1035 lnxev_get_feature_report,
1036 lnxev_set_feature_report,
1037 };
1038 #endif
1039
1040 static int check_same_device(DEVICE_OBJECT *device, void* context)
1041 {
1042 return !compare_platform_device(device, context);
1043 }
1044
1045 static int parse_uevent_info(const char *uevent, DWORD *vendor_id,
1046 DWORD *product_id, WCHAR **serial_number)
1047 {
1048 DWORD bus_type;
1049 char *tmp = strdup(uevent);
1050 char *saveptr = NULL;
1051 char *line;
1052 char *key;
1053 char *value;
1054
1055 int found_id = 0;
1056 int found_serial = 0;
1057
1058 line = strtok_r(tmp, "\n", &saveptr);
1059 while (line != NULL)
1060 {
1061 /* line: "KEY=value" */
1062 key = line;
1063 value = strchr(line, '=');
1064 if (!value)
1065 {
1066 goto next_line;
1067 }
1068 *value = '\0';
1069 value++;
1070
1071 if (strcmp(key, "HID_ID") == 0)
1072 {
1073 /**
1074 * type vendor product
1075 * HID_ID=0003:000005AC:00008242
1076 **/
1077 int ret = sscanf(value, "%x:%x:%x", &bus_type, vendor_id, product_id);
1078 if (ret == 3)
1079 found_id = 1;
1080 }
1081 else if (strcmp(key, "HID_UNIQ") == 0)
1082 {
1083 /* The caller has to free the serial number */
1084 if (strlen(value))
1085 {
1086 *serial_number = (WCHAR*)strdupAtoW(value);
1087 found_serial = 1;
1088 }
1089 }
1090
1091 next_line:
1092 line = strtok_r(NULL, "\n", &saveptr);
1093 }
1094
1095 free(tmp);
1096 return (found_id && found_serial);
1097 }
1098
1099 static void try_add_device(struct udev_device *dev)
1100 {
1101 DWORD vid = 0, pid = 0, version = 0;
1102 struct udev_device *hiddev = NULL;
1103 DEVICE_OBJECT *device = NULL;
1104 const char *subsystem;
1105 const char *devnode;
1106 WCHAR *serial = NULL;
1107 BOOL is_gamepad = FALSE;
1108 int fd;
1109 static const CHAR *base_serial = "0000";
1110
1111 if (!(devnode = udev_device_get_devnode(dev)))
1112 return;
1113
1114 if ((fd = open(devnode, O_RDWR)) == -1)
1115 {
1116 WARN("Unable to open udev device %s: %s\n", debugstr_a(devnode), strerror(errno));
1117 return;
1118 }
1119
1120 subsystem = udev_device_get_subsystem(dev);
1121 hiddev = udev_device_get_parent_with_subsystem_devtype(dev, "hid", NULL);
1122 if (hiddev)
1123 {
1124 #ifdef HAS_PROPER_INPUT_HEADER
1125 const platform_vtbl *other_vtbl = NULL;
1126 DEVICE_OBJECT *dup = NULL;
1127 if (strcmp(subsystem, "hidraw") == 0)
1128 other_vtbl = &lnxev_vtbl;
1129 else if (strcmp(subsystem, "input") == 0)
1130 other_vtbl = &hidraw_vtbl;
1131
1132 if (other_vtbl)
1133 dup = bus_enumerate_hid_devices(other_vtbl, check_same_device, dev);
1134 if (dup)
1135 {
1136 TRACE("Duplicate cross bus device (%p) found, not adding the new one\n", dup);
1137 close(fd);
1138 return;
1139 }
1140 #endif
1141 parse_uevent_info(udev_device_get_sysattr_value(hiddev, "uevent"),
1142 &vid, &pid, &serial);
1143 if (serial == NULL)
1144 serial = strdupAtoW(base_serial);
1145 }
1146 #ifdef HAS_PROPER_INPUT_HEADER
1147 else
1148 {
1149 struct input_id device_id = {0};
1150 char device_uid[255];
1151
1152 if (ioctl(fd, EVIOCGID, &device_id) < 0)
1153 WARN("ioctl(EVIOCGID) failed: %d %s\n", errno, strerror(errno));
1154 device_uid[0] = 0;
1155 if (ioctl(fd, EVIOCGUNIQ(254), device_uid) >= 0 && device_uid[0])
1156 serial = strdupAtoW(device_uid);
1157
1158 vid = device_id.vendor;
1159 pid = device_id.product;
1160 version = device_id.version;
1161 }
1162 #else
1163 else
1164 WARN("Could not get device to query VID, PID, Version and Serial\n");
1165 #endif
1166
1167 if (is_xbox_gamepad(vid, pid))
1168 is_gamepad = TRUE;
1169 #ifdef HAS_PROPER_INPUT_HEADER
1170 else
1171 {
1172 int axes=0, buttons=0;
1173 axes = count_abs_axis(fd);
1174 buttons = count_buttons(fd, NULL);
1175 is_gamepad = (axes == 6 && buttons >= 14);
1176 }
1177 #endif
1178
1179
1180 TRACE("Found udev device %s (vid %04x, pid %04x, version %u, serial %s)\n",
1181 debugstr_a(devnode), vid, pid, version, debugstr_w(serial));
1182
1183 if (strcmp(subsystem, "hidraw") == 0)
1184 {
1185 device = bus_create_hid_device(udev_driver_obj, hidraw_busidW, vid, pid, version, 0, serial, is_gamepad,
1186 &GUID_DEVCLASS_HIDRAW, &hidraw_vtbl, sizeof(struct platform_private));
1187 }
1188 #ifdef HAS_PROPER_INPUT_HEADER
1189 else if (strcmp(subsystem, "input") == 0)
1190 {
1191 device = bus_create_hid_device(udev_driver_obj, lnxev_busidW, vid, pid, version, 0, serial, is_gamepad,
1192 &GUID_DEVCLASS_LINUXEVENT, &lnxev_vtbl, sizeof(struct wine_input_private));
1193 }
1194 #endif
1195
1196 if (device)
1197 {
1198 struct platform_private *private = impl_from_DEVICE_OBJECT(device);
1199 private->udev_device = udev_device_ref(dev);
1200 private->device_fd = fd;
1201 #ifdef HAS_PROPER_INPUT_HEADER
1202 if (strcmp(subsystem, "input") == 0)
1203 if (!build_report_descriptor((struct wine_input_private*)private, dev))
1204 {
1205 ERR("Building report descriptor failed, removing device\n");
1206 close(fd);
1207 udev_device_unref(dev);
1208 bus_remove_hid_device(device);
1209 HeapFree(GetProcessHeap(), 0, serial);
1210 return;
1211 }
1212 #endif
1213 IoInvalidateDeviceRelations(device, BusRelations);
1214 }
1215 else
1216 {
1217 WARN("Ignoring device %s with subsystem %s\n", debugstr_a(devnode), subsystem);
1218 close(fd);
1219 }
1220
1221 HeapFree(GetProcessHeap(), 0, serial);
1222 }
1223
1224 static void try_remove_device(struct udev_device *dev)
1225 {
1226 DEVICE_OBJECT *device = NULL;
1227 struct platform_private* private;
1228 #ifdef HAS_PROPER_INPUT_HEADER
1229 BOOL is_input = FALSE;
1230 #endif
1231
1232 device = bus_find_hid_device(&hidraw_vtbl, dev);
1233 #ifdef HAS_PROPER_INPUT_HEADER
1234 if (device == NULL)
1235 {
1236 device = bus_find_hid_device(&lnxev_vtbl, dev);
1237 is_input = TRUE;
1238 }
1239 #endif
1240 if (!device) return;
1241
1242 IoInvalidateDeviceRelations(device, RemovalRelations);
1243
1244 private = impl_from_DEVICE_OBJECT(device);
1245
1246 if (private->report_thread)
1247 {
1248 write(private->control_pipe[1], "q", 1);
1249 WaitForSingleObject(private->report_thread, INFINITE);
1250 close(private->control_pipe[0]);
1251 close(private->control_pipe[1]);
1252 CloseHandle(private->report_thread);
1253 #ifdef HAS_PROPER_INPUT_HEADER
1254 if (strcmp(udev_device_get_subsystem(dev), "input") == 0)
1255 {
1256 HeapFree(GetProcessHeap(), 0, ((struct wine_input_private*)private)->current_report_buffer);
1257 HeapFree(GetProcessHeap(), 0, ((struct wine_input_private*)private)->last_report_buffer);
1258 }
1259 #endif
1260 }
1261
1262 #ifdef HAS_PROPER_INPUT_HEADER
1263 if (is_input)
1264 {
1265 struct wine_input_private *ext = (struct wine_input_private*)private;
1266 HeapFree(GetProcessHeap(), 0, ext->report_descriptor);
1267 }
1268 #endif
1269
1270 dev = private->udev_device;
1271 close(private->device_fd);
1272 bus_remove_hid_device(device);
1273 udev_device_unref(dev);
1274 }
1275
1276 static void build_initial_deviceset(void)
1277 {
1278 struct udev_enumerate *enumerate;
1279 struct udev_list_entry *devices, *dev_list_entry;
1280
1281 enumerate = udev_enumerate_new(udev_context);
1282 if (!enumerate)
1283 {
1284 WARN("Unable to create udev enumeration object\n");
1285 return;
1286 }
1287
1288 if (!disable_hidraw)
1289 if (udev_enumerate_add_match_subsystem(enumerate, "hidraw") < 0)
1290 WARN("Failed to add subsystem 'hidraw' to enumeration\n");
1291 #ifdef HAS_PROPER_INPUT_HEADER
1292 if (!disable_input)
1293 {
1294 if (udev_enumerate_add_match_subsystem(enumerate, "input") < 0)
1295 WARN("Failed to add subsystem 'input' to enumeration\n");
1296 }
1297 #endif
1298
1299 if (udev_enumerate_scan_devices(enumerate) < 0)
1300 WARN("Enumeration scan failed\n");
1301
1302 devices = udev_enumerate_get_list_entry(enumerate);
1303 udev_list_entry_foreach(dev_list_entry, devices)
1304 {
1305 struct udev_device *dev;
1306 const char *path;
1307
1308 path = udev_list_entry_get_name(dev_list_entry);
1309 if ((dev = udev_device_new_from_syspath(udev_context, path)))
1310 {
1311 try_add_device(dev);
1312 udev_device_unref(dev);
1313 }
1314 }
1315
1316 udev_enumerate_unref(enumerate);
1317 }
1318
1319 static struct udev_monitor *create_monitor(struct pollfd *pfd)
1320 {
1321 struct udev_monitor *monitor;
1322 int systems = 0;
1323
1324 monitor = udev_monitor_new_from_netlink(udev_context, "udev");
1325 if (!monitor)
1326 {
1327 WARN("Unable to get udev monitor object\n");
1328 return NULL;
1329 }
1330
1331 if (!disable_hidraw)
1332 {
1333 if (udev_monitor_filter_add_match_subsystem_devtype(monitor, "hidraw", NULL) < 0)
1334 WARN("Failed to add 'hidraw' subsystem to monitor\n");
1335 else
1336 systems++;
1337 }
1338 #ifdef HAS_PROPER_INPUT_HEADER
1339 if (!disable_input)
1340 {
1341 if (udev_monitor_filter_add_match_subsystem_devtype(monitor, "input", NULL) < 0)
1342 WARN("Failed to add 'input' subsystem to monitor\n");
1343 else
1344 systems++;
1345 }
1346 #endif
1347 if (systems == 0)
1348 {
1349 WARN("No subsystems added to monitor\n");
1350 goto error;
1351 }
1352
1353 if (udev_monitor_enable_receiving(monitor) < 0)
1354 goto error;
1355
1356 if ((pfd->fd = udev_monitor_get_fd(monitor)) >= 0)
1357 {
1358 pfd->events = POLLIN;
1359 return monitor;
1360 }
1361
1362 error:
1363 WARN("Failed to start monitoring\n");
1364 udev_monitor_unref(monitor);
1365 return NULL;
1366 }
1367
1368 static void process_monitor_event(struct udev_monitor *monitor)
1369 {
1370 struct udev_device *dev;
1371 const char *action;
1372
1373 dev = udev_monitor_receive_device(monitor);
1374 if (!dev)
1375 {
1376 FIXME("Failed to get device that has changed\n");
1377 return;
1378 }
1379
1380 action = udev_device_get_action(dev);
1381 TRACE("Received action %s for udev device %s\n", debugstr_a(action),
1382 debugstr_a(udev_device_get_devnode(dev)));
1383
1384 if (!action)
1385 WARN("No action received\n");
1386 else if (strcmp(action, "add") == 0)
1387 try_add_device(dev);
1388 else if (strcmp(action, "remove") == 0)
1389 try_remove_device(dev);
1390 else
1391 WARN("Unhandled action %s\n", debugstr_a(action));
1392
1393 udev_device_unref(dev);
1394 }
1395
1396 static DWORD CALLBACK deviceloop_thread(void *args)
1397 {
1398 struct udev_monitor *monitor;
1399 HANDLE init_done = args;
1400 struct pollfd pfd;
1401
1402 monitor = create_monitor(&pfd);
1403 build_initial_deviceset();
1404 SetEvent(init_done);
1405
1406 while (monitor)
1407 {
1408 if (poll(&pfd, 1, -1) <= 0) continue;
1409 process_monitor_event(monitor);
1410 }
1411
1412 TRACE("Monitor thread exiting\n");
1413 if (monitor)
1414 udev_monitor_unref(monitor);
1415 return 0;
1416 }
1417
1418 NTSTATUS WINAPI udev_driver_init(DRIVER_OBJECT *driver, UNICODE_STRING *registry_path)
1419 {
1420 HANDLE events[2];
1421 DWORD result;
1422 static const WCHAR hidraw_disabledW[] = {'D','i','s','a','b','l','e','H','i','d','r','a','w',0};
1423 static const UNICODE_STRING hidraw_disabled = {sizeof(hidraw_disabledW) - sizeof(WCHAR), sizeof(hidraw_disabledW), (WCHAR*)hidraw_disabledW};
1424 static const WCHAR input_disabledW[] = {'D','i','s','a','b','l','e','I','n','p','u','t',0};
1425 static const UNICODE_STRING input_disabled = {sizeof(input_disabledW) - sizeof(WCHAR), sizeof(input_disabledW), (WCHAR*)input_disabledW};
1426
1427 TRACE("(%p, %s)\n", driver, debugstr_w(registry_path->Buffer));
1428
1429 if (!(udev_context = udev_new()))
1430 {
1431 ERR("Can't create udev object\n");
1432 return STATUS_UNSUCCESSFUL;
1433 }
1434
1435 udev_driver_obj = driver;
1436 driver->MajorFunction[IRP_MJ_PNP] = common_pnp_dispatch;
1437 driver->MajorFunction[IRP_MJ_INTERNAL_DEVICE_CONTROL] = hid_internal_dispatch;
1438
1439 disable_hidraw = check_bus_option(registry_path, &hidraw_disabled, 0);
1440 if (disable_hidraw)
1441 TRACE("UDEV hidraw devices disabled in registry\n");
1442
1443 #ifdef HAS_PROPER_INPUT_HEADER
1444 disable_input = check_bus_option(registry_path, &input_disabled, 0);
1445 if (disable_input)
1446 TRACE("UDEV input devices disabled in registry\n");
1447 #endif
1448
1449 if (!(events[0] = CreateEventW(NULL, TRUE, FALSE, NULL)))
1450 goto error;
1451 if (!(events[1] = CreateThread(NULL, 0, deviceloop_thread, events[0], 0, NULL)))
1452 {
1453 CloseHandle(events[0]);
1454 goto error;
1455 }
1456
1457 result = WaitForMultipleObjects(2, events, FALSE, INFINITE);
1458 CloseHandle(events[0]);
1459 CloseHandle(events[1]);
1460 if (result == WAIT_OBJECT_0)
1461 {
1462 TRACE("Initialization successful\n");
1463 return STATUS_SUCCESS;
1464 }
1465
1466 error:
1467 ERR("Failed to initialize udev device thread\n");
1468 udev_unref(udev_context);
1469 udev_context = NULL;
1470 udev_driver_obj = NULL;
1471 return STATUS_UNSUCCESSFUL;
1472 }
1473
1474 #else
1475
1476 NTSTATUS WINAPI udev_driver_init(DRIVER_OBJECT *driver, UNICODE_STRING *registry_path)
1477 {
1478 WARN("Wine was compiled without UDEV support\n");
1479 return STATUS_NOT_IMPLEMENTED;
1480 }
1481
1482 #endif /* HAVE_UDEV */
Windows API implementation