git.oblomov.eu Git - linux-2.6/blob - drivers/usb/misc/phidgetkit.c

   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", __FUNCTION__);
 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", __FUNCTION__);
 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", __FUNCTION__);
 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, 0,
 599                         "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         dev_set_drvdata(kit->dev, kit);
 606
 607         if (usb_submit_urb(kit->irq, GFP_KERNEL)) {
 608                 rc = -EIO;
 609                 goto out;
 610         }
 611
 612         for (i=0; i<ifkit->outputs; i++ ) {
 613                 rc = device_create_file(kit->dev, &dev_output_attrs[i]);
 614                 if (rc)
 615                         goto out2;
 616         }
 617
 618         for (i=0; i<ifkit->inputs; i++ ) {
 619                 rc = device_create_file(kit->dev, &dev_input_attrs[i]);
 620                 if (rc)
 621                         goto out3;
 622         }
 623
 624         for (i=0; i<ifkit->sensors; i++ ) {
 625                 rc = device_create_file(kit->dev, &dev_sensor_attrs[i]);
 626                 if (rc)
 627                         goto out4;
 628         }
 629
 630         if (ifkit->has_lcd) {
 631                 rc = device_create_file(kit->dev, &dev_attr_lcd);
 632                 if (rc)
 633                         goto out4;
 634
 635         }
 636
 637         dev_info(&intf->dev, "USB PhidgetInterfaceKit %d/%d/%d attached\n",
 638                         ifkit->sensors, ifkit->inputs, ifkit->outputs);
 639
 640         return 0;
 641
 642 out4:
 643         while (i-- > 0)
 644                 device_remove_file(kit->dev, &dev_sensor_attrs[i]);
 645
 646         i = ifkit->inputs;
 647 out3:
 648         while (i-- > 0)
 649                 device_remove_file(kit->dev, &dev_input_attrs[i]);
 650
 651         i = ifkit->outputs;
 652 out2:
 653         while (i-- > 0)
 654                 device_remove_file(kit->dev, &dev_output_attrs[i]);
 655 out:
 656         if (kit) {
 657                 usb_free_urb(kit->irq);
 658                 if (kit->data)
 659                         usb_buffer_free(dev, URB_INT_SIZE, kit->data, kit->data_dma);
 660                 if (kit->dev)
 661                         device_unregister(kit->dev);
 662                 if (kit->dev_no >= 0)
 663                         clear_bit(kit->dev_no, &device_no);
 664
 665                 kfree(kit);
 666         }
 667
 668         return rc;
 669 }
 670
 671 static void interfacekit_disconnect(struct usb_interface *interface)
 672 {
 673         struct interfacekit *kit;
 674         int i;
 675
 676         kit = usb_get_intfdata(interface);
 677         usb_set_intfdata(interface, NULL);
 678         if (!kit)
 679                 return;
 680
 681         usb_kill_urb(kit->irq);
 682         usb_free_urb(kit->irq);
 683         usb_buffer_free(kit->udev, URB_INT_SIZE, kit->data, kit->data_dma);
 684
 685         cancel_delayed_work(&kit->do_notify);
 686         cancel_delayed_work(&kit->do_resubmit);
 687
 688         for (i=0; i<kit->ifkit->outputs; i++)
 689                 device_remove_file(kit->dev, &dev_output_attrs[i]);
 690
 691         for (i=0; i<kit->ifkit->inputs; i++)
 692                 device_remove_file(kit->dev, &dev_input_attrs[i]);
 693
 694         for (i=0; i<kit->ifkit->sensors; i++)
 695                 device_remove_file(kit->dev, &dev_sensor_attrs[i]);
 696
 697         if (kit->ifkit->has_lcd) {
 698                 device_remove_file(kit->dev, &dev_attr_lcd);
 699                 remove_lcd_files(kit);
 700         }
 701
 702         device_unregister(kit->dev);
 703
 704         dev_info(&interface->dev, "USB PhidgetInterfaceKit %d/%d/%d detached\n",
 705                 kit->ifkit->sensors, kit->ifkit->inputs, kit->ifkit->outputs);
 706
 707         usb_put_dev(kit->udev);
 708         clear_bit(kit->dev_no, &device_no);
 709
 710         kfree(kit);
 711 }
 712
 713 static struct usb_driver interfacekit_driver = {
 714         .name = "phidgetkit",
 715         .probe = interfacekit_probe,
 716         .disconnect = interfacekit_disconnect,
 717         .id_table = id_table
 718 };
 719
 720 static int __init interfacekit_init(void)
 721 {
 722         int retval = 0;
 723
 724         retval = usb_register(&interfacekit_driver);
 725         if (retval)
 726                 err("usb_register failed. Error number %d", retval);
 727
 728         return retval;
 729 }
 730
 731 static void __exit interfacekit_exit(void)
 732 {
 733         usb_deregister(&interfacekit_driver);
 734 }
 735
 736 module_init(interfacekit_init);
 737 module_exit(interfacekit_exit);
 738
 739 MODULE_AUTHOR(DRIVER_AUTHOR);
 740 MODULE_DESCRIPTION(DRIVER_DESC);
 741 MODULE_LICENSE("GPL");