Commit | Line | Data |
---|---|---|
a19ceb56 JR |
1 | /* -*- linux-c -*- |
2 | ||
3 | GTCO digitizer USB driver | |
4 | ||
a19ceb56 JR |
5 | TO CHECK: Is pressure done right on report 5? |
6 | ||
7 | Copyright (C) 2006 GTCO CalComp | |
8 | ||
9 | This program is free software; you can redistribute it and/or | |
10 | modify it under the terms of the GNU General Public License | |
11 | as published by the Free Software Foundation; version 2 | |
12 | of the License. | |
13 | ||
14 | This program is distributed in the hope that it will be useful, | |
15 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
17 | GNU General Public License for more details. | |
18 | ||
19 | You should have received a copy of the GNU General Public License | |
20 | along with this program; if not, write to the Free Software | |
21 | Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. | |
22 | ||
23 | Permission to use, copy, modify, distribute, and sell this software and its | |
24 | documentation for any purpose is hereby granted without fee, provided that | |
25 | the above copyright notice appear in all copies and that both that | |
26 | copyright notice and this permission notice appear in supporting | |
27 | documentation, and that the name of GTCO-CalComp not be used in advertising | |
28 | or publicity pertaining to distribution of the software without specific, | |
29 | written prior permission. GTCO-CalComp makes no representations about the | |
30 | suitability of this software for any purpose. It is provided "as is" | |
31 | without express or implied warranty. | |
32 | ||
33 | GTCO-CALCOMP DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, | |
34 | INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO | |
35 | EVENT SHALL GTCO-CALCOMP BE LIABLE FOR ANY SPECIAL, INDIRECT OR | |
36 | CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, | |
37 | DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER | |
38 | TORTIOUS ACTIONS, ARISING OUT OF OR IN CONNECTION WITH THE USE OR | |
39 | PERFORMANCE OF THIS SOFTWARE. | |
40 | ||
41 | GTCO CalComp, Inc. | |
42 | 7125 Riverwood Drive | |
43 | Columbia, MD 21046 | |
44 | ||
45 | Jeremy Roberson jroberson@gtcocalcomp.com | |
46 | Scott Hill shill@gtcocalcomp.com | |
47 | */ | |
48 | ||
49 | ||
50 | ||
51 | /*#define DEBUG*/ | |
52 | ||
53 | #include <linux/kernel.h> | |
54 | #include <linux/module.h> | |
55 | #include <linux/errno.h> | |
56 | #include <linux/init.h> | |
57 | #include <linux/slab.h> | |
58 | #include <linux/input.h> | |
59 | #include <linux/usb.h> | |
60 | #include <asm/uaccess.h> | |
61 | #include <asm/unaligned.h> | |
62 | #include <asm/byteorder.h> | |
63 | ||
64 | ||
a19ceb56 JR |
65 | #include <linux/usb/input.h> |
66 | ||
67 | /* Version with a Major number of 2 is for kernel inclusion only. */ | |
68 | #define GTCO_VERSION "2.00.0006" | |
69 | ||
70 | ||
71 | /* MACROS */ | |
72 | ||
73 | #define VENDOR_ID_GTCO 0x078C | |
74 | #define PID_400 0x400 | |
75 | #define PID_401 0x401 | |
76 | #define PID_1000 0x1000 | |
77 | #define PID_1001 0x1001 | |
78 | #define PID_1002 0x1002 | |
79 | ||
80 | /* Max size of a single report */ | |
81 | #define REPORT_MAX_SIZE 10 | |
82 | ||
83 | ||
84 | /* Bitmask whether pen is in range */ | |
85 | #define MASK_INRANGE 0x20 | |
86 | #define MASK_BUTTON 0x01F | |
87 | ||
88 | #define PATHLENGTH 64 | |
89 | ||
90 | /* DATA STRUCTURES */ | |
91 | ||
92 | /* Device table */ | |
9cb3ce52 | 93 | static const struct usb_device_id gtco_usbid_table[] = { |
a19ceb56 JR |
94 | { USB_DEVICE(VENDOR_ID_GTCO, PID_400) }, |
95 | { USB_DEVICE(VENDOR_ID_GTCO, PID_401) }, | |
96 | { USB_DEVICE(VENDOR_ID_GTCO, PID_1000) }, | |
97 | { USB_DEVICE(VENDOR_ID_GTCO, PID_1001) }, | |
98 | { USB_DEVICE(VENDOR_ID_GTCO, PID_1002) }, | |
99 | { } | |
100 | }; | |
101 | MODULE_DEVICE_TABLE (usb, gtco_usbid_table); | |
102 | ||
103 | ||
104 | /* Structure to hold all of our device specific stuff */ | |
105 | struct gtco { | |
106 | ||
107 | struct input_dev *inputdevice; /* input device struct pointer */ | |
108 | struct usb_device *usbdev; /* the usb device for this device */ | |
109 | struct urb *urbinfo; /* urb for incoming reports */ | |
110 | dma_addr_t buf_dma; /* dma addr of the data buffer*/ | |
111 | unsigned char * buffer; /* databuffer for reports */ | |
112 | ||
113 | char usbpath[PATHLENGTH]; | |
114 | int openCount; | |
115 | ||
116 | /* Information pulled from Report Descriptor */ | |
117 | u32 usage; | |
118 | u32 min_X; | |
119 | u32 max_X; | |
120 | u32 min_Y; | |
121 | u32 max_Y; | |
122 | s8 mintilt_X; | |
123 | s8 maxtilt_X; | |
124 | s8 mintilt_Y; | |
125 | s8 maxtilt_Y; | |
126 | u32 maxpressure; | |
127 | u32 minpressure; | |
128 | }; | |
129 | ||
130 | ||
131 | ||
132 | /* Code for parsing the HID REPORT DESCRIPTOR */ | |
133 | ||
134 | /* From HID1.11 spec */ | |
135 | struct hid_descriptor | |
136 | { | |
137 | struct usb_descriptor_header header; | |
138 | __le16 bcdHID; | |
139 | u8 bCountryCode; | |
140 | u8 bNumDescriptors; | |
141 | u8 bDescriptorType; | |
142 | __le16 wDescriptorLength; | |
143 | } __attribute__ ((packed)); | |
144 | ||
145 | ||
146 | #define HID_DESCRIPTOR_SIZE 9 | |
147 | #define HID_DEVICE_TYPE 33 | |
148 | #define REPORT_DEVICE_TYPE 34 | |
149 | ||
150 | ||
151 | #define PREF_TAG(x) ((x)>>4) | |
152 | #define PREF_TYPE(x) ((x>>2)&0x03) | |
153 | #define PREF_SIZE(x) ((x)&0x03) | |
154 | ||
155 | #define TYPE_MAIN 0 | |
156 | #define TYPE_GLOBAL 1 | |
157 | #define TYPE_LOCAL 2 | |
158 | #define TYPE_RESERVED 3 | |
159 | ||
160 | #define TAG_MAIN_INPUT 0x8 | |
161 | #define TAG_MAIN_OUTPUT 0x9 | |
162 | #define TAG_MAIN_FEATURE 0xB | |
163 | #define TAG_MAIN_COL_START 0xA | |
164 | #define TAG_MAIN_COL_END 0xC | |
165 | ||
166 | #define TAG_GLOB_USAGE 0 | |
167 | #define TAG_GLOB_LOG_MIN 1 | |
168 | #define TAG_GLOB_LOG_MAX 2 | |
169 | #define TAG_GLOB_PHYS_MIN 3 | |
170 | #define TAG_GLOB_PHYS_MAX 4 | |
171 | #define TAG_GLOB_UNIT_EXP 5 | |
172 | #define TAG_GLOB_UNIT 6 | |
173 | #define TAG_GLOB_REPORT_SZ 7 | |
174 | #define TAG_GLOB_REPORT_ID 8 | |
175 | #define TAG_GLOB_REPORT_CNT 9 | |
176 | #define TAG_GLOB_PUSH 10 | |
177 | #define TAG_GLOB_POP 11 | |
178 | ||
179 | #define TAG_GLOB_MAX 12 | |
180 | ||
181 | #define DIGITIZER_USAGE_TIP_PRESSURE 0x30 | |
182 | #define DIGITIZER_USAGE_TILT_X 0x3D | |
183 | #define DIGITIZER_USAGE_TILT_Y 0x3E | |
184 | ||
185 | ||
186 | /* | |
a19ceb56 JR |
187 | * This is an abbreviated parser for the HID Report Descriptor. We |
188 | * know what devices we are talking to, so this is by no means meant | |
189 | * to be generic. We can make some safe assumptions: | |
190 | * | |
191 | * - We know there are no LONG tags, all short | |
192 | * - We know that we have no MAIN Feature and MAIN Output items | |
193 | * - We know what the IRQ reports are supposed to look like. | |
194 | * | |
195 | * The main purpose of this is to use the HID report desc to figure | |
196 | * out the mins and maxs of the fields in the IRQ reports. The IRQ | |
197 | * reports for 400/401 change slightly if the max X is bigger than 64K. | |
198 | * | |
199 | */ | |
200 | static void parse_hid_report_descriptor(struct gtco *device, char * report, | |
201 | int length) | |
202 | { | |
1b726a02 | 203 | int x, i = 0; |
a19ceb56 JR |
204 | |
205 | /* Tag primitive vars */ | |
206 | __u8 prefix; | |
207 | __u8 size; | |
208 | __u8 tag; | |
209 | __u8 type; | |
210 | __u8 data = 0; | |
211 | __u16 data16 = 0; | |
212 | __u32 data32 = 0; | |
213 | ||
a19ceb56 JR |
214 | /* For parsing logic */ |
215 | int inputnum = 0; | |
216 | __u32 usage = 0; | |
217 | ||
218 | /* Global Values, indexed by TAG */ | |
219 | __u32 globalval[TAG_GLOB_MAX]; | |
220 | __u32 oldval[TAG_GLOB_MAX]; | |
221 | ||
222 | /* Debug stuff */ | |
bc95f366 | 223 | char maintype = 'x'; |
a19ceb56 | 224 | char globtype[12]; |
1b726a02 DT |
225 | int indent = 0; |
226 | char indentstr[10] = ""; | |
a19ceb56 JR |
227 | |
228 | ||
229 | dbg("======>>>>>>PARSE<<<<<<======"); | |
230 | ||
231 | /* Walk this report and pull out the info we need */ | |
1b726a02 DT |
232 | while (i < length) { |
233 | prefix = report[i]; | |
a19ceb56 JR |
234 | |
235 | /* Skip over prefix */ | |
236 | i++; | |
237 | ||
238 | /* Determine data size and save the data in the proper variable */ | |
239 | size = PREF_SIZE(prefix); | |
1b726a02 | 240 | switch (size) { |
a19ceb56 JR |
241 | case 1: |
242 | data = report[i]; | |
243 | break; | |
244 | case 2: | |
858ad08c | 245 | data16 = get_unaligned_le16(&report[i]); |
a19ceb56 JR |
246 | break; |
247 | case 3: | |
248 | size = 4; | |
858ad08c | 249 | data32 = get_unaligned_le32(&report[i]); |
1b726a02 | 250 | break; |
a19ceb56 JR |
251 | } |
252 | ||
253 | /* Skip size of data */ | |
1b726a02 | 254 | i += size; |
a19ceb56 JR |
255 | |
256 | /* What we do depends on the tag type */ | |
257 | tag = PREF_TAG(prefix); | |
258 | type = PREF_TYPE(prefix); | |
1b726a02 | 259 | switch (type) { |
a19ceb56 | 260 | case TYPE_MAIN: |
1b726a02 DT |
261 | strcpy(globtype, ""); |
262 | switch (tag) { | |
a19ceb56 JR |
263 | |
264 | case TAG_MAIN_INPUT: | |
265 | /* | |
266 | * The INPUT MAIN tag signifies this is | |
267 | * information from a report. We need to | |
268 | * figure out what it is and store the | |
269 | * min/max values | |
270 | */ | |
271 | ||
1b726a02 DT |
272 | maintype = 'I'; |
273 | if (data == 2) | |
274 | strcpy(globtype, "Variable"); | |
275 | else if (data == 3) | |
276 | strcpy(globtype, "Var|Const"); | |
a19ceb56 JR |
277 | |
278 | dbg("::::: Saving Report: %d input #%d Max: 0x%X(%d) Min:0x%X(%d) of %d bits", | |
1b726a02 DT |
279 | globalval[TAG_GLOB_REPORT_ID], inputnum, |
280 | globalval[TAG_GLOB_LOG_MAX], globalval[TAG_GLOB_LOG_MAX], | |
281 | globalval[TAG_GLOB_LOG_MIN], globalval[TAG_GLOB_LOG_MIN], | |
282 | globalval[TAG_GLOB_REPORT_SZ] * globalval[TAG_GLOB_REPORT_CNT]); | |
a19ceb56 JR |
283 | |
284 | ||
285 | /* | |
286 | We can assume that the first two input items | |
287 | are always the X and Y coordinates. After | |
288 | that, we look for everything else by | |
289 | local usage value | |
290 | */ | |
1b726a02 | 291 | switch (inputnum) { |
a19ceb56 | 292 | case 0: /* X coord */ |
1b726a02 DT |
293 | dbg("GER: X Usage: 0x%x", usage); |
294 | if (device->max_X == 0) { | |
a19ceb56 JR |
295 | device->max_X = globalval[TAG_GLOB_LOG_MAX]; |
296 | device->min_X = globalval[TAG_GLOB_LOG_MIN]; | |
297 | } | |
a19ceb56 | 298 | break; |
1b726a02 | 299 | |
a19ceb56 | 300 | case 1: /* Y coord */ |
1b726a02 DT |
301 | dbg("GER: Y Usage: 0x%x", usage); |
302 | if (device->max_Y == 0) { | |
a19ceb56 JR |
303 | device->max_Y = globalval[TAG_GLOB_LOG_MAX]; |
304 | device->min_Y = globalval[TAG_GLOB_LOG_MIN]; | |
305 | } | |
306 | break; | |
1b726a02 | 307 | |
a19ceb56 JR |
308 | default: |
309 | /* Tilt X */ | |
1b726a02 DT |
310 | if (usage == DIGITIZER_USAGE_TILT_X) { |
311 | if (device->maxtilt_X == 0) { | |
a19ceb56 JR |
312 | device->maxtilt_X = globalval[TAG_GLOB_LOG_MAX]; |
313 | device->mintilt_X = globalval[TAG_GLOB_LOG_MIN]; | |
314 | } | |
315 | } | |
316 | ||
317 | /* Tilt Y */ | |
1b726a02 DT |
318 | if (usage == DIGITIZER_USAGE_TILT_Y) { |
319 | if (device->maxtilt_Y == 0) { | |
a19ceb56 JR |
320 | device->maxtilt_Y = globalval[TAG_GLOB_LOG_MAX]; |
321 | device->mintilt_Y = globalval[TAG_GLOB_LOG_MIN]; | |
322 | } | |
323 | } | |
324 | ||
a19ceb56 | 325 | /* Pressure */ |
1b726a02 DT |
326 | if (usage == DIGITIZER_USAGE_TIP_PRESSURE) { |
327 | if (device->maxpressure == 0) { | |
a19ceb56 JR |
328 | device->maxpressure = globalval[TAG_GLOB_LOG_MAX]; |
329 | device->minpressure = globalval[TAG_GLOB_LOG_MIN]; | |
330 | } | |
331 | } | |
332 | ||
333 | break; | |
334 | } | |
335 | ||
336 | inputnum++; | |
a19ceb56 | 337 | break; |
1b726a02 | 338 | |
a19ceb56 | 339 | case TAG_MAIN_OUTPUT: |
1b726a02 | 340 | maintype = 'O'; |
a19ceb56 | 341 | break; |
1b726a02 | 342 | |
a19ceb56 | 343 | case TAG_MAIN_FEATURE: |
1b726a02 | 344 | maintype = 'F'; |
a19ceb56 | 345 | break; |
1b726a02 | 346 | |
a19ceb56 | 347 | case TAG_MAIN_COL_START: |
1b726a02 | 348 | maintype = 'S'; |
a19ceb56 | 349 | |
1b726a02 | 350 | if (data == 0) { |
a19ceb56 | 351 | dbg("======>>>>>> Physical"); |
1b726a02 DT |
352 | strcpy(globtype, "Physical"); |
353 | } else | |
a19ceb56 | 354 | dbg("======>>>>>>"); |
a19ceb56 JR |
355 | |
356 | /* Indent the debug output */ | |
357 | indent++; | |
1b726a02 DT |
358 | for (x = 0; x < indent; x++) |
359 | indentstr[x] = '-'; | |
360 | indentstr[x] = 0; | |
a19ceb56 JR |
361 | |
362 | /* Save global tags */ | |
1b726a02 | 363 | for (x = 0; x < TAG_GLOB_MAX; x++) |
a19ceb56 | 364 | oldval[x] = globalval[x]; |
a19ceb56 JR |
365 | |
366 | break; | |
1b726a02 | 367 | |
a19ceb56 JR |
368 | case TAG_MAIN_COL_END: |
369 | dbg("<<<<<<======"); | |
1b726a02 | 370 | maintype = 'E'; |
a19ceb56 | 371 | indent--; |
1b726a02 DT |
372 | for (x = 0; x < indent; x++) |
373 | indentstr[x] = '-'; | |
374 | indentstr[x] = 0; | |
a19ceb56 JR |
375 | |
376 | /* Copy global tags back */ | |
1b726a02 | 377 | for (x = 0; x < TAG_GLOB_MAX; x++) |
a19ceb56 | 378 | globalval[x] = oldval[x]; |
a19ceb56 JR |
379 | |
380 | break; | |
381 | } | |
382 | ||
1b726a02 | 383 | switch (size) { |
a19ceb56 JR |
384 | case 1: |
385 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", | |
1b726a02 | 386 | indentstr, tag, maintype, size, globtype, data); |
a19ceb56 | 387 | break; |
1b726a02 | 388 | |
a19ceb56 JR |
389 | case 2: |
390 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", | |
1b726a02 | 391 | indentstr, tag, maintype, size, globtype, data16); |
a19ceb56 | 392 | break; |
1b726a02 | 393 | |
a19ceb56 JR |
394 | case 4: |
395 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", | |
1b726a02 | 396 | indentstr, tag, maintype, size, globtype, data32); |
a19ceb56 JR |
397 | break; |
398 | } | |
399 | break; | |
1b726a02 | 400 | |
a19ceb56 | 401 | case TYPE_GLOBAL: |
1b726a02 | 402 | switch (tag) { |
a19ceb56 JR |
403 | case TAG_GLOB_USAGE: |
404 | /* | |
405 | * First time we hit the global usage tag, | |
406 | * it should tell us the type of device | |
407 | */ | |
1b726a02 | 408 | if (device->usage == 0) |
a19ceb56 | 409 | device->usage = data; |
1b726a02 DT |
410 | |
411 | strcpy(globtype, "USAGE"); | |
a19ceb56 | 412 | break; |
1b726a02 DT |
413 | |
414 | case TAG_GLOB_LOG_MIN: | |
415 | strcpy(globtype, "LOG_MIN"); | |
a19ceb56 | 416 | break; |
1b726a02 DT |
417 | |
418 | case TAG_GLOB_LOG_MAX: | |
419 | strcpy(globtype, "LOG_MAX"); | |
a19ceb56 | 420 | break; |
1b726a02 DT |
421 | |
422 | case TAG_GLOB_PHYS_MIN: | |
423 | strcpy(globtype, "PHYS_MIN"); | |
a19ceb56 | 424 | break; |
1b726a02 DT |
425 | |
426 | case TAG_GLOB_PHYS_MAX: | |
427 | strcpy(globtype, "PHYS_MAX"); | |
a19ceb56 | 428 | break; |
1b726a02 DT |
429 | |
430 | case TAG_GLOB_UNIT_EXP: | |
431 | strcpy(globtype, "EXP"); | |
a19ceb56 | 432 | break; |
1b726a02 DT |
433 | |
434 | case TAG_GLOB_UNIT: | |
435 | strcpy(globtype, "UNIT"); | |
a19ceb56 | 436 | break; |
1b726a02 DT |
437 | |
438 | case TAG_GLOB_REPORT_SZ: | |
439 | strcpy(globtype, "REPORT_SZ"); | |
a19ceb56 | 440 | break; |
1b726a02 DT |
441 | |
442 | case TAG_GLOB_REPORT_ID: | |
443 | strcpy(globtype, "REPORT_ID"); | |
a19ceb56 | 444 | /* New report, restart numbering */ |
1b726a02 | 445 | inputnum = 0; |
a19ceb56 | 446 | break; |
1b726a02 | 447 | |
a19ceb56 | 448 | case TAG_GLOB_REPORT_CNT: |
1b726a02 | 449 | strcpy(globtype, "REPORT_CNT"); |
a19ceb56 | 450 | break; |
1b726a02 DT |
451 | |
452 | case TAG_GLOB_PUSH: | |
453 | strcpy(globtype, "PUSH"); | |
a19ceb56 | 454 | break; |
1b726a02 | 455 | |
a19ceb56 | 456 | case TAG_GLOB_POP: |
1b726a02 | 457 | strcpy(globtype, "POP"); |
a19ceb56 JR |
458 | break; |
459 | } | |
460 | ||
a19ceb56 JR |
461 | /* Check to make sure we have a good tag number |
462 | so we don't overflow array */ | |
1b726a02 DT |
463 | if (tag < TAG_GLOB_MAX) { |
464 | switch (size) { | |
a19ceb56 | 465 | case 1: |
1b726a02 DT |
466 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x", |
467 | indentstr, globtype, tag, size, data); | |
468 | globalval[tag] = data; | |
a19ceb56 | 469 | break; |
1b726a02 | 470 | |
a19ceb56 | 471 | case 2: |
1b726a02 DT |
472 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x", |
473 | indentstr, globtype, tag, size, data16); | |
474 | globalval[tag] = data16; | |
a19ceb56 | 475 | break; |
1b726a02 | 476 | |
a19ceb56 | 477 | case 4: |
1b726a02 DT |
478 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x", |
479 | indentstr, globtype, tag, size, data32); | |
480 | globalval[tag] = data32; | |
a19ceb56 JR |
481 | break; |
482 | } | |
1b726a02 | 483 | } else { |
a19ceb56 | 484 | dbg("%sGLOBALTAG: ILLEGAL TAG:%d SIZE: %d ", |
1b726a02 | 485 | indentstr, tag, size); |
a19ceb56 | 486 | } |
a19ceb56 JR |
487 | break; |
488 | ||
489 | case TYPE_LOCAL: | |
1b726a02 | 490 | switch (tag) { |
a19ceb56 | 491 | case TAG_GLOB_USAGE: |
1b726a02 | 492 | strcpy(globtype, "USAGE"); |
a19ceb56 JR |
493 | /* Always 1 byte */ |
494 | usage = data; | |
495 | break; | |
1b726a02 DT |
496 | |
497 | case TAG_GLOB_LOG_MIN: | |
498 | strcpy(globtype, "MIN"); | |
a19ceb56 | 499 | break; |
1b726a02 DT |
500 | |
501 | case TAG_GLOB_LOG_MAX: | |
502 | strcpy(globtype, "MAX"); | |
a19ceb56 | 503 | break; |
1b726a02 | 504 | |
a19ceb56 | 505 | default: |
1b726a02 DT |
506 | strcpy(globtype, "UNKNOWN"); |
507 | break; | |
a19ceb56 JR |
508 | } |
509 | ||
1b726a02 | 510 | switch (size) { |
a19ceb56 JR |
511 | case 1: |
512 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", | |
1b726a02 | 513 | indentstr, tag, globtype, size, data); |
a19ceb56 | 514 | break; |
1b726a02 | 515 | |
a19ceb56 JR |
516 | case 2: |
517 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", | |
1b726a02 | 518 | indentstr, tag, globtype, size, data16); |
a19ceb56 | 519 | break; |
1b726a02 | 520 | |
a19ceb56 JR |
521 | case 4: |
522 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", | |
1b726a02 | 523 | indentstr, tag, globtype, size, data32); |
a19ceb56 JR |
524 | break; |
525 | } | |
526 | ||
527 | break; | |
528 | } | |
a19ceb56 | 529 | } |
a19ceb56 JR |
530 | } |
531 | ||
a19ceb56 JR |
532 | /* INPUT DRIVER Routines */ |
533 | ||
a19ceb56 | 534 | /* |
1b726a02 DT |
535 | * Called when opening the input device. This will submit the URB to |
536 | * the usb system so we start getting reports | |
a19ceb56 JR |
537 | */ |
538 | static int gtco_input_open(struct input_dev *inputdev) | |
539 | { | |
7791bdae | 540 | struct gtco *device = input_get_drvdata(inputdev); |
a19ceb56 JR |
541 | |
542 | device->urbinfo->dev = device->usbdev; | |
1b726a02 | 543 | if (usb_submit_urb(device->urbinfo, GFP_KERNEL)) |
a19ceb56 | 544 | return -EIO; |
1b726a02 | 545 | |
a19ceb56 JR |
546 | return 0; |
547 | } | |
548 | ||
1b726a02 DT |
549 | /* |
550 | * Called when closing the input device. This will unlink the URB | |
551 | */ | |
a19ceb56 JR |
552 | static void gtco_input_close(struct input_dev *inputdev) |
553 | { | |
7791bdae | 554 | struct gtco *device = input_get_drvdata(inputdev); |
a19ceb56 JR |
555 | |
556 | usb_kill_urb(device->urbinfo); | |
a19ceb56 JR |
557 | } |
558 | ||
559 | ||
560 | /* | |
561 | * Setup input device capabilities. Tell the input system what this | |
562 | * device is capable of generating. | |
563 | * | |
564 | * This information is based on what is read from the HID report and | |
565 | * placed in the struct gtco structure | |
566 | * | |
567 | */ | |
7791bdae | 568 | static void gtco_setup_caps(struct input_dev *inputdev) |
a19ceb56 | 569 | { |
7791bdae | 570 | struct gtco *device = input_get_drvdata(inputdev); |
a19ceb56 | 571 | |
a19ceb56 | 572 | /* Which events */ |
7b19ada2 JS |
573 | inputdev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS) | |
574 | BIT_MASK(EV_MSC); | |
a19ceb56 | 575 | |
a19ceb56 | 576 | /* Misc event menu block */ |
7b19ada2 JS |
577 | inputdev->mscbit[0] = BIT_MASK(MSC_SCAN) | BIT_MASK(MSC_SERIAL) | |
578 | BIT_MASK(MSC_RAW); | |
a19ceb56 | 579 | |
a19ceb56 JR |
580 | /* Absolute values based on HID report info */ |
581 | input_set_abs_params(inputdev, ABS_X, device->min_X, device->max_X, | |
582 | 0, 0); | |
583 | input_set_abs_params(inputdev, ABS_Y, device->min_Y, device->max_Y, | |
584 | 0, 0); | |
585 | ||
586 | /* Proximity */ | |
587 | input_set_abs_params(inputdev, ABS_DISTANCE, 0, 1, 0, 0); | |
588 | ||
589 | /* Tilt & pressure */ | |
590 | input_set_abs_params(inputdev, ABS_TILT_X, device->mintilt_X, | |
591 | device->maxtilt_X, 0, 0); | |
592 | input_set_abs_params(inputdev, ABS_TILT_Y, device->mintilt_Y, | |
593 | device->maxtilt_Y, 0, 0); | |
594 | input_set_abs_params(inputdev, ABS_PRESSURE, device->minpressure, | |
595 | device->maxpressure, 0, 0); | |
596 | ||
a19ceb56 | 597 | /* Transducer */ |
1b726a02 | 598 | input_set_abs_params(inputdev, ABS_MISC, 0, 0xFF, 0, 0); |
a19ceb56 JR |
599 | } |
600 | ||
a19ceb56 JR |
601 | /* USB Routines */ |
602 | ||
a19ceb56 JR |
603 | /* |
604 | * URB callback routine. Called when we get IRQ reports from the | |
605 | * digitizer. | |
606 | * | |
607 | * This bridges the USB and input device worlds. It generates events | |
608 | * on the input device based on the USB reports. | |
609 | */ | |
610 | static void gtco_urb_callback(struct urb *urbinfo) | |
611 | { | |
1b726a02 | 612 | struct gtco *device = urbinfo->context; |
a19ceb56 JR |
613 | struct input_dev *inputdev; |
614 | int rc; | |
615 | u32 val = 0; | |
616 | s8 valsigned = 0; | |
617 | char le_buffer[2]; | |
618 | ||
619 | inputdev = device->inputdevice; | |
620 | ||
a19ceb56 | 621 | /* Was callback OK? */ |
1b726a02 DT |
622 | if (urbinfo->status == -ECONNRESET || |
623 | urbinfo->status == -ENOENT || | |
624 | urbinfo->status == -ESHUTDOWN) { | |
a19ceb56 JR |
625 | |
626 | /* Shutdown is occurring. Return and don't queue up any more */ | |
627 | return; | |
628 | } | |
629 | ||
1b726a02 DT |
630 | if (urbinfo->status != 0) { |
631 | /* | |
632 | * Some unknown error. Hopefully temporary. Just go and | |
633 | * requeue an URB | |
634 | */ | |
a19ceb56 JR |
635 | goto resubmit; |
636 | } | |
637 | ||
638 | /* | |
639 | * Good URB, now process | |
640 | */ | |
641 | ||
642 | /* PID dependent when we interpret the report */ | |
1b726a02 DT |
643 | if (inputdev->id.product == PID_1000 || |
644 | inputdev->id.product == PID_1001 || | |
645 | inputdev->id.product == PID_1002) { | |
a19ceb56 JR |
646 | |
647 | /* | |
648 | * Switch on the report ID | |
649 | * Conveniently, the reports have more information, the higher | |
650 | * the report number. We can just fall through the case | |
651 | * statements if we start with the highest number report | |
652 | */ | |
1b726a02 | 653 | switch (device->buffer[0]) { |
a19ceb56 JR |
654 | case 5: |
655 | /* Pressure is 9 bits */ | |
1b726a02 | 656 | val = ((u16)(device->buffer[8]) << 1); |
a19ceb56 JR |
657 | val |= (u16)(device->buffer[7] >> 7); |
658 | input_report_abs(inputdev, ABS_PRESSURE, | |
659 | device->buffer[8]); | |
660 | ||
661 | /* Mask out the Y tilt value used for pressure */ | |
662 | device->buffer[7] = (u8)((device->buffer[7]) & 0x7F); | |
663 | ||
a19ceb56 JR |
664 | /* Fall thru */ |
665 | case 4: | |
666 | /* Tilt */ | |
667 | ||
668 | /* Sign extend these 7 bit numbers. */ | |
669 | if (device->buffer[6] & 0x40) | |
670 | device->buffer[6] |= 0x80; | |
671 | ||
672 | if (device->buffer[7] & 0x40) | |
673 | device->buffer[7] |= 0x80; | |
674 | ||
675 | ||
676 | valsigned = (device->buffer[6]); | |
677 | input_report_abs(inputdev, ABS_TILT_X, (s32)valsigned); | |
678 | ||
679 | valsigned = (device->buffer[7]); | |
680 | input_report_abs(inputdev, ABS_TILT_Y, (s32)valsigned); | |
681 | ||
682 | /* Fall thru */ | |
a19ceb56 JR |
683 | case 2: |
684 | case 3: | |
685 | /* Convert buttons, only 5 bits possible */ | |
1b726a02 | 686 | val = (device->buffer[5]) & MASK_BUTTON; |
a19ceb56 JR |
687 | |
688 | /* We don't apply any meaning to the bitmask, | |
689 | just report */ | |
690 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); | |
691 | ||
692 | /* Fall thru */ | |
693 | case 1: | |
a19ceb56 | 694 | /* All reports have X and Y coords in the same place */ |
858ad08c | 695 | val = get_unaligned_le16(&device->buffer[1]); |
a19ceb56 JR |
696 | input_report_abs(inputdev, ABS_X, val); |
697 | ||
858ad08c | 698 | val = get_unaligned_le16(&device->buffer[3]); |
a19ceb56 JR |
699 | input_report_abs(inputdev, ABS_Y, val); |
700 | ||
a19ceb56 | 701 | /* Ditto for proximity bit */ |
1b726a02 | 702 | val = device->buffer[5] & MASK_INRANGE ? 1 : 0; |
a19ceb56 JR |
703 | input_report_abs(inputdev, ABS_DISTANCE, val); |
704 | ||
a19ceb56 JR |
705 | /* Report 1 is an exception to how we handle buttons */ |
706 | /* Buttons are an index, not a bitmask */ | |
1b726a02 | 707 | if (device->buffer[0] == 1) { |
a19ceb56 | 708 | |
1b726a02 DT |
709 | /* |
710 | * Convert buttons, 5 bit index | |
711 | * Report value of index set as one, | |
712 | * the rest as 0 | |
713 | */ | |
714 | val = device->buffer[5] & MASK_BUTTON; | |
a19ceb56 | 715 | dbg("======>>>>>>REPORT 1: val 0x%X(%d)", |
1b726a02 | 716 | val, val); |
a19ceb56 JR |
717 | |
718 | /* | |
719 | * We don't apply any meaning to the button | |
720 | * index, just report it | |
721 | */ | |
722 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); | |
a19ceb56 | 723 | } |
a19ceb56 | 724 | break; |
1b726a02 | 725 | |
a19ceb56 JR |
726 | case 7: |
727 | /* Menu blocks */ | |
728 | input_event(inputdev, EV_MSC, MSC_SCAN, | |
729 | device->buffer[1]); | |
a19ceb56 | 730 | break; |
a19ceb56 | 731 | } |
a19ceb56 | 732 | } |
1b726a02 | 733 | |
a19ceb56 | 734 | /* Other pid class */ |
1b726a02 DT |
735 | if (inputdev->id.product == PID_400 || |
736 | inputdev->id.product == PID_401) { | |
a19ceb56 JR |
737 | |
738 | /* Report 2 */ | |
1b726a02 | 739 | if (device->buffer[0] == 2) { |
a19ceb56 | 740 | /* Menu blocks */ |
1b726a02 | 741 | input_event(inputdev, EV_MSC, MSC_SCAN, device->buffer[1]); |
a19ceb56 JR |
742 | } |
743 | ||
744 | /* Report 1 */ | |
1b726a02 | 745 | if (device->buffer[0] == 1) { |
a19ceb56 JR |
746 | char buttonbyte; |
747 | ||
a19ceb56 | 748 | /* IF X max > 64K, we still a bit from the y report */ |
1b726a02 | 749 | if (device->max_X > 0x10000) { |
a19ceb56 | 750 | |
1b726a02 DT |
751 | val = (u16)(((u16)(device->buffer[2] << 8)) | (u8)device->buffer[1]); |
752 | val |= (u32)(((u8)device->buffer[3] & 0x1) << 16); | |
a19ceb56 JR |
753 | |
754 | input_report_abs(inputdev, ABS_X, val); | |
755 | ||
1b726a02 DT |
756 | le_buffer[0] = (u8)((u8)(device->buffer[3]) >> 1); |
757 | le_buffer[0] |= (u8)((device->buffer[3] & 0x1) << 7); | |
a19ceb56 | 758 | |
1b726a02 DT |
759 | le_buffer[1] = (u8)(device->buffer[4] >> 1); |
760 | le_buffer[1] |= (u8)((device->buffer[5] & 0x1) << 7); | |
a19ceb56 | 761 | |
858ad08c | 762 | val = get_unaligned_le16(le_buffer); |
a19ceb56 JR |
763 | input_report_abs(inputdev, ABS_Y, val); |
764 | ||
a19ceb56 JR |
765 | /* |
766 | * Shift the button byte right by one to | |
767 | * make it look like the standard report | |
768 | */ | |
1b726a02 DT |
769 | buttonbyte = device->buffer[5] >> 1; |
770 | } else { | |
a19ceb56 | 771 | |
858ad08c | 772 | val = get_unaligned_le16(&device->buffer[1]); |
a19ceb56 JR |
773 | input_report_abs(inputdev, ABS_X, val); |
774 | ||
858ad08c | 775 | val = get_unaligned_le16(&device->buffer[3]); |
a19ceb56 JR |
776 | input_report_abs(inputdev, ABS_Y, val); |
777 | ||
778 | buttonbyte = device->buffer[5]; | |
a19ceb56 JR |
779 | } |
780 | ||
a19ceb56 | 781 | /* BUTTONS and PROXIMITY */ |
1b726a02 | 782 | val = buttonbyte & MASK_INRANGE ? 1 : 0; |
a19ceb56 JR |
783 | input_report_abs(inputdev, ABS_DISTANCE, val); |
784 | ||
785 | /* Convert buttons, only 4 bits possible */ | |
1b726a02 | 786 | val = buttonbyte & 0x0F; |
a19ceb56 | 787 | #ifdef USE_BUTTONS |
1b726a02 DT |
788 | for (i = 0; i < 5; i++) |
789 | input_report_key(inputdev, BTN_DIGI + i, val & (1 << i)); | |
a19ceb56 JR |
790 | #else |
791 | /* We don't apply any meaning to the bitmask, just report */ | |
792 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); | |
793 | #endif | |
1b726a02 | 794 | |
a19ceb56 JR |
795 | /* TRANSDUCER */ |
796 | input_report_abs(inputdev, ABS_MISC, device->buffer[6]); | |
a19ceb56 JR |
797 | } |
798 | } | |
799 | ||
800 | /* Everybody gets report ID's */ | |
801 | input_event(inputdev, EV_MSC, MSC_RAW, device->buffer[0]); | |
802 | ||
803 | /* Sync it up */ | |
804 | input_sync(inputdev); | |
805 | ||
806 | resubmit: | |
807 | rc = usb_submit_urb(urbinfo, GFP_ATOMIC); | |
1b726a02 | 808 | if (rc != 0) |
88d5ab3a | 809 | dev_err(&inputdev->dev, |
3bd9597a | 810 | "usb_submit_urb failed rc=0x%x\n", rc); |
a19ceb56 JR |
811 | } |
812 | ||
813 | /* | |
814 | * The probe routine. This is called when the kernel find the matching USB | |
815 | * vendor/product. We do the following: | |
816 | * | |
817 | * - Allocate mem for a local structure to manage the device | |
818 | * - Request a HID Report Descriptor from the device and parse it to | |
819 | * find out the device parameters | |
820 | * - Create an input device and assign it attributes | |
821 | * - Allocate an URB so the device can talk to us when the input | |
822 | * queue is open | |
823 | */ | |
824 | static int gtco_probe(struct usb_interface *usbinterface, | |
825 | const struct usb_device_id *id) | |
826 | { | |
827 | ||
1b726a02 DT |
828 | struct gtco *gtco; |
829 | struct input_dev *input_dev; | |
a19ceb56 | 830 | struct hid_descriptor *hid_desc; |
501a5250 | 831 | char *report; |
1b726a02 DT |
832 | int result = 0, retry; |
833 | int error; | |
a19ceb56 JR |
834 | struct usb_endpoint_descriptor *endpoint; |
835 | ||
836 | /* Allocate memory for device structure */ | |
1b726a02 DT |
837 | gtco = kzalloc(sizeof(struct gtco), GFP_KERNEL); |
838 | input_dev = input_allocate_device(); | |
839 | if (!gtco || !input_dev) { | |
3bd9597a | 840 | dev_err(&usbinterface->dev, "No more memory\n"); |
1b726a02 DT |
841 | error = -ENOMEM; |
842 | goto err_free_devs; | |
a19ceb56 JR |
843 | } |
844 | ||
1b726a02 DT |
845 | /* Set pointer to the input device */ |
846 | gtco->inputdevice = input_dev; | |
a19ceb56 JR |
847 | |
848 | /* Save interface information */ | |
1b726a02 | 849 | gtco->usbdev = usb_get_dev(interface_to_usbdev(usbinterface)); |
a19ceb56 JR |
850 | |
851 | /* Allocate some data for incoming reports */ | |
997ea58e DM |
852 | gtco->buffer = usb_alloc_coherent(gtco->usbdev, REPORT_MAX_SIZE, |
853 | GFP_KERNEL, >co->buf_dma); | |
1b726a02 | 854 | if (!gtco->buffer) { |
3bd9597a | 855 | dev_err(&usbinterface->dev, "No more memory for us buffers\n"); |
1b726a02 DT |
856 | error = -ENOMEM; |
857 | goto err_free_devs; | |
a19ceb56 JR |
858 | } |
859 | ||
860 | /* Allocate URB for reports */ | |
1b726a02 DT |
861 | gtco->urbinfo = usb_alloc_urb(0, GFP_KERNEL); |
862 | if (!gtco->urbinfo) { | |
3bd9597a | 863 | dev_err(&usbinterface->dev, "Failed to allocate URB\n"); |
f4bc95d7 | 864 | error = -ENOMEM; |
1b726a02 | 865 | goto err_free_buf; |
a19ceb56 JR |
866 | } |
867 | ||
a19ceb56 JR |
868 | /* |
869 | * The endpoint is always altsetting 0, we know this since we know | |
870 | * this device only has one interrupt endpoint | |
871 | */ | |
872 | endpoint = &usbinterface->altsetting[0].endpoint[0].desc; | |
873 | ||
874 | /* Some debug */ | |
1b726a02 DT |
875 | dbg("gtco # interfaces: %d", usbinterface->num_altsetting); |
876 | dbg("num endpoints: %d", usbinterface->cur_altsetting->desc.bNumEndpoints); | |
877 | dbg("interface class: %d", usbinterface->cur_altsetting->desc.bInterfaceClass); | |
878 | dbg("endpoint: attribute:0x%x type:0x%x", endpoint->bmAttributes, endpoint->bDescriptorType); | |
e941da31 | 879 | if (usb_endpoint_xfer_int(endpoint)) |
a19ceb56 JR |
880 | dbg("endpoint: we have interrupt endpoint\n"); |
881 | ||
1b726a02 | 882 | dbg("endpoint extra len:%d ", usbinterface->altsetting[0].extralen); |
a19ceb56 JR |
883 | |
884 | /* | |
885 | * Find the HID descriptor so we can find out the size of the | |
886 | * HID report descriptor | |
887 | */ | |
888 | if (usb_get_extra_descriptor(usbinterface->cur_altsetting, | |
1b726a02 | 889 | HID_DEVICE_TYPE, &hid_desc) != 0){ |
3bd9597a GKH |
890 | dev_err(&usbinterface->dev, |
891 | "Can't retrieve exta USB descriptor to get hid report descriptor length\n"); | |
1b726a02 DT |
892 | error = -EIO; |
893 | goto err_free_urb; | |
a19ceb56 JR |
894 | } |
895 | ||
896 | dbg("Extra descriptor success: type:%d len:%d", | |
897 | hid_desc->bDescriptorType, hid_desc->wDescriptorLength); | |
898 | ||
6b8588f7 | 899 | report = kzalloc(le16_to_cpu(hid_desc->wDescriptorLength), GFP_KERNEL); |
1b726a02 | 900 | if (!report) { |
3bd9597a | 901 | dev_err(&usbinterface->dev, "No more memory for report\n"); |
1b726a02 DT |
902 | error = -ENOMEM; |
903 | goto err_free_urb; | |
a19ceb56 JR |
904 | } |
905 | ||
906 | /* Couple of tries to get reply */ | |
1b726a02 DT |
907 | for (retry = 0; retry < 3; retry++) { |
908 | result = usb_control_msg(gtco->usbdev, | |
909 | usb_rcvctrlpipe(gtco->usbdev, 0), | |
a19ceb56 JR |
910 | USB_REQ_GET_DESCRIPTOR, |
911 | USB_RECIP_INTERFACE | USB_DIR_IN, | |
1b726a02 | 912 | REPORT_DEVICE_TYPE << 8, |
a19ceb56 JR |
913 | 0, /* interface */ |
914 | report, | |
6b8588f7 | 915 | le16_to_cpu(hid_desc->wDescriptorLength), |
a19ceb56 JR |
916 | 5000); /* 5 secs */ |
917 | ||
501a5250 DT |
918 | dbg("usb_control_msg result: %d", result); |
919 | if (result == le16_to_cpu(hid_desc->wDescriptorLength)) { | |
920 | parse_hid_report_descriptor(gtco, report, result); | |
a19ceb56 | 921 | break; |
501a5250 | 922 | } |
a19ceb56 JR |
923 | } |
924 | ||
501a5250 DT |
925 | kfree(report); |
926 | ||
a19ceb56 | 927 | /* If we didn't get the report, fail */ |
6b8588f7 | 928 | if (result != le16_to_cpu(hid_desc->wDescriptorLength)) { |
3bd9597a GKH |
929 | dev_err(&usbinterface->dev, |
930 | "Failed to get HID Report Descriptor of size: %d\n", | |
931 | hid_desc->wDescriptorLength); | |
1b726a02 DT |
932 | error = -EIO; |
933 | goto err_free_urb; | |
a19ceb56 JR |
934 | } |
935 | ||
a19ceb56 | 936 | /* Create a device file node */ |
1b726a02 DT |
937 | usb_make_path(gtco->usbdev, gtco->usbpath, sizeof(gtco->usbpath)); |
938 | strlcat(gtco->usbpath, "/input0", sizeof(gtco->usbpath)); | |
a19ceb56 JR |
939 | |
940 | /* Set Input device functions */ | |
1b726a02 DT |
941 | input_dev->open = gtco_input_open; |
942 | input_dev->close = gtco_input_close; | |
a19ceb56 JR |
943 | |
944 | /* Set input device information */ | |
1b726a02 DT |
945 | input_dev->name = "GTCO_CalComp"; |
946 | input_dev->phys = gtco->usbpath; | |
7791bdae DT |
947 | |
948 | input_set_drvdata(input_dev, gtco); | |
a19ceb56 JR |
949 | |
950 | /* Now set up all the input device capabilities */ | |
1b726a02 | 951 | gtco_setup_caps(input_dev); |
a19ceb56 JR |
952 | |
953 | /* Set input device required ID information */ | |
1b726a02 | 954 | usb_to_input_id(gtco->usbdev, &input_dev->id); |
c0f82d57 | 955 | input_dev->dev.parent = &usbinterface->dev; |
a19ceb56 JR |
956 | |
957 | /* Setup the URB, it will be posted later on open of input device */ | |
958 | endpoint = &usbinterface->altsetting[0].endpoint[0].desc; | |
959 | ||
1b726a02 DT |
960 | usb_fill_int_urb(gtco->urbinfo, |
961 | gtco->usbdev, | |
962 | usb_rcvintpipe(gtco->usbdev, | |
a19ceb56 | 963 | endpoint->bEndpointAddress), |
1b726a02 | 964 | gtco->buffer, |
a19ceb56 JR |
965 | REPORT_MAX_SIZE, |
966 | gtco_urb_callback, | |
1b726a02 | 967 | gtco, |
a19ceb56 JR |
968 | endpoint->bInterval); |
969 | ||
1b726a02 DT |
970 | gtco->urbinfo->transfer_dma = gtco->buf_dma; |
971 | gtco->urbinfo->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
a19ceb56 | 972 | |
1b726a02 DT |
973 | /* Save gtco pointer in USB interface gtco */ |
974 | usb_set_intfdata(usbinterface, gtco); | |
a19ceb56 JR |
975 | |
976 | /* All done, now register the input device */ | |
1b726a02 DT |
977 | error = input_register_device(input_dev); |
978 | if (error) | |
979 | goto err_free_urb; | |
a19ceb56 | 980 | |
a19ceb56 JR |
981 | return 0; |
982 | ||
1b726a02 DT |
983 | err_free_urb: |
984 | usb_free_urb(gtco->urbinfo); | |
985 | err_free_buf: | |
997ea58e DM |
986 | usb_free_coherent(gtco->usbdev, REPORT_MAX_SIZE, |
987 | gtco->buffer, gtco->buf_dma); | |
1b726a02 | 988 | err_free_devs: |
1b726a02 DT |
989 | input_free_device(input_dev); |
990 | kfree(gtco); | |
991 | return error; | |
a19ceb56 JR |
992 | } |
993 | ||
994 | /* | |
995 | * This function is a standard USB function called when the USB device | |
996 | * is disconnected. We will get rid of the URV, de-register the input | |
997 | * device, and free up allocated memory | |
998 | */ | |
999 | static void gtco_disconnect(struct usb_interface *interface) | |
1000 | { | |
a19ceb56 | 1001 | /* Grab private device ptr */ |
1b726a02 | 1002 | struct gtco *gtco = usb_get_intfdata(interface); |
a19ceb56 JR |
1003 | |
1004 | /* Now reverse all the registration stuff */ | |
1b726a02 DT |
1005 | if (gtco) { |
1006 | input_unregister_device(gtco->inputdevice); | |
1007 | usb_kill_urb(gtco->urbinfo); | |
1008 | usb_free_urb(gtco->urbinfo); | |
997ea58e DM |
1009 | usb_free_coherent(gtco->usbdev, REPORT_MAX_SIZE, |
1010 | gtco->buffer, gtco->buf_dma); | |
1b726a02 | 1011 | kfree(gtco); |
a19ceb56 JR |
1012 | } |
1013 | ||
899ef6e7 | 1014 | dev_info(&interface->dev, "gtco driver disconnected\n"); |
a19ceb56 JR |
1015 | } |
1016 | ||
a19ceb56 JR |
1017 | /* STANDARD MODULE LOAD ROUTINES */ |
1018 | ||
1019 | static struct usb_driver gtco_driverinfo_table = { | |
1b726a02 DT |
1020 | .name = "gtco", |
1021 | .id_table = gtco_usbid_table, | |
1022 | .probe = gtco_probe, | |
1023 | .disconnect = gtco_disconnect, | |
a19ceb56 | 1024 | }; |
1b726a02 | 1025 | |
08642e7c | 1026 | module_usb_driver(gtco_driverinfo_table); |
a19ceb56 | 1027 | |
32a676fe | 1028 | MODULE_DESCRIPTION("GTCO digitizer USB driver"); |
a19ceb56 | 1029 | MODULE_LICENSE("GPL"); |