]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/input/tablet/wacom_sys.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:


72b1724ac7d0a6291c0bae06c056207b98956758
[mirror_ubuntu-artful-kernel.git] / drivers / input / tablet / wacom_sys.c
1 /*
2 * drivers/input/tablet/wacom_sys.c
3 *
4 * USB Wacom tablet support - system specific code
5 */
6
7 /*
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 */
13
14 #include "wacom_wac.h"
15 #include "wacom.h"
16
17 /* defines to get HID report descriptor */
18 #define HID_DEVICET_HID (USB_TYPE_CLASS | 0x01)
19 #define HID_DEVICET_REPORT (USB_TYPE_CLASS | 0x02)
20 #define HID_USAGE_UNDEFINED 0x00
21 #define HID_USAGE_PAGE 0x05
22 #define HID_USAGE_PAGE_DIGITIZER 0x0d
23 #define HID_USAGE_PAGE_DESKTOP 0x01
24 #define HID_USAGE 0x09
25 #define HID_USAGE_X ((HID_USAGE_PAGE_DESKTOP << 16) | 0x30)
26 #define HID_USAGE_Y ((HID_USAGE_PAGE_DESKTOP << 16) | 0x31)
27 #define HID_USAGE_PRESSURE ((HID_USAGE_PAGE_DIGITIZER << 16) | 0x30)
28 #define HID_USAGE_X_TILT ((HID_USAGE_PAGE_DIGITIZER << 16) | 0x3d)
29 #define HID_USAGE_Y_TILT ((HID_USAGE_PAGE_DIGITIZER << 16) | 0x3e)
30 #define HID_USAGE_FINGER ((HID_USAGE_PAGE_DIGITIZER << 16) | 0x22)
31 #define HID_USAGE_STYLUS ((HID_USAGE_PAGE_DIGITIZER << 16) | 0x20)
32 #define HID_USAGE_CONTACTMAX ((HID_USAGE_PAGE_DIGITIZER << 16) | 0x55)
33 #define HID_COLLECTION 0xa1
34 #define HID_COLLECTION_LOGICAL 0x02
35 #define HID_COLLECTION_END 0xc0
36
37 struct hid_descriptor {
38 struct usb_descriptor_header header;
39 __le16 bcdHID;
40 u8 bCountryCode;
41 u8 bNumDescriptors;
42 u8 bDescriptorType;
43 __le16 wDescriptorLength;
44 } __attribute__ ((packed));
45
46 /* defines to get/set USB message */
47 #define USB_REQ_GET_REPORT 0x01
48 #define USB_REQ_SET_REPORT 0x09
49
50 #define WAC_HID_FEATURE_REPORT 0x03
51 #define WAC_MSG_RETRIES 5
52
53 #define WAC_CMD_LED_CONTROL 0x20
54 #define WAC_CMD_ICON_START 0x21
55 #define WAC_CMD_ICON_XFER 0x23
56 #define WAC_CMD_RETRIES 10
57
58 static int wacom_get_report(struct usb_interface *intf, u8 type, u8 id,
59 void *buf, size_t size, unsigned int retries)
60 {
61 struct usb_device *dev = interface_to_usbdev(intf);
62 int retval;
63
64 do {
65 retval = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
66 USB_REQ_GET_REPORT,
67 USB_DIR_IN | USB_TYPE_CLASS |
68 USB_RECIP_INTERFACE,
69 (type << 8) + id,
70 intf->altsetting[0].desc.bInterfaceNumber,
71 buf, size, 100);
72 } while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);
73
74 return retval;
75 }
76
77 static int wacom_set_report(struct usb_interface *intf, u8 type, u8 id,
78 void *buf, size_t size, unsigned int retries)
79 {
80 struct usb_device *dev = interface_to_usbdev(intf);
81 int retval;
82
83 do {
84 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
85 USB_REQ_SET_REPORT,
86 USB_TYPE_CLASS | USB_RECIP_INTERFACE,
87 (type << 8) + id,
88 intf->altsetting[0].desc.bInterfaceNumber,
89 buf, size, 1000);
90 } while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);
91
92 return retval;
93 }
94
95 static void wacom_sys_irq(struct urb *urb)
96 {
97 struct wacom *wacom = urb->context;
98 struct device *dev = &wacom->intf->dev;
99 int retval;
100
101 switch (urb->status) {
102 case 0:
103 /* success */
104 break;
105 case -ECONNRESET:
106 case -ENOENT:
107 case -ESHUTDOWN:
108 /* this urb is terminated, clean up */
109 dev_dbg(dev, "%s - urb shutting down with status: %d\n",
110 __func__, urb->status);
111 return;
112 default:
113 dev_dbg(dev, "%s - nonzero urb status received: %d\n",
114 __func__, urb->status);
115 goto exit;
116 }
117
118 wacom_wac_irq(&wacom->wacom_wac, urb->actual_length);
119
120 exit:
121 usb_mark_last_busy(wacom->usbdev);
122 retval = usb_submit_urb(urb, GFP_ATOMIC);
123 if (retval)
124 dev_err(dev, "%s - usb_submit_urb failed with result %d\n",
125 __func__, retval);
126 }
127
128 static int wacom_open(struct input_dev *dev)
129 {
130 struct wacom *wacom = input_get_drvdata(dev);
131 int retval = 0;
132
133 if (usb_autopm_get_interface(wacom->intf) < 0)
134 return -EIO;
135
136 mutex_lock(&wacom->lock);
137
138 if (usb_submit_urb(wacom->irq, GFP_KERNEL)) {
139 retval = -EIO;
140 goto out;
141 }
142
143 wacom->open = true;
144 wacom->intf->needs_remote_wakeup = 1;
145
146 out:
147 mutex_unlock(&wacom->lock);
148 usb_autopm_put_interface(wacom->intf);
149 return retval;
150 }
151
152 static void wacom_close(struct input_dev *dev)
153 {
154 struct wacom *wacom = input_get_drvdata(dev);
155 int autopm_error;
156
157 autopm_error = usb_autopm_get_interface(wacom->intf);
158
159 mutex_lock(&wacom->lock);
160 usb_kill_urb(wacom->irq);
161 wacom->open = false;
162 wacom->intf->needs_remote_wakeup = 0;
163 mutex_unlock(&wacom->lock);
164
165 if (!autopm_error)
166 usb_autopm_put_interface(wacom->intf);
167 }
168
169 /*
170 * Calculate the resolution of the X or Y axis, given appropriate HID data.
171 * This function is little more than hidinput_calc_abs_res stripped down.
172 */
173 static int wacom_calc_hid_res(int logical_extents, int physical_extents,
174 unsigned char unit, unsigned char exponent)
175 {
176 int prev, unit_exponent;
177
178 /* Check if the extents are sane */
179 if (logical_extents <= 0 || physical_extents <= 0)
180 return 0;
181
182 /* Get signed value of nybble-sized twos-compliment exponent */
183 unit_exponent = exponent;
184 if (unit_exponent > 7)
185 unit_exponent -= 16;
186
187 /* Convert physical_extents to millimeters */
188 if (unit == 0x11) { /* If centimeters */
189 unit_exponent += 1;
190 } else if (unit == 0x13) { /* If inches */
191 prev = physical_extents;
192 physical_extents *= 254;
193 if (physical_extents < prev)
194 return 0;
195 unit_exponent -= 1;
196 } else {
197 return 0;
198 }
199
200 /* Apply negative unit exponent */
201 for (; unit_exponent < 0; unit_exponent++) {
202 prev = logical_extents;
203 logical_extents *= 10;
204 if (logical_extents < prev)
205 return 0;
206 }
207 /* Apply positive unit exponent */
208 for (; unit_exponent > 0; unit_exponent--) {
209 prev = physical_extents;
210 physical_extents *= 10;
211 if (physical_extents < prev)
212 return 0;
213 }
214
215 /* Calculate resolution */
216 return logical_extents / physical_extents;
217 }
218
219 static int wacom_parse_logical_collection(unsigned char *report,
220 struct wacom_features *features)
221 {
222 int length = 0;
223
224 if (features->type == BAMBOO_PT) {
225
226 /* Logical collection is only used by 3rd gen Bamboo Touch */
227 features->pktlen = WACOM_PKGLEN_BBTOUCH3;
228 features->device_type = BTN_TOOL_FINGER;
229
230 features->x_max = features->y_max =
231 get_unaligned_le16(&report[10]);
232
233 length = 11;
234 }
235 return length;
236 }
237
238 static void wacom_retrieve_report_data(struct usb_interface *intf,
239 struct wacom_features *features)
240 {
241 int result = 0;
242 unsigned char *rep_data;
243
244 rep_data = kmalloc(2, GFP_KERNEL);
245 if (rep_data) {
246
247 rep_data[0] = 12;
248 result = wacom_get_report(intf, WAC_HID_FEATURE_REPORT,
249 rep_data[0], rep_data, 2,
250 WAC_MSG_RETRIES);
251
252 if (result >= 0 && rep_data[1] > 2)
253 features->touch_max = rep_data[1];
254
255 kfree(rep_data);
256 }
257 }
258
259 /*
260 * Interface Descriptor of wacom devices can be incomplete and
261 * inconsistent so wacom_features table is used to store stylus
262 * device's packet lengths, various maximum values, and tablet
263 * resolution based on product ID's.
264 *
265 * For devices that contain 2 interfaces, wacom_features table is
266 * inaccurate for the touch interface. Since the Interface Descriptor
267 * for touch interfaces has pretty complete data, this function exists
268 * to query tablet for this missing information instead of hard coding in
269 * an additional table.
270 *
271 * A typical Interface Descriptor for a stylus will contain a
272 * boot mouse application collection that is not of interest and this
273 * function will ignore it.
274 *
275 * It also contains a digitizer application collection that also is not
276 * of interest since any information it contains would be duplicate
277 * of what is in wacom_features. Usually it defines a report of an array
278 * of bytes that could be used as max length of the stylus packet returned.
279 * If it happens to define a Digitizer-Stylus Physical Collection then
280 * the X and Y logical values contain valid data but it is ignored.
281 *
282 * A typical Interface Descriptor for a touch interface will contain a
283 * Digitizer-Finger Physical Collection which will define both logical
284 * X/Y maximum as well as the physical size of tablet. Since touch
285 * interfaces haven't supported pressure or distance, this is enough
286 * information to override invalid values in the wacom_features table.
287 *
288 * 3rd gen Bamboo Touch no longer define a Digitizer-Finger Pysical
289 * Collection. Instead they define a Logical Collection with a single
290 * Logical Maximum for both X and Y.
291 *
292 * Intuos5 touch interface does not contain useful data. We deal with
293 * this after returning from this function.
294 */
295 static int wacom_parse_hid(struct usb_interface *intf,
296 struct hid_descriptor *hid_desc,
297 struct wacom_features *features)
298 {
299 struct usb_device *dev = interface_to_usbdev(intf);
300 char limit = 0;
301 /* result has to be defined as int for some devices */
302 int result = 0, touch_max = 0;
303 int i = 0, page = 0, finger = 0, pen = 0;
304 unsigned char *report;
305
306 report = kzalloc(hid_desc->wDescriptorLength, GFP_KERNEL);
307 if (!report)
308 return -ENOMEM;
309
310 /* retrive report descriptors */
311 do {
312 result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
313 USB_REQ_GET_DESCRIPTOR,
314 USB_RECIP_INTERFACE | USB_DIR_IN,
315 HID_DEVICET_REPORT << 8,
316 intf->altsetting[0].desc.bInterfaceNumber, /* interface */
317 report,
318 hid_desc->wDescriptorLength,
319 5000); /* 5 secs */
320 } while (result < 0 && limit++ < WAC_MSG_RETRIES);
321
322 /* No need to parse the Descriptor. It isn't an error though */
323 if (result < 0)
324 goto out;
325
326 for (i = 0; i < hid_desc->wDescriptorLength; i++) {
327
328 switch (report[i]) {
329 case HID_USAGE_PAGE:
330 page = report[i + 1];
331 i++;
332 break;
333
334 case HID_USAGE:
335 switch (page << 16 | report[i + 1]) {
336 case HID_USAGE_X:
337 if (finger) {
338 features->device_type = BTN_TOOL_FINGER;
339 /* touch device at least supports one touch point */
340 touch_max = 1;
341 switch (features->type) {
342 case TABLETPC2FG:
343 features->pktlen = WACOM_PKGLEN_TPC2FG;
344 break;
345
346 case MTSCREEN:
347 case WACOM_24HDT:
348 features->pktlen = WACOM_PKGLEN_MTOUCH;
349 break;
350
351 case MTTPC:
352 case MTTPC_B:
353 features->pktlen = WACOM_PKGLEN_MTTPC;
354 break;
355
356 case BAMBOO_PT:
357 features->pktlen = WACOM_PKGLEN_BBTOUCH;
358 break;
359
360 default:
361 features->pktlen = WACOM_PKGLEN_GRAPHIRE;
362 break;
363 }
364
365 switch (features->type) {
366 case BAMBOO_PT:
367 features->x_phy =
368 get_unaligned_le16(&report[i + 5]);
369 features->x_max =
370 get_unaligned_le16(&report[i + 8]);
371 i += 15;
372 break;
373
374 case WACOM_24HDT:
375 features->x_max =
376 get_unaligned_le16(&report[i + 3]);
377 features->x_phy =
378 get_unaligned_le16(&report[i + 8]);
379 features->unit = report[i - 1];
380 features->unitExpo = report[i - 3];
381 i += 12;
382 break;
383
384 case MTTPC_B:
385 features->x_max =
386 get_unaligned_le16(&report[i + 3]);
387 features->x_phy =
388 get_unaligned_le16(&report[i + 6]);
389 features->unit = report[i - 5];
390 features->unitExpo = report[i - 3];
391 i += 9;
392 break;
393
394 default:
395 features->x_max =
396 get_unaligned_le16(&report[i + 3]);
397 features->x_phy =
398 get_unaligned_le16(&report[i + 6]);
399 features->unit = report[i + 9];
400 features->unitExpo = report[i + 11];
401 i += 12;
402 break;
403 }
404 } else if (pen) {
405 /* penabled only accepts exact bytes of data */
406 if (features->type >= TABLETPC)
407 features->pktlen = WACOM_PKGLEN_GRAPHIRE;
408 features->device_type = BTN_TOOL_PEN;
409 features->x_max =
410 get_unaligned_le16(&report[i + 3]);
411 i += 4;
412 }
413 break;
414
415 case HID_USAGE_Y:
416 if (finger) {
417 switch (features->type) {
418 case TABLETPC2FG:
419 case MTSCREEN:
420 case MTTPC:
421 features->y_max =
422 get_unaligned_le16(&report[i + 3]);
423 features->y_phy =
424 get_unaligned_le16(&report[i + 6]);
425 i += 7;
426 break;
427
428 case WACOM_24HDT:
429 features->y_max =
430 get_unaligned_le16(&report[i + 3]);
431 features->y_phy =
432 get_unaligned_le16(&report[i - 2]);
433 i += 7;
434 break;
435
436 case BAMBOO_PT:
437 features->y_phy =
438 get_unaligned_le16(&report[i + 3]);
439 features->y_max =
440 get_unaligned_le16(&report[i + 6]);
441 i += 12;
442 break;
443
444 case MTTPC_B:
445 features->y_max =
446 get_unaligned_le16(&report[i + 3]);
447 features->y_phy =
448 get_unaligned_le16(&report[i + 6]);
449 i += 9;
450 break;
451
452 default:
453 features->y_max =
454 features->x_max;
455 features->y_phy =
456 get_unaligned_le16(&report[i + 3]);
457 i += 4;
458 break;
459 }
460 } else if (pen) {
461 features->y_max =
462 get_unaligned_le16(&report[i + 3]);
463 i += 4;
464 }
465 break;
466
467 case HID_USAGE_FINGER:
468 finger = 1;
469 i++;
470 break;
471
472 /*
473 * Requiring Stylus Usage will ignore boot mouse
474 * X/Y values and some cases of invalid Digitizer X/Y
475 * values commonly reported.
476 */
477 case HID_USAGE_STYLUS:
478 pen = 1;
479 i++;
480 break;
481
482 case HID_USAGE_CONTACTMAX:
483 /* leave touch_max as is if predefined */
484 if (!features->touch_max)
485 wacom_retrieve_report_data(intf, features);
486 i++;
487 break;
488
489 case HID_USAGE_PRESSURE:
490 if (pen) {
491 features->pressure_max =
492 get_unaligned_le16(&report[i + 3]);
493 i += 4;
494 }
495 break;
496 }
497 break;
498
499 case HID_COLLECTION_END:
500 /* reset UsagePage and Finger */
501 finger = page = 0;
502 break;
503
504 case HID_COLLECTION:
505 i++;
506 switch (report[i]) {
507 case HID_COLLECTION_LOGICAL:
508 i += wacom_parse_logical_collection(&report[i],
509 features);
510 break;
511 }
512 break;
513 }
514 }
515
516 out:
517 if (!features->touch_max && touch_max)
518 features->touch_max = touch_max;
519 result = 0;
520 kfree(report);
521 return result;
522 }
523
524 static int wacom_set_device_mode(struct usb_interface *intf, int report_id, int length, int mode)
525 {
526 unsigned char *rep_data;
527 int error = -ENOMEM, limit = 0;
528
529 rep_data = kzalloc(length, GFP_KERNEL);
530 if (!rep_data)
531 return error;
532
533 do {
534 rep_data[0] = report_id;
535 rep_data[1] = mode;
536
537 error = wacom_set_report(intf, WAC_HID_FEATURE_REPORT,
538 report_id, rep_data, length, 1);
539 if (error >= 0)
540 error = wacom_get_report(intf, WAC_HID_FEATURE_REPORT,
541 report_id, rep_data, length, 1);
542 } while ((error < 0 || rep_data[1] != mode) && limit++ < WAC_MSG_RETRIES);
543
544 kfree(rep_data);
545
546 return error < 0 ? error : 0;
547 }
548
549 /*
550 * Switch the tablet into its most-capable mode. Wacom tablets are
551 * typically configured to power-up in a mode which sends mouse-like
552 * reports to the OS. To get absolute position, pressure data, etc.
553 * from the tablet, it is necessary to switch the tablet out of this
554 * mode and into one which sends the full range of tablet data.
555 */
556 static int wacom_query_tablet_data(struct usb_interface *intf, struct wacom_features *features)
557 {
558 if (features->device_type == BTN_TOOL_FINGER) {
559 if (features->type > TABLETPC) {
560 /* MT Tablet PC touch */
561 return wacom_set_device_mode(intf, 3, 4, 4);
562 }
563 else if (features->type == WACOM_24HDT || features->type == CINTIQ_HYBRID) {
564 return wacom_set_device_mode(intf, 18, 3, 2);
565 }
566 } else if (features->device_type == BTN_TOOL_PEN) {
567 if (features->type <= BAMBOO_PT && features->type != WIRELESS) {
568 return wacom_set_device_mode(intf, 2, 2, 2);
569 }
570 }
571
572 return 0;
573 }
574
575 static int wacom_retrieve_hid_descriptor(struct usb_interface *intf,
576 struct wacom_features *features)
577 {
578 int error = 0;
579 struct usb_host_interface *interface = intf->cur_altsetting;
580 struct hid_descriptor *hid_desc;
581
582 /* default features */
583 features->device_type = BTN_TOOL_PEN;
584 features->x_fuzz = 4;
585 features->y_fuzz = 4;
586 features->pressure_fuzz = 0;
587 features->distance_fuzz = 0;
588
589 /*
590 * The wireless device HID is basic and layout conflicts with
591 * other tablets (monitor and touch interface can look like pen).
592 * Skip the query for this type and modify defaults based on
593 * interface number.
594 */
595 if (features->type == WIRELESS) {
596 if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
597 features->device_type = 0;
598 } else if (intf->cur_altsetting->desc.bInterfaceNumber == 2) {
599 features->device_type = BTN_TOOL_FINGER;
600 features->pktlen = WACOM_PKGLEN_BBTOUCH3;
601 }
602 }
603
604 /* only devices that support touch need to retrieve the info */
605 if (features->type < BAMBOO_PT) {
606 goto out;
607 }
608
609 error = usb_get_extra_descriptor(interface, HID_DEVICET_HID, &hid_desc);
610 if (error) {
611 error = usb_get_extra_descriptor(&interface->endpoint[0],
612 HID_DEVICET_REPORT, &hid_desc);
613 if (error) {
614 dev_err(&intf->dev,
615 "can not retrieve extra class descriptor\n");
616 goto out;
617 }
618 }
619 error = wacom_parse_hid(intf, hid_desc, features);
620
621 out:
622 return error;
623 }
624
625 struct wacom_usbdev_data {
626 struct list_head list;
627 struct kref kref;
628 struct usb_device *dev;
629 struct wacom_shared shared;
630 };
631
632 static LIST_HEAD(wacom_udev_list);
633 static DEFINE_MUTEX(wacom_udev_list_lock);
634
635 static struct usb_device *wacom_get_sibling(struct usb_device *dev, int vendor, int product)
636 {
637 int port1;
638 struct usb_device *sibling;
639
640 if (vendor == 0 && product == 0)
641 return dev;
642
643 if (dev->parent == NULL)
644 return NULL;
645
646 usb_hub_for_each_child(dev->parent, port1, sibling) {
647 struct usb_device_descriptor *d;
648 if (sibling == NULL)
649 continue;
650
651 d = &sibling->descriptor;
652 if (d->idVendor == vendor && d->idProduct == product)
653 return sibling;
654 }
655
656 return NULL;
657 }
658
659 static struct wacom_usbdev_data *wacom_get_usbdev_data(struct usb_device *dev)
660 {
661 struct wacom_usbdev_data *data;
662
663 list_for_each_entry(data, &wacom_udev_list, list) {
664 if (data->dev == dev) {
665 kref_get(&data->kref);
666 return data;
667 }
668 }
669
670 return NULL;
671 }
672
673 static int wacom_add_shared_data(struct wacom_wac *wacom,
674 struct usb_device *dev)
675 {
676 struct wacom_usbdev_data *data;
677 int retval = 0;
678
679 mutex_lock(&wacom_udev_list_lock);
680
681 data = wacom_get_usbdev_data(dev);
682 if (!data) {
683 data = kzalloc(sizeof(struct wacom_usbdev_data), GFP_KERNEL);
684 if (!data) {
685 retval = -ENOMEM;
686 goto out;
687 }
688
689 kref_init(&data->kref);
690 data->dev = dev;
691 list_add_tail(&data->list, &wacom_udev_list);
692 }
693
694 wacom->shared = &data->shared;
695
696 out:
697 mutex_unlock(&wacom_udev_list_lock);
698 return retval;
699 }
700
701 static void wacom_release_shared_data(struct kref *kref)
702 {
703 struct wacom_usbdev_data *data =
704 container_of(kref, struct wacom_usbdev_data, kref);
705
706 mutex_lock(&wacom_udev_list_lock);
707 list_del(&data->list);
708 mutex_unlock(&wacom_udev_list_lock);
709
710 kfree(data);
711 }
712
713 static void wacom_remove_shared_data(struct wacom_wac *wacom)
714 {
715 struct wacom_usbdev_data *data;
716
717 if (wacom->shared) {
718 data = container_of(wacom->shared, struct wacom_usbdev_data, shared);
719 kref_put(&data->kref, wacom_release_shared_data);
720 wacom->shared = NULL;
721 }
722 }
723
724 static int wacom_led_control(struct wacom *wacom)
725 {
726 unsigned char *buf;
727 int retval;
728
729 buf = kzalloc(9, GFP_KERNEL);
730 if (!buf)
731 return -ENOMEM;
732
733 if (wacom->wacom_wac.features.type >= INTUOS5S &&
734 wacom->wacom_wac.features.type <= INTUOSPL) {
735 /*
736 * Touch Ring and crop mark LED luminance may take on
737 * one of four values:
738 * 0 = Low; 1 = Medium; 2 = High; 3 = Off
739 */
740 int ring_led = wacom->led.select[0] & 0x03;
741 int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
742 int crop_lum = 0;
743
744 buf[0] = WAC_CMD_LED_CONTROL;
745 buf[1] = (crop_lum << 4) | (ring_lum << 2) | (ring_led);
746 }
747 else {
748 int led = wacom->led.select[0] | 0x4;
749
750 if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
751 wacom->wacom_wac.features.type == WACOM_24HD)
752 led |= (wacom->led.select[1] << 4) | 0x40;
753
754 buf[0] = WAC_CMD_LED_CONTROL;
755 buf[1] = led;
756 buf[2] = wacom->led.llv;
757 buf[3] = wacom->led.hlv;
758 buf[4] = wacom->led.img_lum;
759 }
760
761 retval = wacom_set_report(wacom->intf, 0x03, WAC_CMD_LED_CONTROL,
762 buf, 9, WAC_CMD_RETRIES);
763 kfree(buf);
764
765 return retval;
766 }
767
768 static int wacom_led_putimage(struct wacom *wacom, int button_id, const void *img)
769 {
770 unsigned char *buf;
771 int i, retval;
772
773 buf = kzalloc(259, GFP_KERNEL);
774 if (!buf)
775 return -ENOMEM;
776
777 /* Send 'start' command */
778 buf[0] = WAC_CMD_ICON_START;
779 buf[1] = 1;
780 retval = wacom_set_report(wacom->intf, 0x03, WAC_CMD_ICON_START,
781 buf, 2, WAC_CMD_RETRIES);
782 if (retval < 0)
783 goto out;
784
785 buf[0] = WAC_CMD_ICON_XFER;
786 buf[1] = button_id & 0x07;
787 for (i = 0; i < 4; i++) {
788 buf[2] = i;
789 memcpy(buf + 3, img + i * 256, 256);
790
791 retval = wacom_set_report(wacom->intf, 0x03, WAC_CMD_ICON_XFER,
792 buf, 259, WAC_CMD_RETRIES);
793 if (retval < 0)
794 break;
795 }
796
797 /* Send 'stop' */
798 buf[0] = WAC_CMD_ICON_START;
799 buf[1] = 0;
800 wacom_set_report(wacom->intf, 0x03, WAC_CMD_ICON_START,
801 buf, 2, WAC_CMD_RETRIES);
802
803 out:
804 kfree(buf);
805 return retval;
806 }
807
808 static ssize_t wacom_led_select_store(struct device *dev, int set_id,
809 const char *buf, size_t count)
810 {
811 struct wacom *wacom = dev_get_drvdata(dev);
812 unsigned int id;
813 int err;
814
815 err = kstrtouint(buf, 10, &id);
816 if (err)
817 return err;
818
819 mutex_lock(&wacom->lock);
820
821 wacom->led.select[set_id] = id & 0x3;
822 err = wacom_led_control(wacom);
823
824 mutex_unlock(&wacom->lock);
825
826 return err < 0 ? err : count;
827 }
828
829 #define DEVICE_LED_SELECT_ATTR(SET_ID) \
830 static ssize_t wacom_led##SET_ID##_select_store(struct device *dev, \
831 struct device_attribute *attr, const char *buf, size_t count) \
832 { \
833 return wacom_led_select_store(dev, SET_ID, buf, count); \
834 } \
835 static ssize_t wacom_led##SET_ID##_select_show(struct device *dev, \
836 struct device_attribute *attr, char *buf) \
837 { \
838 struct wacom *wacom = dev_get_drvdata(dev); \
839 return snprintf(buf, 2, "%d\n", wacom->led.select[SET_ID]); \
840 } \
841 static DEVICE_ATTR(status_led##SET_ID##_select, S_IWUSR | S_IRUSR, \
842 wacom_led##SET_ID##_select_show, \
843 wacom_led##SET_ID##_select_store)
844
845 DEVICE_LED_SELECT_ATTR(0);
846 DEVICE_LED_SELECT_ATTR(1);
847
848 static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
849 const char *buf, size_t count)
850 {
851 unsigned int value;
852 int err;
853
854 err = kstrtouint(buf, 10, &value);
855 if (err)
856 return err;
857
858 mutex_lock(&wacom->lock);
859
860 *dest = value & 0x7f;
861 err = wacom_led_control(wacom);
862
863 mutex_unlock(&wacom->lock);
864
865 return err < 0 ? err : count;
866 }
867
868 #define DEVICE_LUMINANCE_ATTR(name, field) \
869 static ssize_t wacom_##name##_luminance_store(struct device *dev, \
870 struct device_attribute *attr, const char *buf, size_t count) \
871 { \
872 struct wacom *wacom = dev_get_drvdata(dev); \
873 \
874 return wacom_luminance_store(wacom, &wacom->led.field, \
875 buf, count); \
876 } \
877 static DEVICE_ATTR(name##_luminance, S_IWUSR, \
878 NULL, wacom_##name##_luminance_store)
879
880 DEVICE_LUMINANCE_ATTR(status0, llv);
881 DEVICE_LUMINANCE_ATTR(status1, hlv);
882 DEVICE_LUMINANCE_ATTR(buttons, img_lum);
883
884 static ssize_t wacom_button_image_store(struct device *dev, int button_id,
885 const char *buf, size_t count)
886 {
887 struct wacom *wacom = dev_get_drvdata(dev);
888 int err;
889
890 if (count != 1024)
891 return -EINVAL;
892
893 mutex_lock(&wacom->lock);
894
895 err = wacom_led_putimage(wacom, button_id, buf);
896
897 mutex_unlock(&wacom->lock);
898
899 return err < 0 ? err : count;
900 }
901
902 #define DEVICE_BTNIMG_ATTR(BUTTON_ID) \
903 static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev, \
904 struct device_attribute *attr, const char *buf, size_t count) \
905 { \
906 return wacom_button_image_store(dev, BUTTON_ID, buf, count); \
907 } \
908 static DEVICE_ATTR(button##BUTTON_ID##_rawimg, S_IWUSR, \
909 NULL, wacom_btnimg##BUTTON_ID##_store)
910
911 DEVICE_BTNIMG_ATTR(0);
912 DEVICE_BTNIMG_ATTR(1);
913 DEVICE_BTNIMG_ATTR(2);
914 DEVICE_BTNIMG_ATTR(3);
915 DEVICE_BTNIMG_ATTR(4);
916 DEVICE_BTNIMG_ATTR(5);
917 DEVICE_BTNIMG_ATTR(6);
918 DEVICE_BTNIMG_ATTR(7);
919
920 static struct attribute *cintiq_led_attrs[] = {
921 &dev_attr_status_led0_select.attr,
922 &dev_attr_status_led1_select.attr,
923 NULL
924 };
925
926 static struct attribute_group cintiq_led_attr_group = {
927 .name = "wacom_led",
928 .attrs = cintiq_led_attrs,
929 };
930
931 static struct attribute *intuos4_led_attrs[] = {
932 &dev_attr_status0_luminance.attr,
933 &dev_attr_status1_luminance.attr,
934 &dev_attr_status_led0_select.attr,
935 &dev_attr_buttons_luminance.attr,
936 &dev_attr_button0_rawimg.attr,
937 &dev_attr_button1_rawimg.attr,
938 &dev_attr_button2_rawimg.attr,
939 &dev_attr_button3_rawimg.attr,
940 &dev_attr_button4_rawimg.attr,
941 &dev_attr_button5_rawimg.attr,
942 &dev_attr_button6_rawimg.attr,
943 &dev_attr_button7_rawimg.attr,
944 NULL
945 };
946
947 static struct attribute_group intuos4_led_attr_group = {
948 .name = "wacom_led",
949 .attrs = intuos4_led_attrs,
950 };
951
952 static struct attribute *intuos5_led_attrs[] = {
953 &dev_attr_status0_luminance.attr,
954 &dev_attr_status_led0_select.attr,
955 NULL
956 };
957
958 static struct attribute_group intuos5_led_attr_group = {
959 .name = "wacom_led",
960 .attrs = intuos5_led_attrs,
961 };
962
963 static int wacom_initialize_leds(struct wacom *wacom)
964 {
965 int error;
966
967 /* Initialize default values */
968 switch (wacom->wacom_wac.features.type) {
969 case INTUOS4S:
970 case INTUOS4:
971 case INTUOS4L:
972 wacom->led.select[0] = 0;
973 wacom->led.select[1] = 0;
974 wacom->led.llv = 10;
975 wacom->led.hlv = 20;
976 wacom->led.img_lum = 10;
977 error = sysfs_create_group(&wacom->intf->dev.kobj,
978 &intuos4_led_attr_group);
979 break;
980
981 case WACOM_24HD:
982 case WACOM_21UX2:
983 wacom->led.select[0] = 0;
984 wacom->led.select[1] = 0;
985 wacom->led.llv = 0;
986 wacom->led.hlv = 0;
987 wacom->led.img_lum = 0;
988
989 error = sysfs_create_group(&wacom->intf->dev.kobj,
990 &cintiq_led_attr_group);
991 break;
992
993 case INTUOS5S:
994 case INTUOS5:
995 case INTUOS5L:
996 case INTUOSPS:
997 case INTUOSPM:
998 case INTUOSPL:
999 if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN) {
1000 wacom->led.select[0] = 0;
1001 wacom->led.select[1] = 0;
1002 wacom->led.llv = 32;
1003 wacom->led.hlv = 0;
1004 wacom->led.img_lum = 0;
1005
1006 error = sysfs_create_group(&wacom->intf->dev.kobj,
1007 &intuos5_led_attr_group);
1008 } else
1009 return 0;
1010 break;
1011
1012 default:
1013 return 0;
1014 }
1015
1016 if (error) {
1017 dev_err(&wacom->intf->dev,
1018 "cannot create sysfs group err: %d\n", error);
1019 return error;
1020 }
1021 wacom_led_control(wacom);
1022
1023 return 0;
1024 }
1025
1026 static void wacom_destroy_leds(struct wacom *wacom)
1027 {
1028 switch (wacom->wacom_wac.features.type) {
1029 case INTUOS4S:
1030 case INTUOS4:
1031 case INTUOS4L:
1032 sysfs_remove_group(&wacom->intf->dev.kobj,
1033 &intuos4_led_attr_group);
1034 break;
1035
1036 case WACOM_24HD:
1037 case WACOM_21UX2:
1038 sysfs_remove_group(&wacom->intf->dev.kobj,
1039 &cintiq_led_attr_group);
1040 break;
1041
1042 case INTUOS5S:
1043 case INTUOS5:
1044 case INTUOS5L:
1045 case INTUOSPS:
1046 case INTUOSPM:
1047 case INTUOSPL:
1048 if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN)
1049 sysfs_remove_group(&wacom->intf->dev.kobj,
1050 &intuos5_led_attr_group);
1051 break;
1052 }
1053 }
1054
1055 static enum power_supply_property wacom_battery_props[] = {
1056 POWER_SUPPLY_PROP_SCOPE,
1057 POWER_SUPPLY_PROP_CAPACITY
1058 };
1059
1060 static int wacom_battery_get_property(struct power_supply *psy,
1061 enum power_supply_property psp,
1062 union power_supply_propval *val)
1063 {
1064 struct wacom *wacom = container_of(psy, struct wacom, battery);
1065 int ret = 0;
1066
1067 switch (psp) {
1068 case POWER_SUPPLY_PROP_SCOPE:
1069 val->intval = POWER_SUPPLY_SCOPE_DEVICE;
1070 break;
1071 case POWER_SUPPLY_PROP_CAPACITY:
1072 val->intval =
1073 wacom->wacom_wac.battery_capacity * 100 / 31;
1074 break;
1075 default:
1076 ret = -EINVAL;
1077 break;
1078 }
1079
1080 return ret;
1081 }
1082
1083 static int wacom_initialize_battery(struct wacom *wacom)
1084 {
1085 int error = 0;
1086
1087 if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_MONITOR) {
1088 wacom->battery.properties = wacom_battery_props;
1089 wacom->battery.num_properties = ARRAY_SIZE(wacom_battery_props);
1090 wacom->battery.get_property = wacom_battery_get_property;
1091 wacom->battery.name = "wacom_battery";
1092 wacom->battery.type = POWER_SUPPLY_TYPE_BATTERY;
1093 wacom->battery.use_for_apm = 0;
1094
1095 error = power_supply_register(&wacom->usbdev->dev,
1096 &wacom->battery);
1097
1098 if (!error)
1099 power_supply_powers(&wacom->battery,
1100 &wacom->usbdev->dev);
1101 }
1102
1103 return error;
1104 }
1105
1106 static void wacom_destroy_battery(struct wacom *wacom)
1107 {
1108 if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_MONITOR &&
1109 wacom->battery.dev) {
1110 power_supply_unregister(&wacom->battery);
1111 wacom->battery.dev = NULL;
1112 }
1113 }
1114
1115 static int wacom_register_input(struct wacom *wacom)
1116 {
1117 struct input_dev *input_dev;
1118 struct usb_interface *intf = wacom->intf;
1119 struct usb_device *dev = interface_to_usbdev(intf);
1120 struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1121 int error;
1122
1123 input_dev = input_allocate_device();
1124 if (!input_dev) {
1125 error = -ENOMEM;
1126 goto fail1;
1127 }
1128
1129 input_dev->name = wacom_wac->name;
1130 input_dev->dev.parent = &intf->dev;
1131 input_dev->open = wacom_open;
1132 input_dev->close = wacom_close;
1133 usb_to_input_id(dev, &input_dev->id);
1134 input_set_drvdata(input_dev, wacom);
1135
1136 wacom_wac->input = input_dev;
1137 error = wacom_setup_input_capabilities(input_dev, wacom_wac);
1138 if (error)
1139 goto fail1;
1140
1141 error = input_register_device(input_dev);
1142 if (error)
1143 goto fail2;
1144
1145 return 0;
1146
1147 fail2:
1148 input_free_device(input_dev);
1149 wacom_wac->input = NULL;
1150 fail1:
1151 return error;
1152 }
1153
1154 static void wacom_wireless_work(struct work_struct *work)
1155 {
1156 struct wacom *wacom = container_of(work, struct wacom, work);
1157 struct usb_device *usbdev = wacom->usbdev;
1158 struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1159 struct wacom *wacom1, *wacom2;
1160 struct wacom_wac *wacom_wac1, *wacom_wac2;
1161 int error;
1162
1163 /*
1164 * Regardless if this is a disconnect or a new tablet,
1165 * remove any existing input and battery devices.
1166 */
1167
1168 wacom_destroy_battery(wacom);
1169
1170 /* Stylus interface */
1171 wacom1 = usb_get_intfdata(usbdev->config->interface[1]);
1172 wacom_wac1 = &(wacom1->wacom_wac);
1173 if (wacom_wac1->input)
1174 input_unregister_device(wacom_wac1->input);
1175 wacom_wac1->input = NULL;
1176
1177 /* Touch interface */
1178 wacom2 = usb_get_intfdata(usbdev->config->interface[2]);
1179 wacom_wac2 = &(wacom2->wacom_wac);
1180 if (wacom_wac2->input)
1181 input_unregister_device(wacom_wac2->input);
1182 wacom_wac2->input = NULL;
1183
1184 if (wacom_wac->pid == 0) {
1185 dev_info(&wacom->intf->dev, "wireless tablet disconnected\n");
1186 } else {
1187 const struct usb_device_id *id = wacom_ids;
1188
1189 dev_info(&wacom->intf->dev,
1190 "wireless tablet connected with PID %x\n",
1191 wacom_wac->pid);
1192
1193 while (id->match_flags) {
1194 if (id->idVendor == USB_VENDOR_ID_WACOM &&
1195 id->idProduct == wacom_wac->pid)
1196 break;
1197 id++;
1198 }
1199
1200 if (!id->match_flags) {
1201 dev_info(&wacom->intf->dev,
1202 "ignoring unknown PID.\n");
1203 return;
1204 }
1205
1206 /* Stylus interface */
1207 wacom_wac1->features =
1208 *((struct wacom_features *)id->driver_info);
1209 wacom_wac1->features.device_type = BTN_TOOL_PEN;
1210 snprintf(wacom_wac1->name, WACOM_NAME_MAX, "%s (WL) Pen",
1211 wacom_wac1->features.name);
1212 wacom_wac1->shared->touch_max = wacom_wac1->features.touch_max;
1213 wacom_wac1->shared->type = wacom_wac1->features.type;
1214 error = wacom_register_input(wacom1);
1215 if (error)
1216 goto fail;
1217
1218 /* Touch interface */
1219 if (wacom_wac1->features.touch_max ||
1220 wacom_wac1->features.type == INTUOSHT) {
1221 wacom_wac2->features =
1222 *((struct wacom_features *)id->driver_info);
1223 wacom_wac2->features.pktlen = WACOM_PKGLEN_BBTOUCH3;
1224 wacom_wac2->features.device_type = BTN_TOOL_FINGER;
1225 wacom_wac2->features.x_max = wacom_wac2->features.y_max = 4096;
1226 if (wacom_wac2->features.touch_max)
1227 snprintf(wacom_wac2->name, WACOM_NAME_MAX,
1228 "%s (WL) Finger",wacom_wac2->features.name);
1229 else
1230 snprintf(wacom_wac2->name, WACOM_NAME_MAX,
1231 "%s (WL) Pad",wacom_wac2->features.name);
1232 error = wacom_register_input(wacom2);
1233 if (error)
1234 goto fail;
1235
1236 if (wacom_wac1->features.type == INTUOSHT &&
1237 wacom_wac1->features.touch_max)
1238 wacom_wac->shared->touch_input = wacom_wac2->input;
1239 }
1240
1241 error = wacom_initialize_battery(wacom);
1242 if (error)
1243 goto fail;
1244 }
1245
1246 return;
1247
1248 fail:
1249 if (wacom_wac2->input) {
1250 input_unregister_device(wacom_wac2->input);
1251 wacom_wac2->input = NULL;
1252 }
1253
1254 if (wacom_wac1->input) {
1255 input_unregister_device(wacom_wac1->input);
1256 wacom_wac1->input = NULL;
1257 }
1258 return;
1259 }
1260
1261 /*
1262 * Not all devices report physical dimensions from HID.
1263 * Compute the default from hardcoded logical dimension
1264 * and resolution before driver overwrites them.
1265 */
1266 static void wacom_set_default_phy(struct wacom_features *features)
1267 {
1268 if (features->x_resolution) {
1269 features->x_phy = (features->x_max * 100) /
1270 features->x_resolution;
1271 features->y_phy = (features->y_max * 100) /
1272 features->y_resolution;
1273 }
1274 }
1275
1276 static void wacom_calculate_res(struct wacom_features *features)
1277 {
1278 features->x_resolution = wacom_calc_hid_res(features->x_max,
1279 features->x_phy,
1280 features->unit,
1281 features->unitExpo);
1282 features->y_resolution = wacom_calc_hid_res(features->y_max,
1283 features->y_phy,
1284 features->unit,
1285 features->unitExpo);
1286 }
1287
1288 static int wacom_probe(struct usb_interface *intf, const struct usb_device_id *id)
1289 {
1290 struct usb_device *dev = interface_to_usbdev(intf);
1291 struct usb_endpoint_descriptor *endpoint;
1292 struct wacom *wacom;
1293 struct wacom_wac *wacom_wac;
1294 struct wacom_features *features;
1295 int error;
1296
1297 if (!id->driver_info)
1298 return -EINVAL;
1299
1300 wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
1301 if (!wacom)
1302 return -ENOMEM;
1303
1304 wacom_wac = &wacom->wacom_wac;
1305 wacom_wac->features = *((struct wacom_features *)id->driver_info);
1306 features = &wacom_wac->features;
1307 if (features->pktlen > WACOM_PKGLEN_MAX) {
1308 error = -EINVAL;
1309 goto fail1;
1310 }
1311
1312 wacom_wac->data = usb_alloc_coherent(dev, WACOM_PKGLEN_MAX,
1313 GFP_KERNEL, &wacom->data_dma);
1314 if (!wacom_wac->data) {
1315 error = -ENOMEM;
1316 goto fail1;
1317 }
1318
1319 wacom->irq = usb_alloc_urb(0, GFP_KERNEL);
1320 if (!wacom->irq) {
1321 error = -ENOMEM;
1322 goto fail2;
1323 }
1324
1325 wacom->usbdev = dev;
1326 wacom->intf = intf;
1327 mutex_init(&wacom->lock);
1328 INIT_WORK(&wacom->work, wacom_wireless_work);
1329 usb_make_path(dev, wacom->phys, sizeof(wacom->phys));
1330 strlcat(wacom->phys, "/input0", sizeof(wacom->phys));
1331
1332 endpoint = &intf->cur_altsetting->endpoint[0].desc;
1333
1334 /* set the default size in case we do not get them from hid */
1335 wacom_set_default_phy(features);
1336
1337 /* Retrieve the physical and logical size for touch devices */
1338 error = wacom_retrieve_hid_descriptor(intf, features);
1339 if (error)
1340 goto fail3;
1341
1342 /*
1343 * Intuos5 has no useful data about its touch interface in its
1344 * HID descriptor. If this is the touch interface (wMaxPacketSize
1345 * of WACOM_PKGLEN_BBTOUCH3), override the table values.
1346 */
1347 if (features->type >= INTUOS5S && features->type <= INTUOSHT) {
1348 if (endpoint->wMaxPacketSize == WACOM_PKGLEN_BBTOUCH3) {
1349 features->device_type = BTN_TOOL_FINGER;
1350 features->pktlen = WACOM_PKGLEN_BBTOUCH3;
1351
1352 features->x_max = 4096;
1353 features->y_max = 4096;
1354 } else {
1355 features->device_type = BTN_TOOL_PEN;
1356 }
1357 }
1358
1359 wacom_setup_device_quirks(features);
1360
1361 /* set unit to "100th of a mm" for devices not reported by HID */
1362 if (!features->unit) {
1363 features->unit = 0x11;
1364 features->unitExpo = 16 - 3;
1365 }
1366 wacom_calculate_res(features);
1367
1368 strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name));
1369
1370 if (features->quirks & WACOM_QUIRK_MULTI_INPUT) {
1371 struct usb_device *other_dev;
1372
1373 /* Append the device type to the name */
1374 if (features->device_type != BTN_TOOL_FINGER)
1375 strlcat(wacom_wac->name, " Pen", WACOM_NAME_MAX);
1376 else if (features->touch_max)
1377 strlcat(wacom_wac->name, " Finger", WACOM_NAME_MAX);
1378 else
1379 strlcat(wacom_wac->name, " Pad", WACOM_NAME_MAX);
1380
1381 other_dev = wacom_get_sibling(dev, features->oVid, features->oPid);
1382 if (other_dev == NULL || wacom_get_usbdev_data(other_dev) == NULL)
1383 other_dev = dev;
1384 error = wacom_add_shared_data(wacom_wac, other_dev);
1385 if (error)
1386 goto fail3;
1387 }
1388
1389 usb_fill_int_urb(wacom->irq, dev,
1390 usb_rcvintpipe(dev, endpoint->bEndpointAddress),
1391 wacom_wac->data, features->pktlen,
1392 wacom_sys_irq, wacom, endpoint->bInterval);
1393 wacom->irq->transfer_dma = wacom->data_dma;
1394 wacom->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
1395
1396 error = wacom_initialize_leds(wacom);
1397 if (error)
1398 goto fail4;
1399
1400 if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
1401 error = wacom_register_input(wacom);
1402 if (error)
1403 goto fail5;
1404 }
1405
1406 /* Note that if query fails it is not a hard failure */
1407 wacom_query_tablet_data(intf, features);
1408
1409 usb_set_intfdata(intf, wacom);
1410
1411 if (features->quirks & WACOM_QUIRK_MONITOR) {
1412 if (usb_submit_urb(wacom->irq, GFP_KERNEL)) {
1413 error = -EIO;
1414 goto fail5;
1415 }
1416 }
1417
1418 if (wacom_wac->features.type == INTUOSHT && wacom_wac->features.touch_max) {
1419 if (wacom_wac->features.device_type == BTN_TOOL_FINGER)
1420 wacom_wac->shared->touch_input = wacom_wac->input;
1421 }
1422
1423 return 0;
1424
1425 fail5: wacom_destroy_leds(wacom);
1426 fail4: wacom_remove_shared_data(wacom_wac);
1427 fail3: usb_free_urb(wacom->irq);
1428 fail2: usb_free_coherent(dev, WACOM_PKGLEN_MAX, wacom_wac->data, wacom->data_dma);
1429 fail1: kfree(wacom);
1430 return error;
1431 }
1432
1433 static void wacom_disconnect(struct usb_interface *intf)
1434 {
1435 struct wacom *wacom = usb_get_intfdata(intf);
1436
1437 usb_set_intfdata(intf, NULL);
1438
1439 usb_kill_urb(wacom->irq);
1440 cancel_work_sync(&wacom->work);
1441 if (wacom->wacom_wac.input)
1442 input_unregister_device(wacom->wacom_wac.input);
1443 wacom_destroy_battery(wacom);
1444 wacom_destroy_leds(wacom);
1445 usb_free_urb(wacom->irq);
1446 usb_free_coherent(interface_to_usbdev(intf), WACOM_PKGLEN_MAX,
1447 wacom->wacom_wac.data, wacom->data_dma);
1448 wacom_remove_shared_data(&wacom->wacom_wac);
1449 kfree(wacom);
1450 }
1451
1452 static int wacom_suspend(struct usb_interface *intf, pm_message_t message)
1453 {
1454 struct wacom *wacom = usb_get_intfdata(intf);
1455
1456 mutex_lock(&wacom->lock);
1457 usb_kill_urb(wacom->irq);
1458 mutex_unlock(&wacom->lock);
1459
1460 return 0;
1461 }
1462
1463 static int wacom_resume(struct usb_interface *intf)
1464 {
1465 struct wacom *wacom = usb_get_intfdata(intf);
1466 struct wacom_features *features = &wacom->wacom_wac.features;
1467 int rv = 0;
1468
1469 mutex_lock(&wacom->lock);
1470
1471 /* switch to wacom mode first */
1472 wacom_query_tablet_data(intf, features);
1473 wacom_led_control(wacom);
1474
1475 if ((wacom->open || (features->quirks & WACOM_QUIRK_MONITOR)) &&
1476 usb_submit_urb(wacom->irq, GFP_NOIO) < 0)
1477 rv = -EIO;
1478
1479 mutex_unlock(&wacom->lock);
1480
1481 return rv;
1482 }
1483
1484 static int wacom_reset_resume(struct usb_interface *intf)
1485 {
1486 return wacom_resume(intf);
1487 }
1488
1489 static struct usb_driver wacom_driver = {
1490 .name = "wacom",
1491 .id_table = wacom_ids,
1492 .probe = wacom_probe,
1493 .disconnect = wacom_disconnect,
1494 .suspend = wacom_suspend,
1495 .resume = wacom_resume,
1496 .reset_resume = wacom_reset_resume,
1497 .supports_autosuspend = 1,
1498 };
1499
1500 module_usb_driver(wacom_driver);
Ubuntu Artful kernel mirror