diff options
Diffstat (limited to 'drivers/usb/misc/phidgetkit.c')
-rw-r--r-- | drivers/usb/misc/phidgetkit.c | 740 |
1 files changed, 0 insertions, 740 deletions
diff --git a/drivers/usb/misc/phidgetkit.c b/drivers/usb/misc/phidgetkit.c deleted file mode 100644 index cc8e0a926f99..000000000000 --- a/drivers/usb/misc/phidgetkit.c +++ /dev/null | |||
@@ -1,740 +0,0 @@ | |||
1 | /* | ||
2 | * USB PhidgetInterfaceKit driver 1.0 | ||
3 | * | ||
4 | * Copyright (C) 2004, 2006 Sean Young <sean@mess.org> | ||
5 | * Copyright (C) 2005 Daniel Saakes <daniel@saakes.net> | ||
6 | * Copyright (C) 2004 Greg Kroah-Hartman <greg@kroah.com> | ||
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 | * This is a driver for the USB PhidgetInterfaceKit. | ||
14 | */ | ||
15 | |||
16 | #include <linux/kernel.h> | ||
17 | #include <linux/errno.h> | ||
18 | #include <linux/init.h> | ||
19 | #include <linux/slab.h> | ||
20 | #include <linux/module.h> | ||
21 | #include <linux/usb.h> | ||
22 | |||
23 | #include "phidget.h" | ||
24 | |||
25 | #define DRIVER_AUTHOR "Sean Young <sean@mess.org>" | ||
26 | #define DRIVER_DESC "USB PhidgetInterfaceKit Driver" | ||
27 | |||
28 | #define USB_VENDOR_ID_GLAB 0x06c2 | ||
29 | #define USB_DEVICE_ID_INTERFACEKIT004 0x0040 | ||
30 | #define USB_DEVICE_ID_INTERFACEKIT01616 0x0044 | ||
31 | #define USB_DEVICE_ID_INTERFACEKIT888 0x0045 | ||
32 | #define USB_DEVICE_ID_INTERFACEKIT047 0x0051 | ||
33 | #define USB_DEVICE_ID_INTERFACEKIT088 0x0053 | ||
34 | |||
35 | #define USB_VENDOR_ID_WISEGROUP 0x0925 | ||
36 | #define USB_DEVICE_ID_INTERFACEKIT884 0x8201 | ||
37 | |||
38 | #define MAX_INTERFACES 16 | ||
39 | |||
40 | #define URB_INT_SIZE 8 | ||
41 | |||
42 | struct driver_interfacekit { | ||
43 | int sensors; | ||
44 | int inputs; | ||
45 | int outputs; | ||
46 | int has_lcd; | ||
47 | int amnesiac; | ||
48 | }; | ||
49 | |||
50 | #define ifkit(_sensors, _inputs, _outputs, _lcd, _amnesiac) \ | ||
51 | { \ | ||
52 | .sensors = _sensors, \ | ||
53 | .inputs = _inputs, \ | ||
54 | .outputs = _outputs, \ | ||
55 | .has_lcd = _lcd, \ | ||
56 | .amnesiac = _amnesiac \ | ||
57 | }; | ||
58 | |||
59 | static const struct driver_interfacekit ph_004 = ifkit(0, 0, 4, 0, 0); | ||
60 | static const struct driver_interfacekit ph_888n = ifkit(8, 8, 8, 0, 1); | ||
61 | static const struct driver_interfacekit ph_888o = ifkit(8, 8, 8, 0, 0); | ||
62 | static const struct driver_interfacekit ph_047 = ifkit(0, 4, 7, 1, 0); | ||
63 | static const struct driver_interfacekit ph_884 = ifkit(8, 8, 4, 0, 0); | ||
64 | static const struct driver_interfacekit ph_088 = ifkit(0, 8, 8, 1, 0); | ||
65 | static const struct driver_interfacekit ph_01616 = ifkit(0, 16, 16, 0, 0); | ||
66 | |||
67 | static unsigned long device_no; | ||
68 | |||
69 | struct interfacekit { | ||
70 | struct usb_device *udev; | ||
71 | struct usb_interface *intf; | ||
72 | struct driver_interfacekit *ifkit; | ||
73 | struct device *dev; | ||
74 | unsigned long outputs; | ||
75 | int dev_no; | ||
76 | u8 inputs[MAX_INTERFACES]; | ||
77 | u16 sensors[MAX_INTERFACES]; | ||
78 | u8 lcd_files_on; | ||
79 | |||
80 | struct urb *irq; | ||
81 | unsigned char *data; | ||
82 | dma_addr_t data_dma; | ||
83 | |||
84 | struct delayed_work do_notify; | ||
85 | struct delayed_work do_resubmit; | ||
86 | unsigned long input_events; | ||
87 | unsigned long sensor_events; | ||
88 | }; | ||
89 | |||
90 | static struct usb_device_id id_table[] = { | ||
91 | {USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT004), | ||
92 | .driver_info = (kernel_ulong_t)&ph_004}, | ||
93 | {USB_DEVICE_VER(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT888, 0, 0x814), | ||
94 | .driver_info = (kernel_ulong_t)&ph_888o}, | ||
95 | {USB_DEVICE_VER(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT888, 0x0815, 0xffff), | ||
96 | .driver_info = (kernel_ulong_t)&ph_888n}, | ||
97 | {USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT047), | ||
98 | .driver_info = (kernel_ulong_t)&ph_047}, | ||
99 | {USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT088), | ||
100 | .driver_info = (kernel_ulong_t)&ph_088}, | ||
101 | {USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT01616), | ||
102 | .driver_info = (kernel_ulong_t)&ph_01616}, | ||
103 | {USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_INTERFACEKIT884), | ||
104 | .driver_info = (kernel_ulong_t)&ph_884}, | ||
105 | {} | ||
106 | }; | ||
107 | MODULE_DEVICE_TABLE(usb, id_table); | ||
108 | |||
109 | static int set_outputs(struct interfacekit *kit) | ||
110 | { | ||
111 | u8 *buffer; | ||
112 | int retval; | ||
113 | |||
114 | buffer = kzalloc(4, GFP_KERNEL); | ||
115 | if (!buffer) { | ||
116 | dev_err(&kit->udev->dev, "%s - out of memory\n", __func__); | ||
117 | return -ENOMEM; | ||
118 | } | ||
119 | buffer[0] = (u8)kit->outputs; | ||
120 | buffer[1] = (u8)(kit->outputs >> 8); | ||
121 | |||
122 | dev_dbg(&kit->udev->dev, "sending data: 0x%04x\n", (u16)kit->outputs); | ||
123 | |||
124 | retval = usb_control_msg(kit->udev, | ||
125 | usb_sndctrlpipe(kit->udev, 0), | ||
126 | 0x09, 0x21, 0x0200, 0x0000, buffer, 4, 2000); | ||
127 | |||
128 | if (retval != 4) | ||
129 | dev_err(&kit->udev->dev, "usb_control_msg returned %d\n", | ||
130 | retval); | ||
131 | kfree(buffer); | ||
132 | |||
133 | if (kit->ifkit->amnesiac) | ||
134 | schedule_delayed_work(&kit->do_resubmit, HZ / 2); | ||
135 | |||
136 | return retval < 0 ? retval : 0; | ||
137 | } | ||
138 | |||
139 | static int change_string(struct interfacekit *kit, const char *display, unsigned char row) | ||
140 | { | ||
141 | unsigned char *buffer; | ||
142 | unsigned char *form_buffer; | ||
143 | int retval = -ENOMEM; | ||
144 | int i,j, len, buf_ptr; | ||
145 | |||
146 | buffer = kmalloc(8, GFP_KERNEL); | ||
147 | form_buffer = kmalloc(30, GFP_KERNEL); | ||
148 | if ((!buffer) || (!form_buffer)) { | ||
149 | dev_err(&kit->udev->dev, "%s - out of memory\n", __func__); | ||
150 | goto exit; | ||
151 | } | ||
152 | |||
153 | len = strlen(display); | ||
154 | if (len > 20) | ||
155 | len = 20; | ||
156 | |||
157 | dev_dbg(&kit->udev->dev, "Setting LCD line %d to %s\n", row, display); | ||
158 | |||
159 | form_buffer[0] = row * 0x40 + 0x80; | ||
160 | form_buffer[1] = 0x02; | ||
161 | buf_ptr = 2; | ||
162 | for (i = 0; i<len; i++) | ||
163 | form_buffer[buf_ptr++] = display[i]; | ||
164 | |||
165 | for (i = 0; i < (20 - len); i++) | ||
166 | form_buffer[buf_ptr++] = 0x20; | ||
167 | form_buffer[buf_ptr++] = 0x01; | ||
168 | form_buffer[buf_ptr++] = row * 0x40 + 0x80 + strlen(display); | ||
169 | |||
170 | for (i = 0; i < buf_ptr; i += 7) { | ||
171 | if ((buf_ptr - i) > 7) | ||
172 | len = 7; | ||
173 | else | ||
174 | len = (buf_ptr - i); | ||
175 | for (j = 0; j < len; j++) | ||
176 | buffer[j] = form_buffer[i + j]; | ||
177 | buffer[7] = len; | ||
178 | |||
179 | retval = usb_control_msg(kit->udev, | ||
180 | usb_sndctrlpipe(kit->udev, 0), | ||
181 | 0x09, 0x21, 0x0200, 0x0000, buffer, 8, 2000); | ||
182 | if (retval < 0) | ||
183 | goto exit; | ||
184 | } | ||
185 | |||
186 | retval = 0; | ||
187 | exit: | ||
188 | kfree(buffer); | ||
189 | kfree(form_buffer); | ||
190 | |||
191 | return retval; | ||
192 | } | ||
193 | |||
194 | #define set_lcd_line(number) \ | ||
195 | static ssize_t lcd_line_##number(struct device *dev, \ | ||
196 | struct device_attribute *attr, \ | ||
197 | const char *buf, size_t count) \ | ||
198 | { \ | ||
199 | struct interfacekit *kit = dev_get_drvdata(dev); \ | ||
200 | change_string(kit, buf, number - 1); \ | ||
201 | return count; \ | ||
202 | } | ||
203 | |||
204 | #define lcd_line_attr(number) \ | ||
205 | __ATTR(lcd_line_##number, S_IWUGO, NULL, lcd_line_##number) | ||
206 | |||
207 | set_lcd_line(1); | ||
208 | set_lcd_line(2); | ||
209 | |||
210 | static ssize_t set_backlight(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | ||
211 | { | ||
212 | struct interfacekit *kit = dev_get_drvdata(dev); | ||
213 | int enabled; | ||
214 | unsigned char *buffer; | ||
215 | int retval = -ENOMEM; | ||
216 | |||
217 | buffer = kzalloc(8, GFP_KERNEL); | ||
218 | if (!buffer) { | ||
219 | dev_err(&kit->udev->dev, "%s - out of memory\n", __func__); | ||
220 | goto exit; | ||
221 | } | ||
222 | |||
223 | if (sscanf(buf, "%d", &enabled) < 1) { | ||
224 | retval = -EINVAL; | ||
225 | goto exit; | ||
226 | } | ||
227 | if (enabled) | ||
228 | buffer[0] = 0x01; | ||
229 | buffer[7] = 0x11; | ||
230 | |||
231 | dev_dbg(&kit->udev->dev, "Setting backlight to %s\n", enabled ? "on" : "off"); | ||
232 | |||
233 | retval = usb_control_msg(kit->udev, | ||
234 | usb_sndctrlpipe(kit->udev, 0), | ||
235 | 0x09, 0x21, 0x0200, 0x0000, buffer, 8, 2000); | ||
236 | if (retval < 0) | ||
237 | goto exit; | ||
238 | |||
239 | retval = count; | ||
240 | exit: | ||
241 | kfree(buffer); | ||
242 | return retval; | ||
243 | } | ||
244 | |||
245 | static struct device_attribute dev_lcd_line_attrs[] = { | ||
246 | lcd_line_attr(1), | ||
247 | lcd_line_attr(2), | ||
248 | __ATTR(backlight, S_IWUGO, NULL, set_backlight) | ||
249 | }; | ||
250 | |||
251 | static void remove_lcd_files(struct interfacekit *kit) | ||
252 | { | ||
253 | int i; | ||
254 | |||
255 | if (kit->lcd_files_on) { | ||
256 | dev_dbg(&kit->udev->dev, "Removing lcd files\n"); | ||
257 | |||
258 | for (i=0; i<ARRAY_SIZE(dev_lcd_line_attrs); i++) | ||
259 | device_remove_file(kit->dev, &dev_lcd_line_attrs[i]); | ||
260 | } | ||
261 | } | ||
262 | |||
263 | static ssize_t enable_lcd_files(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | ||
264 | { | ||
265 | struct interfacekit *kit = dev_get_drvdata(dev); | ||
266 | int enable; | ||
267 | int i, rc; | ||
268 | |||
269 | if (kit->ifkit->has_lcd == 0) | ||
270 | return -ENODEV; | ||
271 | |||
272 | if (sscanf(buf, "%d", &enable) < 1) | ||
273 | return -EINVAL; | ||
274 | |||
275 | if (enable) { | ||
276 | if (!kit->lcd_files_on) { | ||
277 | dev_dbg(&kit->udev->dev, "Adding lcd files\n"); | ||
278 | for (i=0; i<ARRAY_SIZE(dev_lcd_line_attrs); i++) { | ||
279 | rc = device_create_file(kit->dev, | ||
280 | &dev_lcd_line_attrs[i]); | ||
281 | if (rc) | ||
282 | goto out; | ||
283 | } | ||
284 | kit->lcd_files_on = 1; | ||
285 | } | ||
286 | } else { | ||
287 | if (kit->lcd_files_on) { | ||
288 | remove_lcd_files(kit); | ||
289 | kit->lcd_files_on = 0; | ||
290 | } | ||
291 | } | ||
292 | |||
293 | return count; | ||
294 | out: | ||
295 | while (i-- > 0) | ||
296 | device_remove_file(kit->dev, &dev_lcd_line_attrs[i]); | ||
297 | |||
298 | return rc; | ||
299 | } | ||
300 | |||
301 | static DEVICE_ATTR(lcd, S_IWUGO, NULL, enable_lcd_files); | ||
302 | |||
303 | static void interfacekit_irq(struct urb *urb) | ||
304 | { | ||
305 | struct interfacekit *kit = urb->context; | ||
306 | unsigned char *buffer = kit->data; | ||
307 | int i, level, sensor; | ||
308 | int retval; | ||
309 | int status = urb->status; | ||
310 | |||
311 | switch (status) { | ||
312 | case 0: /* success */ | ||
313 | break; | ||
314 | case -ECONNRESET: /* unlink */ | ||
315 | case -ENOENT: | ||
316 | case -ESHUTDOWN: | ||
317 | return; | ||
318 | /* -EPIPE: should clear the halt */ | ||
319 | default: /* error */ | ||
320 | goto resubmit; | ||
321 | } | ||
322 | |||
323 | /* digital inputs */ | ||
324 | if (kit->ifkit->inputs == 16) { | ||
325 | for (i=0; i < 8; i++) { | ||
326 | level = (buffer[0] >> i) & 1; | ||
327 | if (kit->inputs[i] != level) { | ||
328 | kit->inputs[i] = level; | ||
329 | set_bit(i, &kit->input_events); | ||
330 | } | ||
331 | level = (buffer[1] >> i) & 1; | ||
332 | if (kit->inputs[8 + i] != level) { | ||
333 | kit->inputs[8 + i] = level; | ||
334 | set_bit(8 + i, &kit->input_events); | ||
335 | } | ||
336 | } | ||
337 | } | ||
338 | else if (kit->ifkit->inputs == 8) { | ||
339 | for (i=0; i < 8; i++) { | ||
340 | level = (buffer[1] >> i) & 1; | ||
341 | if (kit->inputs[i] != level) { | ||
342 | kit->inputs[i] = level; | ||
343 | set_bit(i, &kit->input_events); | ||
344 | } | ||
345 | } | ||
346 | } | ||
347 | |||
348 | /* analog inputs */ | ||
349 | if (kit->ifkit->sensors) { | ||
350 | sensor = (buffer[0] & 1) ? 4 : 0; | ||
351 | |||
352 | level = buffer[2] + (buffer[3] & 0x0f) * 256; | ||
353 | if (level != kit->sensors[sensor]) { | ||
354 | kit->sensors[sensor] = level; | ||
355 | set_bit(sensor, &kit->sensor_events); | ||
356 | } | ||
357 | sensor++; | ||
358 | level = buffer[4] + (buffer[3] & 0xf0) * 16; | ||
359 | if (level != kit->sensors[sensor]) { | ||
360 | kit->sensors[sensor] = level; | ||
361 | set_bit(sensor, &kit->sensor_events); | ||
362 | } | ||
363 | sensor++; | ||
364 | level = buffer[5] + (buffer[6] & 0x0f) * 256; | ||
365 | if (level != kit->sensors[sensor]) { | ||
366 | kit->sensors[sensor] = level; | ||
367 | set_bit(sensor, &kit->sensor_events); | ||
368 | } | ||
369 | sensor++; | ||
370 | level = buffer[7] + (buffer[6] & 0xf0) * 16; | ||
371 | if (level != kit->sensors[sensor]) { | ||
372 | kit->sensors[sensor] = level; | ||
373 | set_bit(sensor, &kit->sensor_events); | ||
374 | } | ||
375 | } | ||
376 | |||
377 | if (kit->input_events || kit->sensor_events) | ||
378 | schedule_delayed_work(&kit->do_notify, 0); | ||
379 | |||
380 | resubmit: | ||
381 | retval = usb_submit_urb(urb, GFP_ATOMIC); | ||
382 | if (retval) | ||
383 | err("can't resubmit intr, %s-%s/interfacekit0, retval %d", | ||
384 | kit->udev->bus->bus_name, | ||
385 | kit->udev->devpath, retval); | ||
386 | } | ||
387 | |||
388 | static void do_notify(struct work_struct *work) | ||
389 | { | ||
390 | struct interfacekit *kit = | ||
391 | container_of(work, struct interfacekit, do_notify.work); | ||
392 | int i; | ||
393 | char sysfs_file[8]; | ||
394 | |||
395 | for (i=0; i<kit->ifkit->inputs; i++) { | ||
396 | if (test_and_clear_bit(i, &kit->input_events)) { | ||
397 | sprintf(sysfs_file, "input%d", i + 1); | ||
398 | sysfs_notify(&kit->dev->kobj, NULL, sysfs_file); | ||
399 | } | ||
400 | } | ||
401 | |||
402 | for (i=0; i<kit->ifkit->sensors; i++) { | ||
403 | if (test_and_clear_bit(i, &kit->sensor_events)) { | ||
404 | sprintf(sysfs_file, "sensor%d", i + 1); | ||
405 | sysfs_notify(&kit->dev->kobj, NULL, sysfs_file); | ||
406 | } | ||
407 | } | ||
408 | } | ||
409 | |||
410 | static void do_resubmit(struct work_struct *work) | ||
411 | { | ||
412 | struct interfacekit *kit = | ||
413 | container_of(work, struct interfacekit, do_resubmit.work); | ||
414 | set_outputs(kit); | ||
415 | } | ||
416 | |||
417 | #define show_set_output(value) \ | ||
418 | static ssize_t set_output##value(struct device *dev, \ | ||
419 | struct device_attribute *attr, \ | ||
420 | const char *buf, size_t count) \ | ||
421 | { \ | ||
422 | struct interfacekit *kit = dev_get_drvdata(dev); \ | ||
423 | int enable; \ | ||
424 | int retval; \ | ||
425 | \ | ||
426 | if (sscanf(buf, "%d", &enable) < 1) \ | ||
427 | return -EINVAL; \ | ||
428 | \ | ||
429 | if (enable) \ | ||
430 | set_bit(value - 1, &kit->outputs); \ | ||
431 | else \ | ||
432 | clear_bit(value - 1, &kit->outputs); \ | ||
433 | \ | ||
434 | retval = set_outputs(kit); \ | ||
435 | \ | ||
436 | return retval ? retval : count; \ | ||
437 | } \ | ||
438 | \ | ||
439 | static ssize_t show_output##value(struct device *dev, \ | ||
440 | struct device_attribute *attr, \ | ||
441 | char *buf) \ | ||
442 | { \ | ||
443 | struct interfacekit *kit = dev_get_drvdata(dev); \ | ||
444 | \ | ||
445 | return sprintf(buf, "%d\n", !!test_bit(value - 1, &kit->outputs));\ | ||
446 | } | ||
447 | |||
448 | #define output_attr(value) \ | ||
449 | __ATTR(output##value, S_IWUGO | S_IRUGO, \ | ||
450 | show_output##value, set_output##value) | ||
451 | |||
452 | show_set_output(1); | ||
453 | show_set_output(2); | ||
454 | show_set_output(3); | ||
455 | show_set_output(4); | ||
456 | show_set_output(5); | ||
457 | show_set_output(6); | ||
458 | show_set_output(7); | ||
459 | show_set_output(8); | ||
460 | show_set_output(9); | ||
461 | show_set_output(10); | ||
462 | show_set_output(11); | ||
463 | show_set_output(12); | ||
464 | show_set_output(13); | ||
465 | show_set_output(14); | ||
466 | show_set_output(15); | ||
467 | show_set_output(16); | ||
468 | |||
469 | static struct device_attribute dev_output_attrs[] = { | ||
470 | output_attr(1), output_attr(2), output_attr(3), output_attr(4), | ||
471 | output_attr(5), output_attr(6), output_attr(7), output_attr(8), | ||
472 | output_attr(9), output_attr(10), output_attr(11), output_attr(12), | ||
473 | output_attr(13), output_attr(14), output_attr(15), output_attr(16) | ||
474 | }; | ||
475 | |||
476 | #define show_input(value) \ | ||
477 | static ssize_t show_input##value(struct device *dev, \ | ||
478 | struct device_attribute *attr, char *buf) \ | ||
479 | { \ | ||
480 | struct interfacekit *kit = dev_get_drvdata(dev); \ | ||
481 | \ | ||
482 | return sprintf(buf, "%d\n", (int)kit->inputs[value - 1]); \ | ||
483 | } | ||
484 | |||
485 | #define input_attr(value) \ | ||
486 | __ATTR(input##value, S_IRUGO, show_input##value, NULL) | ||
487 | |||
488 | show_input(1); | ||
489 | show_input(2); | ||
490 | show_input(3); | ||
491 | show_input(4); | ||
492 | show_input(5); | ||
493 | show_input(6); | ||
494 | show_input(7); | ||
495 | show_input(8); | ||
496 | show_input(9); | ||
497 | show_input(10); | ||
498 | show_input(11); | ||
499 | show_input(12); | ||
500 | show_input(13); | ||
501 | show_input(14); | ||
502 | show_input(15); | ||
503 | show_input(16); | ||
504 | |||
505 | static struct device_attribute dev_input_attrs[] = { | ||
506 | input_attr(1), input_attr(2), input_attr(3), input_attr(4), | ||
507 | input_attr(5), input_attr(6), input_attr(7), input_attr(8), | ||
508 | input_attr(9), input_attr(10), input_attr(11), input_attr(12), | ||
509 | input_attr(13), input_attr(14), input_attr(15), input_attr(16) | ||
510 | }; | ||
511 | |||
512 | #define show_sensor(value) \ | ||
513 | static ssize_t show_sensor##value(struct device *dev, \ | ||
514 | struct device_attribute *attr, \ | ||
515 | char *buf) \ | ||
516 | { \ | ||
517 | struct interfacekit *kit = dev_get_drvdata(dev); \ | ||
518 | \ | ||
519 | return sprintf(buf, "%d\n", (int)kit->sensors[value - 1]); \ | ||
520 | } | ||
521 | |||
522 | #define sensor_attr(value) \ | ||
523 | __ATTR(sensor##value, S_IRUGO, show_sensor##value, NULL) | ||
524 | |||
525 | show_sensor(1); | ||
526 | show_sensor(2); | ||
527 | show_sensor(3); | ||
528 | show_sensor(4); | ||
529 | show_sensor(5); | ||
530 | show_sensor(6); | ||
531 | show_sensor(7); | ||
532 | show_sensor(8); | ||
533 | |||
534 | static struct device_attribute dev_sensor_attrs[] = { | ||
535 | sensor_attr(1), sensor_attr(2), sensor_attr(3), sensor_attr(4), | ||
536 | sensor_attr(5), sensor_attr(6), sensor_attr(7), sensor_attr(8) | ||
537 | }; | ||
538 | |||
539 | static int interfacekit_probe(struct usb_interface *intf, const struct usb_device_id *id) | ||
540 | { | ||
541 | struct usb_device *dev = interface_to_usbdev(intf); | ||
542 | struct usb_host_interface *interface; | ||
543 | struct usb_endpoint_descriptor *endpoint; | ||
544 | struct interfacekit *kit; | ||
545 | struct driver_interfacekit *ifkit; | ||
546 | int pipe, maxp, rc = -ENOMEM; | ||
547 | int bit, value, i; | ||
548 | |||
549 | ifkit = (struct driver_interfacekit *)id->driver_info; | ||
550 | if (!ifkit) | ||
551 | return -ENODEV; | ||
552 | |||
553 | interface = intf->cur_altsetting; | ||
554 | if (interface->desc.bNumEndpoints != 1) | ||
555 | return -ENODEV; | ||
556 | |||
557 | endpoint = &interface->endpoint[0].desc; | ||
558 | if (!usb_endpoint_dir_in(endpoint)) | ||
559 | return -ENODEV; | ||
560 | /* | ||
561 | * bmAttributes | ||
562 | */ | ||
563 | pipe = usb_rcvintpipe(dev, endpoint->bEndpointAddress); | ||
564 | maxp = usb_maxpacket(dev, pipe, usb_pipeout(pipe)); | ||
565 | |||
566 | kit = kzalloc(sizeof(*kit), GFP_KERNEL); | ||
567 | if (!kit) | ||
568 | goto out; | ||
569 | |||
570 | kit->dev_no = -1; | ||
571 | kit->ifkit = ifkit; | ||
572 | kit->data = usb_buffer_alloc(dev, URB_INT_SIZE, GFP_ATOMIC, &kit->data_dma); | ||
573 | if (!kit->data) | ||
574 | goto out; | ||
575 | |||
576 | kit->irq = usb_alloc_urb(0, GFP_KERNEL); | ||
577 | if (!kit->irq) | ||
578 | goto out; | ||
579 | |||
580 | kit->udev = usb_get_dev(dev); | ||
581 | kit->intf = intf; | ||
582 | INIT_DELAYED_WORK(&kit->do_notify, do_notify); | ||
583 | INIT_DELAYED_WORK(&kit->do_resubmit, do_resubmit); | ||
584 | usb_fill_int_urb(kit->irq, kit->udev, pipe, kit->data, | ||
585 | maxp > URB_INT_SIZE ? URB_INT_SIZE : maxp, | ||
586 | interfacekit_irq, kit, endpoint->bInterval); | ||
587 | kit->irq->transfer_dma = kit->data_dma; | ||
588 | kit->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | ||
589 | |||
590 | usb_set_intfdata(intf, kit); | ||
591 | |||
592 | do { | ||
593 | bit = find_first_zero_bit(&device_no, sizeof(device_no)); | ||
594 | value = test_and_set_bit(bit, &device_no); | ||
595 | } while(value); | ||
596 | kit->dev_no = bit; | ||
597 | |||
598 | kit->dev = device_create(phidget_class, &kit->udev->dev, MKDEV(0, 0), | ||
599 | kit, "interfacekit%d", kit->dev_no); | ||
600 | if (IS_ERR(kit->dev)) { | ||
601 | rc = PTR_ERR(kit->dev); | ||
602 | kit->dev = NULL; | ||
603 | goto out; | ||
604 | } | ||
605 | |||
606 | if (usb_submit_urb(kit->irq, GFP_KERNEL)) { | ||
607 | rc = -EIO; | ||
608 | goto out; | ||
609 | } | ||
610 | |||
611 | for (i=0; i<ifkit->outputs; i++ ) { | ||
612 | rc = device_create_file(kit->dev, &dev_output_attrs[i]); | ||
613 | if (rc) | ||
614 | goto out2; | ||
615 | } | ||
616 | |||
617 | for (i=0; i<ifkit->inputs; i++ ) { | ||
618 | rc = device_create_file(kit->dev, &dev_input_attrs[i]); | ||
619 | if (rc) | ||
620 | goto out3; | ||
621 | } | ||
622 | |||
623 | for (i=0; i<ifkit->sensors; i++ ) { | ||
624 | rc = device_create_file(kit->dev, &dev_sensor_attrs[i]); | ||
625 | if (rc) | ||
626 | goto out4; | ||
627 | } | ||
628 | |||
629 | if (ifkit->has_lcd) { | ||
630 | rc = device_create_file(kit->dev, &dev_attr_lcd); | ||
631 | if (rc) | ||
632 | goto out4; | ||
633 | |||
634 | } | ||
635 | |||
636 | dev_info(&intf->dev, "USB PhidgetInterfaceKit %d/%d/%d attached\n", | ||
637 | ifkit->sensors, ifkit->inputs, ifkit->outputs); | ||
638 | |||
639 | return 0; | ||
640 | |||
641 | out4: | ||
642 | while (i-- > 0) | ||
643 | device_remove_file(kit->dev, &dev_sensor_attrs[i]); | ||
644 | |||
645 | i = ifkit->inputs; | ||
646 | out3: | ||
647 | while (i-- > 0) | ||
648 | device_remove_file(kit->dev, &dev_input_attrs[i]); | ||
649 | |||
650 | i = ifkit->outputs; | ||
651 | out2: | ||
652 | while (i-- > 0) | ||
653 | device_remove_file(kit->dev, &dev_output_attrs[i]); | ||
654 | out: | ||
655 | if (kit) { | ||
656 | usb_free_urb(kit->irq); | ||
657 | if (kit->data) | ||
658 | usb_buffer_free(dev, URB_INT_SIZE, kit->data, kit->data_dma); | ||
659 | if (kit->dev) | ||
660 | device_unregister(kit->dev); | ||
661 | if (kit->dev_no >= 0) | ||
662 | clear_bit(kit->dev_no, &device_no); | ||
663 | |||
664 | kfree(kit); | ||
665 | } | ||
666 | |||
667 | return rc; | ||
668 | } | ||
669 | |||
670 | static void interfacekit_disconnect(struct usb_interface *interface) | ||
671 | { | ||
672 | struct interfacekit *kit; | ||
673 | int i; | ||
674 | |||
675 | kit = usb_get_intfdata(interface); | ||
676 | usb_set_intfdata(interface, NULL); | ||
677 | if (!kit) | ||
678 | return; | ||
679 | |||
680 | usb_kill_urb(kit->irq); | ||
681 | usb_free_urb(kit->irq); | ||
682 | usb_buffer_free(kit->udev, URB_INT_SIZE, kit->data, kit->data_dma); | ||
683 | |||
684 | cancel_delayed_work(&kit->do_notify); | ||
685 | cancel_delayed_work(&kit->do_resubmit); | ||
686 | |||
687 | for (i=0; i<kit->ifkit->outputs; i++) | ||
688 | device_remove_file(kit->dev, &dev_output_attrs[i]); | ||
689 | |||
690 | for (i=0; i<kit->ifkit->inputs; i++) | ||
691 | device_remove_file(kit->dev, &dev_input_attrs[i]); | ||
692 | |||
693 | for (i=0; i<kit->ifkit->sensors; i++) | ||
694 | device_remove_file(kit->dev, &dev_sensor_attrs[i]); | ||
695 | |||
696 | if (kit->ifkit->has_lcd) { | ||
697 | device_remove_file(kit->dev, &dev_attr_lcd); | ||
698 | remove_lcd_files(kit); | ||
699 | } | ||
700 | |||
701 | device_unregister(kit->dev); | ||
702 | |||
703 | dev_info(&interface->dev, "USB PhidgetInterfaceKit %d/%d/%d detached\n", | ||
704 | kit->ifkit->sensors, kit->ifkit->inputs, kit->ifkit->outputs); | ||
705 | |||
706 | usb_put_dev(kit->udev); | ||
707 | clear_bit(kit->dev_no, &device_no); | ||
708 | |||
709 | kfree(kit); | ||
710 | } | ||
711 | |||
712 | static struct usb_driver interfacekit_driver = { | ||
713 | .name = "phidgetkit", | ||
714 | .probe = interfacekit_probe, | ||
715 | .disconnect = interfacekit_disconnect, | ||
716 | .id_table = id_table | ||
717 | }; | ||
718 | |||
719 | static int __init interfacekit_init(void) | ||
720 | { | ||
721 | int retval = 0; | ||
722 | |||
723 | retval = usb_register(&interfacekit_driver); | ||
724 | if (retval) | ||
725 | err("usb_register failed. Error number %d", retval); | ||
726 | |||
727 | return retval; | ||
728 | } | ||
729 | |||
730 | static void __exit interfacekit_exit(void) | ||
731 | { | ||
732 | usb_deregister(&interfacekit_driver); | ||
733 | } | ||
734 | |||
735 | module_init(interfacekit_init); | ||
736 | module_exit(interfacekit_exit); | ||
737 | |||
738 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
739 | MODULE_DESCRIPTION(DRIVER_DESC); | ||
740 | MODULE_LICENSE("GPL"); | ||