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