]>
Commit | Line | Data |
---|---|---|
3bea733a | 1 | /* |
4104d13f | 2 | * drivers/input/tablet/wacom_sys.c |
3bea733a | 3 | * |
232f5693 | 4 | * USB Wacom tablet support - system specific code |
3bea733a PC |
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 | ||
3bea733a | 14 | #include "wacom_wac.h" |
51269fe8 | 15 | #include "wacom.h" |
3bea733a | 16 | |
545f4e99 PC |
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 0x30 | |
26 | #define HID_USAGE_Y 0x31 | |
27 | #define HID_USAGE_X_TILT 0x3d | |
28 | #define HID_USAGE_Y_TILT 0x3e | |
29 | #define HID_USAGE_FINGER 0x22 | |
30 | #define HID_USAGE_STYLUS 0x20 | |
31 | #define HID_COLLECTION 0xc0 | |
32 | ||
33 | enum { | |
34 | WCM_UNDEFINED = 0, | |
35 | WCM_DESKTOP, | |
36 | WCM_DIGITIZER, | |
37 | }; | |
38 | ||
39 | struct hid_descriptor { | |
40 | struct usb_descriptor_header header; | |
41 | __le16 bcdHID; | |
42 | u8 bCountryCode; | |
43 | u8 bNumDescriptors; | |
44 | u8 bDescriptorType; | |
45 | __le16 wDescriptorLength; | |
46 | } __attribute__ ((packed)); | |
47 | ||
48 | /* defines to get/set USB message */ | |
3bea733a PC |
49 | #define USB_REQ_GET_REPORT 0x01 |
50 | #define USB_REQ_SET_REPORT 0x09 | |
545f4e99 | 51 | #define WAC_HID_FEATURE_REPORT 0x03 |
3bea733a PC |
52 | |
53 | static int usb_get_report(struct usb_interface *intf, unsigned char type, | |
54 | unsigned char id, void *buf, int size) | |
55 | { | |
56 | return usb_control_msg(interface_to_usbdev(intf), | |
57 | usb_rcvctrlpipe(interface_to_usbdev(intf), 0), | |
58 | USB_REQ_GET_REPORT, USB_TYPE_CLASS | USB_RECIP_INTERFACE, | |
59 | (type << 8) + id, intf->altsetting[0].desc.bInterfaceNumber, | |
60 | buf, size, 100); | |
61 | } | |
62 | ||
63 | static int usb_set_report(struct usb_interface *intf, unsigned char type, | |
64 | unsigned char id, void *buf, int size) | |
65 | { | |
66 | return usb_control_msg(interface_to_usbdev(intf), | |
67 | usb_sndctrlpipe(interface_to_usbdev(intf), 0), | |
68 | USB_REQ_SET_REPORT, USB_TYPE_CLASS | USB_RECIP_INTERFACE, | |
69 | (type << 8) + id, intf->altsetting[0].desc.bInterfaceNumber, | |
70 | buf, size, 1000); | |
71 | } | |
72 | ||
54c9b226 | 73 | static void wacom_sys_irq(struct urb *urb) |
3bea733a PC |
74 | { |
75 | struct wacom *wacom = urb->context; | |
3bea733a PC |
76 | int retval; |
77 | ||
78 | switch (urb->status) { | |
79 | case 0: | |
80 | /* success */ | |
81 | break; | |
82 | case -ECONNRESET: | |
83 | case -ENOENT: | |
84 | case -ESHUTDOWN: | |
85 | /* this urb is terminated, clean up */ | |
ea3e6c59 | 86 | dbg("%s - urb shutting down with status: %d", __func__, urb->status); |
3bea733a PC |
87 | return; |
88 | default: | |
ea3e6c59 | 89 | dbg("%s - nonzero urb status received: %d", __func__, urb->status); |
3bea733a PC |
90 | goto exit; |
91 | } | |
92 | ||
95dd3b30 | 93 | wacom_wac_irq(&wacom->wacom_wac, urb->actual_length); |
3bea733a PC |
94 | |
95 | exit: | |
e7224094 | 96 | usb_mark_last_busy(wacom->usbdev); |
73a97f4f | 97 | retval = usb_submit_urb(urb, GFP_ATOMIC); |
3bea733a PC |
98 | if (retval) |
99 | err ("%s - usb_submit_urb failed with result %d", | |
ea3e6c59 | 100 | __func__, retval); |
3bea733a PC |
101 | } |
102 | ||
3bea733a PC |
103 | static int wacom_open(struct input_dev *dev) |
104 | { | |
7791bdae | 105 | struct wacom *wacom = input_get_drvdata(dev); |
3bea733a | 106 | |
e7224094 ON |
107 | mutex_lock(&wacom->lock); |
108 | ||
3bea733a | 109 | wacom->irq->dev = wacom->usbdev; |
e7224094 ON |
110 | |
111 | if (usb_autopm_get_interface(wacom->intf) < 0) { | |
112 | mutex_unlock(&wacom->lock); | |
3bea733a | 113 | return -EIO; |
e7224094 ON |
114 | } |
115 | ||
116 | if (usb_submit_urb(wacom->irq, GFP_KERNEL)) { | |
117 | usb_autopm_put_interface(wacom->intf); | |
118 | mutex_unlock(&wacom->lock); | |
119 | return -EIO; | |
120 | } | |
121 | ||
51269fe8 | 122 | wacom->open = true; |
e7224094 | 123 | wacom->intf->needs_remote_wakeup = 1; |
3bea733a | 124 | |
e7224094 | 125 | mutex_unlock(&wacom->lock); |
3bea733a PC |
126 | return 0; |
127 | } | |
128 | ||
129 | static void wacom_close(struct input_dev *dev) | |
130 | { | |
7791bdae | 131 | struct wacom *wacom = input_get_drvdata(dev); |
3bea733a | 132 | |
e7224094 | 133 | mutex_lock(&wacom->lock); |
3bea733a | 134 | usb_kill_urb(wacom->irq); |
51269fe8 | 135 | wacom->open = false; |
e7224094 ON |
136 | wacom->intf->needs_remote_wakeup = 0; |
137 | mutex_unlock(&wacom->lock); | |
3bea733a PC |
138 | } |
139 | ||
545f4e99 | 140 | static int wacom_parse_hid(struct usb_interface *intf, struct hid_descriptor *hid_desc, |
ec67bbed | 141 | struct wacom_features *features) |
545f4e99 PC |
142 | { |
143 | struct usb_device *dev = interface_to_usbdev(intf); | |
ec67bbed PC |
144 | char limit = 0; |
145 | /* result has to be defined as int for some devices */ | |
146 | int result = 0; | |
545f4e99 PC |
147 | int i = 0, usage = WCM_UNDEFINED, finger = 0, pen = 0; |
148 | unsigned char *report; | |
149 | ||
150 | report = kzalloc(hid_desc->wDescriptorLength, GFP_KERNEL); | |
151 | if (!report) | |
152 | return -ENOMEM; | |
153 | ||
154 | /* retrive report descriptors */ | |
155 | do { | |
156 | result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), | |
157 | USB_REQ_GET_DESCRIPTOR, | |
158 | USB_RECIP_INTERFACE | USB_DIR_IN, | |
159 | HID_DEVICET_REPORT << 8, | |
160 | intf->altsetting[0].desc.bInterfaceNumber, /* interface */ | |
161 | report, | |
162 | hid_desc->wDescriptorLength, | |
163 | 5000); /* 5 secs */ | |
164 | } while (result < 0 && limit++ < 5); | |
165 | ||
384318ec | 166 | /* No need to parse the Descriptor. It isn't an error though */ |
545f4e99 PC |
167 | if (result < 0) |
168 | goto out; | |
169 | ||
170 | for (i = 0; i < hid_desc->wDescriptorLength; i++) { | |
171 | ||
172 | switch (report[i]) { | |
173 | case HID_USAGE_PAGE: | |
174 | switch (report[i + 1]) { | |
175 | case HID_USAGE_PAGE_DIGITIZER: | |
176 | usage = WCM_DIGITIZER; | |
177 | i++; | |
178 | break; | |
179 | ||
180 | case HID_USAGE_PAGE_DESKTOP: | |
181 | usage = WCM_DESKTOP; | |
182 | i++; | |
183 | break; | |
184 | } | |
185 | break; | |
186 | ||
187 | case HID_USAGE: | |
188 | switch (report[i + 1]) { | |
189 | case HID_USAGE_X: | |
190 | if (usage == WCM_DESKTOP) { | |
191 | if (finger) { | |
ec67bbed PC |
192 | features->device_type = BTN_TOOL_DOUBLETAP; |
193 | if (features->type == TABLETPC2FG) { | |
194 | /* need to reset back */ | |
195 | features->pktlen = WACOM_PKGLEN_TPC2FG; | |
196 | features->device_type = BTN_TOOL_TRIPLETAP; | |
197 | } | |
545f4e99 | 198 | features->x_max = |
252f7769 | 199 | get_unaligned_le16(&report[i + 3]); |
ec67bbed | 200 | features->x_phy = |
252f7769 | 201 | get_unaligned_le16(&report[i + 6]); |
ec67bbed PC |
202 | features->unit = report[i + 9]; |
203 | features->unitExpo = report[i + 11]; | |
204 | i += 12; | |
545f4e99 | 205 | } else if (pen) { |
ec67bbed PC |
206 | /* penabled only accepts exact bytes of data */ |
207 | if (features->type == TABLETPC2FG) | |
57e413d9 | 208 | features->pktlen = WACOM_PKGLEN_GRAPHIRE; |
ec67bbed | 209 | features->device_type = BTN_TOOL_PEN; |
545f4e99 | 210 | features->x_max = |
252f7769 | 211 | get_unaligned_le16(&report[i + 3]); |
545f4e99 PC |
212 | i += 4; |
213 | } | |
214 | } else if (usage == WCM_DIGITIZER) { | |
215 | /* max pressure isn't reported | |
216 | features->pressure_max = (unsigned short) | |
217 | (report[i+4] << 8 | report[i + 3]); | |
218 | */ | |
219 | features->pressure_max = 255; | |
220 | i += 4; | |
221 | } | |
222 | break; | |
223 | ||
224 | case HID_USAGE_Y: | |
ec67bbed PC |
225 | if (usage == WCM_DESKTOP) { |
226 | if (finger) { | |
227 | features->device_type = BTN_TOOL_DOUBLETAP; | |
228 | if (features->type == TABLETPC2FG) { | |
229 | /* need to reset back */ | |
230 | features->pktlen = WACOM_PKGLEN_TPC2FG; | |
231 | features->device_type = BTN_TOOL_TRIPLETAP; | |
232 | features->y_max = | |
252f7769 | 233 | get_unaligned_le16(&report[i + 3]); |
ec67bbed | 234 | features->y_phy = |
252f7769 | 235 | get_unaligned_le16(&report[i + 6]); |
ec67bbed PC |
236 | i += 7; |
237 | } else { | |
238 | features->y_max = | |
239 | features->x_max; | |
240 | features->y_phy = | |
252f7769 | 241 | get_unaligned_le16(&report[i + 3]); |
ec67bbed PC |
242 | i += 4; |
243 | } | |
244 | } else if (pen) { | |
245 | /* penabled only accepts exact bytes of data */ | |
246 | if (features->type == TABLETPC2FG) | |
57e413d9 | 247 | features->pktlen = WACOM_PKGLEN_GRAPHIRE; |
ec67bbed PC |
248 | features->device_type = BTN_TOOL_PEN; |
249 | features->y_max = | |
252f7769 | 250 | get_unaligned_le16(&report[i + 3]); |
ec67bbed PC |
251 | i += 4; |
252 | } | |
253 | } | |
545f4e99 PC |
254 | break; |
255 | ||
256 | case HID_USAGE_FINGER: | |
257 | finger = 1; | |
258 | i++; | |
259 | break; | |
260 | ||
261 | case HID_USAGE_STYLUS: | |
262 | pen = 1; | |
263 | i++; | |
264 | break; | |
265 | ||
266 | case HID_USAGE_UNDEFINED: | |
267 | if (usage == WCM_DESKTOP && finger) /* capacity */ | |
268 | features->pressure_max = | |
252f7769 | 269 | get_unaligned_le16(&report[i + 3]); |
545f4e99 PC |
270 | i += 4; |
271 | break; | |
272 | } | |
273 | break; | |
274 | ||
275 | case HID_COLLECTION: | |
ec67bbed | 276 | /* reset UsagePage and Finger */ |
545f4e99 PC |
277 | finger = usage = 0; |
278 | break; | |
279 | } | |
280 | } | |
281 | ||
545f4e99 | 282 | out: |
384318ec | 283 | result = 0; |
545f4e99 PC |
284 | kfree(report); |
285 | return result; | |
286 | } | |
287 | ||
ec67bbed | 288 | static int wacom_query_tablet_data(struct usb_interface *intf, struct wacom_features *features) |
3b7307c2 DT |
289 | { |
290 | unsigned char *rep_data; | |
ec67bbed PC |
291 | int limit = 0, report_id = 2; |
292 | int error = -ENOMEM; | |
3b7307c2 DT |
293 | |
294 | rep_data = kmalloc(2, GFP_KERNEL); | |
295 | if (!rep_data) | |
ec67bbed PC |
296 | return error; |
297 | ||
298 | /* ask to report tablet data if it is 2FGT or not a Tablet PC */ | |
299 | if (features->device_type == BTN_TOOL_TRIPLETAP) { | |
300 | do { | |
301 | rep_data[0] = 3; | |
302 | rep_data[1] = 4; | |
303 | report_id = 3; | |
304 | error = usb_set_report(intf, WAC_HID_FEATURE_REPORT, | |
305 | report_id, rep_data, 2); | |
306 | if (error >= 0) | |
307 | error = usb_get_report(intf, | |
308 | WAC_HID_FEATURE_REPORT, report_id, | |
309 | rep_data, 3); | |
310 | } while ((error < 0 || rep_data[1] != 4) && limit++ < 5); | |
311 | } else if (features->type != TABLETPC && features->type != TABLETPC2FG) { | |
312 | do { | |
313 | rep_data[0] = 2; | |
314 | rep_data[1] = 2; | |
315 | error = usb_set_report(intf, WAC_HID_FEATURE_REPORT, | |
316 | report_id, rep_data, 2); | |
317 | if (error >= 0) | |
318 | error = usb_get_report(intf, | |
319 | WAC_HID_FEATURE_REPORT, report_id, | |
320 | rep_data, 2); | |
321 | } while ((error < 0 || rep_data[1] != 2) && limit++ < 5); | |
322 | } | |
3b7307c2 DT |
323 | |
324 | kfree(rep_data); | |
325 | ||
326 | return error < 0 ? error : 0; | |
327 | } | |
328 | ||
ec67bbed PC |
329 | static int wacom_retrieve_hid_descriptor(struct usb_interface *intf, |
330 | struct wacom_features *features) | |
331 | { | |
332 | int error = 0; | |
333 | struct usb_host_interface *interface = intf->cur_altsetting; | |
334 | struct hid_descriptor *hid_desc; | |
335 | ||
336 | /* default device to penabled */ | |
337 | features->device_type = BTN_TOOL_PEN; | |
338 | ||
339 | /* only Tablet PCs need to retrieve the info */ | |
340 | if ((features->type != TABLETPC) && (features->type != TABLETPC2FG)) | |
341 | goto out; | |
342 | ||
343 | if (usb_get_extra_descriptor(interface, HID_DEVICET_HID, &hid_desc)) { | |
344 | if (usb_get_extra_descriptor(&interface->endpoint[0], | |
345 | HID_DEVICET_REPORT, &hid_desc)) { | |
346 | printk("wacom: can not retrieve extra class descriptor\n"); | |
347 | error = 1; | |
348 | goto out; | |
349 | } | |
350 | } | |
351 | error = wacom_parse_hid(intf, hid_desc, features); | |
352 | if (error) | |
353 | goto out; | |
354 | ||
355 | /* touch device found but size is not defined. use default */ | |
356 | if (features->device_type == BTN_TOOL_DOUBLETAP && !features->x_max) { | |
357 | features->x_max = 1023; | |
358 | features->y_max = 1023; | |
359 | } | |
360 | ||
361 | out: | |
362 | return error; | |
363 | } | |
364 | ||
4492efff PC |
365 | struct wacom_usbdev_data { |
366 | struct list_head list; | |
367 | struct kref kref; | |
368 | struct usb_device *dev; | |
369 | struct wacom_shared shared; | |
370 | }; | |
371 | ||
372 | static LIST_HEAD(wacom_udev_list); | |
373 | static DEFINE_MUTEX(wacom_udev_list_lock); | |
374 | ||
375 | static struct wacom_usbdev_data *wacom_get_usbdev_data(struct usb_device *dev) | |
376 | { | |
377 | struct wacom_usbdev_data *data; | |
378 | ||
379 | list_for_each_entry(data, &wacom_udev_list, list) { | |
380 | if (data->dev == dev) { | |
381 | kref_get(&data->kref); | |
382 | return data; | |
383 | } | |
384 | } | |
385 | ||
386 | return NULL; | |
387 | } | |
388 | ||
389 | static int wacom_add_shared_data(struct wacom_wac *wacom, | |
390 | struct usb_device *dev) | |
391 | { | |
392 | struct wacom_usbdev_data *data; | |
393 | int retval = 0; | |
394 | ||
395 | mutex_lock(&wacom_udev_list_lock); | |
396 | ||
397 | data = wacom_get_usbdev_data(dev); | |
398 | if (!data) { | |
399 | data = kzalloc(sizeof(struct wacom_usbdev_data), GFP_KERNEL); | |
400 | if (!data) { | |
401 | retval = -ENOMEM; | |
402 | goto out; | |
403 | } | |
404 | ||
405 | kref_init(&data->kref); | |
406 | data->dev = dev; | |
407 | list_add_tail(&data->list, &wacom_udev_list); | |
408 | } | |
409 | ||
410 | wacom->shared = &data->shared; | |
411 | ||
412 | out: | |
413 | mutex_unlock(&wacom_udev_list_lock); | |
414 | return retval; | |
415 | } | |
416 | ||
417 | static void wacom_release_shared_data(struct kref *kref) | |
418 | { | |
419 | struct wacom_usbdev_data *data = | |
420 | container_of(kref, struct wacom_usbdev_data, kref); | |
421 | ||
422 | mutex_lock(&wacom_udev_list_lock); | |
423 | list_del(&data->list); | |
424 | mutex_unlock(&wacom_udev_list_lock); | |
425 | ||
426 | kfree(data); | |
427 | } | |
428 | ||
429 | static void wacom_remove_shared_data(struct wacom_wac *wacom) | |
430 | { | |
431 | struct wacom_usbdev_data *data; | |
432 | ||
433 | if (wacom->shared) { | |
434 | data = container_of(wacom->shared, struct wacom_usbdev_data, shared); | |
435 | kref_put(&data->kref, wacom_release_shared_data); | |
436 | wacom->shared = NULL; | |
437 | } | |
438 | } | |
439 | ||
3bea733a PC |
440 | static int wacom_probe(struct usb_interface *intf, const struct usb_device_id *id) |
441 | { | |
442 | struct usb_device *dev = interface_to_usbdev(intf); | |
443 | struct usb_endpoint_descriptor *endpoint; | |
444 | struct wacom *wacom; | |
445 | struct wacom_wac *wacom_wac; | |
e33da8a5 | 446 | struct wacom_features *features; |
3bea733a | 447 | struct input_dev *input_dev; |
e33da8a5 | 448 | int error; |
3bea733a | 449 | |
e33da8a5 | 450 | if (!id->driver_info) |
b036f6fb BB |
451 | return -EINVAL; |
452 | ||
3bea733a | 453 | wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL); |
3bea733a | 454 | input_dev = input_allocate_device(); |
51269fe8 | 455 | if (!wacom || !input_dev) { |
e33da8a5 JC |
456 | error = -ENOMEM; |
457 | goto fail1; | |
458 | } | |
459 | ||
51269fe8 | 460 | wacom_wac = &wacom->wacom_wac; |
e33da8a5 JC |
461 | wacom_wac->features = *((struct wacom_features *)id->driver_info); |
462 | features = &wacom_wac->features; | |
463 | if (features->pktlen > WACOM_PKGLEN_MAX) { | |
464 | error = -EINVAL; | |
3bea733a | 465 | goto fail1; |
e33da8a5 | 466 | } |
3bea733a | 467 | |
997ea58e DM |
468 | wacom_wac->data = usb_alloc_coherent(dev, WACOM_PKGLEN_MAX, |
469 | GFP_KERNEL, &wacom->data_dma); | |
e33da8a5 JC |
470 | if (!wacom_wac->data) { |
471 | error = -ENOMEM; | |
3bea733a | 472 | goto fail1; |
e33da8a5 | 473 | } |
3bea733a PC |
474 | |
475 | wacom->irq = usb_alloc_urb(0, GFP_KERNEL); | |
e33da8a5 JC |
476 | if (!wacom->irq) { |
477 | error = -ENOMEM; | |
3bea733a | 478 | goto fail2; |
e33da8a5 | 479 | } |
3bea733a PC |
480 | |
481 | wacom->usbdev = dev; | |
e7224094 ON |
482 | wacom->intf = intf; |
483 | mutex_init(&wacom->lock); | |
3bea733a PC |
484 | usb_make_path(dev, wacom->phys, sizeof(wacom->phys)); |
485 | strlcat(wacom->phys, "/input0", sizeof(wacom->phys)); | |
486 | ||
8da23fc1 | 487 | wacom_wac->input = input_dev; |
3bea733a | 488 | |
545f4e99 PC |
489 | endpoint = &intf->cur_altsetting->endpoint[0].desc; |
490 | ||
ec67bbed PC |
491 | /* Retrieve the physical and logical size for OEM devices */ |
492 | error = wacom_retrieve_hid_descriptor(intf, features); | |
493 | if (error) | |
494 | goto fail2; | |
545f4e99 | 495 | |
49b764ae PC |
496 | strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name)); |
497 | ||
498 | if (features->type == TABLETPC || features->type == TABLETPC2FG) { | |
499 | /* Append the device type to the name */ | |
500 | strlcat(wacom_wac->name, | |
501 | features->device_type == BTN_TOOL_PEN ? | |
502 | " Pen" : " Finger", | |
503 | sizeof(wacom_wac->name)); | |
4492efff PC |
504 | |
505 | error = wacom_add_shared_data(wacom_wac, dev); | |
506 | if (error) | |
507 | goto fail3; | |
49b764ae PC |
508 | } |
509 | ||
8da23fc1 DT |
510 | input_dev->name = wacom_wac->name; |
511 | input_dev->dev.parent = &intf->dev; | |
512 | input_dev->open = wacom_open; | |
513 | input_dev->close = wacom_close; | |
514 | usb_to_input_id(dev, &input_dev->id); | |
515 | input_set_drvdata(input_dev, wacom); | |
e33da8a5 | 516 | |
8da23fc1 | 517 | wacom_setup_input_capabilities(input_dev, wacom_wac); |
3bea733a | 518 | |
3bea733a PC |
519 | usb_fill_int_urb(wacom->irq, dev, |
520 | usb_rcvintpipe(dev, endpoint->bEndpointAddress), | |
ec67bbed | 521 | wacom_wac->data, features->pktlen, |
8d32e3ae | 522 | wacom_sys_irq, wacom, endpoint->bInterval); |
3bea733a PC |
523 | wacom->irq->transfer_dma = wacom->data_dma; |
524 | wacom->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
525 | ||
8da23fc1 | 526 | error = input_register_device(input_dev); |
5014186d | 527 | if (error) |
4492efff | 528 | goto fail4; |
3bea733a | 529 | |
ec67bbed PC |
530 | /* Note that if query fails it is not a hard failure */ |
531 | wacom_query_tablet_data(intf, features); | |
3bea733a PC |
532 | |
533 | usb_set_intfdata(intf, wacom); | |
534 | return 0; | |
535 | ||
4492efff | 536 | fail4: wacom_remove_shared_data(wacom_wac); |
5014186d | 537 | fail3: usb_free_urb(wacom->irq); |
997ea58e | 538 | fail2: usb_free_coherent(dev, WACOM_PKGLEN_MAX, wacom_wac->data, wacom->data_dma); |
5014186d | 539 | fail1: input_free_device(input_dev); |
3bea733a | 540 | kfree(wacom); |
5014186d | 541 | return error; |
3bea733a PC |
542 | } |
543 | ||
544 | static void wacom_disconnect(struct usb_interface *intf) | |
545 | { | |
e7224094 | 546 | struct wacom *wacom = usb_get_intfdata(intf); |
3bea733a PC |
547 | |
548 | usb_set_intfdata(intf, NULL); | |
e7224094 ON |
549 | |
550 | usb_kill_urb(wacom->irq); | |
8da23fc1 | 551 | input_unregister_device(wacom->wacom_wac.input); |
e7224094 | 552 | usb_free_urb(wacom->irq); |
997ea58e | 553 | usb_free_coherent(interface_to_usbdev(intf), WACOM_PKGLEN_MAX, |
51269fe8 DT |
554 | wacom->wacom_wac.data, wacom->data_dma); |
555 | wacom_remove_shared_data(&wacom->wacom_wac); | |
e7224094 ON |
556 | kfree(wacom); |
557 | } | |
558 | ||
559 | static int wacom_suspend(struct usb_interface *intf, pm_message_t message) | |
560 | { | |
561 | struct wacom *wacom = usb_get_intfdata(intf); | |
562 | ||
563 | mutex_lock(&wacom->lock); | |
564 | usb_kill_urb(wacom->irq); | |
565 | mutex_unlock(&wacom->lock); | |
566 | ||
567 | return 0; | |
568 | } | |
569 | ||
570 | static int wacom_resume(struct usb_interface *intf) | |
571 | { | |
572 | struct wacom *wacom = usb_get_intfdata(intf); | |
51269fe8 | 573 | struct wacom_features *features = &wacom->wacom_wac.features; |
e7224094 ON |
574 | int rv; |
575 | ||
576 | mutex_lock(&wacom->lock); | |
38101475 PC |
577 | |
578 | /* switch to wacom mode first */ | |
579 | wacom_query_tablet_data(intf, features); | |
580 | ||
581 | if (wacom->open) | |
e7224094 | 582 | rv = usb_submit_urb(wacom->irq, GFP_NOIO); |
38101475 | 583 | else |
e7224094 | 584 | rv = 0; |
38101475 | 585 | |
e7224094 ON |
586 | mutex_unlock(&wacom->lock); |
587 | ||
588 | return rv; | |
589 | } | |
590 | ||
591 | static int wacom_reset_resume(struct usb_interface *intf) | |
592 | { | |
593 | return wacom_resume(intf); | |
3bea733a PC |
594 | } |
595 | ||
596 | static struct usb_driver wacom_driver = { | |
597 | .name = "wacom", | |
b036f6fb | 598 | .id_table = wacom_ids, |
3bea733a PC |
599 | .probe = wacom_probe, |
600 | .disconnect = wacom_disconnect, | |
e7224094 ON |
601 | .suspend = wacom_suspend, |
602 | .resume = wacom_resume, | |
603 | .reset_resume = wacom_reset_resume, | |
604 | .supports_autosuspend = 1, | |
3bea733a PC |
605 | }; |
606 | ||
607 | static int __init wacom_init(void) | |
608 | { | |
609 | int result; | |
b036f6fb | 610 | |
3bea733a PC |
611 | result = usb_register(&wacom_driver); |
612 | if (result == 0) | |
899ef6e7 GKH |
613 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" |
614 | DRIVER_DESC "\n"); | |
3bea733a PC |
615 | return result; |
616 | } | |
617 | ||
618 | static void __exit wacom_exit(void) | |
619 | { | |
620 | usb_deregister(&wacom_driver); | |
621 | } | |
622 | ||
623 | module_init(wacom_init); | |
624 | module_exit(wacom_exit); |