git.oblomov.eu Git - linux-2.6/blob - drivers/input/input.c

   1 /*
   2  * The input core
   3  *
   4  * Copyright (c) 1999-2002 Vojtech Pavlik
   5  */
   6
   7 /*
   8  * This program is free software; you can redistribute it and/or modify it
   9  * under the terms of the GNU General Public License version 2 as published by
  10  * the Free Software Foundation.
  11  */
  12
  13 #include <linux/init.h>
  14 #include <linux/sched.h>
  15 #include <linux/smp_lock.h>
  16 #include <linux/input.h>
  17 #include <linux/module.h>
  18 #include <linux/random.h>
  19 #include <linux/major.h>
  20 #include <linux/proc_fs.h>
  21 #include <linux/interrupt.h>
  22 #include <linux/poll.h>
  23 #include <linux/device.h>
  24
  25 MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
  26 MODULE_DESCRIPTION("Input core");
  27 MODULE_LICENSE("GPL");
  28
  29 EXPORT_SYMBOL(input_allocate_device);
  30 EXPORT_SYMBOL(input_register_device);
  31 EXPORT_SYMBOL(input_unregister_device);
  32 EXPORT_SYMBOL(input_register_handler);
  33 EXPORT_SYMBOL(input_unregister_handler);
  34 EXPORT_SYMBOL(input_grab_device);
  35 EXPORT_SYMBOL(input_release_device);
  36 EXPORT_SYMBOL(input_open_device);
  37 EXPORT_SYMBOL(input_close_device);
  38 EXPORT_SYMBOL(input_accept_process);
  39 EXPORT_SYMBOL(input_flush_device);
  40 EXPORT_SYMBOL(input_event);
  41 EXPORT_SYMBOL_GPL(input_class);
  42
  43 #define INPUT_DEVICES   256
  44
  45 static LIST_HEAD(input_dev_list);
  46 static LIST_HEAD(input_handler_list);
  47
  48 static struct input_handler *input_table[8];
  49
  50 void input_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
  51 {
  52         struct input_handle *handle;
  53
  54         if (type > EV_MAX || !test_bit(type, dev->evbit))
  55                 return;
  56
  57         add_input_randomness(type, code, value);
  58
  59         switch (type) {
  60
  61                 case EV_SYN:
  62                         switch (code) {
  63                                 case SYN_CONFIG:
  64                                         if (dev->event) dev->event(dev, type, code, value);
  65                                         break;
  66
  67                                 case SYN_REPORT:
  68                                         if (dev->sync) return;
  69                                         dev->sync = 1;
  70                                         break;
  71                         }
  72                         break;
  73
  74                 case EV_KEY:
  75
  76                         if (code > KEY_MAX || !test_bit(code, dev->keybit) || !!test_bit(code, dev->key) == value)
  77                                 return;
  78
  79                         if (value == 2)
  80                                 break;
  81
  82                         change_bit(code, dev->key);
  83
  84                         if (test_bit(EV_REP, dev->evbit) && dev->rep[REP_PERIOD] && dev->rep[REP_DELAY] && dev->timer.data && value) {
  85                                 dev->repeat_key = code;
  86                                 mod_timer(&dev->timer, jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]));
  87                         }
  88
  89                         break;
  90
  91                 case EV_SW:
  92
  93                         if (code > SW_MAX || !test_bit(code, dev->swbit) || !!test_bit(code, dev->sw) == value)
  94                                 return;
  95
  96                         change_bit(code, dev->sw);
  97
  98                         break;
  99
 100                 case EV_ABS:
 101
 102                         if (code > ABS_MAX || !test_bit(code, dev->absbit))
 103                                 return;
 104
 105                         if (dev->absfuzz[code]) {
 106                                 if ((value > dev->abs[code] - (dev->absfuzz[code] >> 1)) &&
 107                                     (value < dev->abs[code] + (dev->absfuzz[code] >> 1)))
 108                                         return;
 109
 110                                 if ((value > dev->abs[code] - dev->absfuzz[code]) &&
 111                                     (value < dev->abs[code] + dev->absfuzz[code]))
 112                                         value = (dev->abs[code] * 3 + value) >> 2;
 113
 114                                 if ((value > dev->abs[code] - (dev->absfuzz[code] << 1)) &&
 115                                     (value < dev->abs[code] + (dev->absfuzz[code] << 1)))
 116                                         value = (dev->abs[code] + value) >> 1;
 117                         }
 118
 119                         if (dev->abs[code] == value)
 120                                 return;
 121
 122                         dev->abs[code] = value;
 123                         break;
 124
 125                 case EV_REL:
 126
 127                         if (code > REL_MAX || !test_bit(code, dev->relbit) || (value == 0))
 128                                 return;
 129
 130                         break;
 131
 132                 case EV_MSC:
 133
 134                         if (code > MSC_MAX || !test_bit(code, dev->mscbit))
 135                                 return;
 136
 137                         if (dev->event) dev->event(dev, type, code, value);
 138
 139                         break;
 140
 141                 case EV_LED:
 142
 143                         if (code > LED_MAX || !test_bit(code, dev->ledbit) || !!test_bit(code, dev->led) == value)
 144                                 return;
 145
 146                         change_bit(code, dev->led);
 147                         if (dev->event) dev->event(dev, type, code, value);
 148
 149                         break;
 150
 151                 case EV_SND:
 152
 153                         if (code > SND_MAX || !test_bit(code, dev->sndbit))
 154                                 return;
 155
 156                         if (dev->event) dev->event(dev, type, code, value);
 157
 158                         break;
 159
 160                 case EV_REP:
 161
 162                         if (code > REP_MAX || value < 0 || dev->rep[code] == value) return;
 163
 164                         dev->rep[code] = value;
 165                         if (dev->event) dev->event(dev, type, code, value);
 166
 167                         break;
 168
 169                 case EV_FF:
 170                         if (dev->event) dev->event(dev, type, code, value);
 171                         break;
 172         }
 173
 174         if (type != EV_SYN)
 175                 dev->sync = 0;
 176
 177         if (dev->grab)
 178                 dev->grab->handler->event(dev->grab, type, code, value);
 179         else
 180                 list_for_each_entry(handle, &dev->h_list, d_node)
 181                         if (handle->open)
 182                                 handle->handler->event(handle, type, code, value);
 183 }
 184
 185 static void input_repeat_key(unsigned long data)
 186 {
 187         struct input_dev *dev = (void *) data;
 188
 189         if (!test_bit(dev->repeat_key, dev->key))
 190                 return;
 191
 192         input_event(dev, EV_KEY, dev->repeat_key, 2);
 193         input_sync(dev);
 194
 195         if (dev->rep[REP_PERIOD])
 196                 mod_timer(&dev->timer, jiffies + msecs_to_jiffies(dev->rep[REP_PERIOD]));
 197 }
 198
 199 int input_accept_process(struct input_handle *handle, struct file *file)
 200 {
 201         if (handle->dev->accept)
 202                 return handle->dev->accept(handle->dev, file);
 203
 204         return 0;
 205 }
 206
 207 int input_grab_device(struct input_handle *handle)
 208 {
 209         if (handle->dev->grab)
 210                 return -EBUSY;
 211
 212         handle->dev->grab = handle;
 213         return 0;
 214 }
 215
 216 void input_release_device(struct input_handle *handle)
 217 {
 218         if (handle->dev->grab == handle)
 219                 handle->dev->grab = NULL;
 220 }
 221
 222 int input_open_device(struct input_handle *handle)
 223 {
 224         struct input_dev *dev = handle->dev;
 225         int err;
 226
 227         err = down_interruptible(&dev->sem);
 228         if (err)
 229                 return err;
 230
 231         handle->open++;
 232
 233         if (!dev->users++ && dev->open)
 234                 err = dev->open(dev);
 235
 236         if (err)
 237                 handle->open--;
 238
 239         up(&dev->sem);
 240
 241         return err;
 242 }
 243
 244 int input_flush_device(struct input_handle* handle, struct file* file)
 245 {
 246         if (handle->dev->flush)
 247                 return handle->dev->flush(handle->dev, file);
 248
 249         return 0;
 250 }
 251
 252 void input_close_device(struct input_handle *handle)
 253 {
 254         struct input_dev *dev = handle->dev;
 255
 256         input_release_device(handle);
 257
 258         down(&dev->sem);
 259
 260         if (!--dev->users && dev->close)
 261                 dev->close(dev);
 262         handle->open--;
 263
 264         up(&dev->sem);
 265 }
 266
 267 static void input_link_handle(struct input_handle *handle)
 268 {
 269         list_add_tail(&handle->d_node, &handle->dev->h_list);
 270         list_add_tail(&handle->h_node, &handle->handler->h_list);
 271 }
 272
 273 #define MATCH_BIT(bit, max) \
 274                 for (i = 0; i < NBITS(max); i++) \
 275                         if ((id->bit[i] & dev->bit[i]) != id->bit[i]) \
 276                                 break; \
 277                 if (i != NBITS(max)) \
 278                         continue;
 279
 280 static struct input_device_id *input_match_device(struct input_device_id *id, struct input_dev *dev)
 281 {
 282         int i;
 283
 284         for (; id->flags || id->driver_info; id++) {
 285
 286                 if (id->flags & INPUT_DEVICE_ID_MATCH_BUS)
 287                         if (id->id.bustype != dev->id.bustype)
 288                                 continue;
 289
 290                 if (id->flags & INPUT_DEVICE_ID_MATCH_VENDOR)
 291                         if (id->id.vendor != dev->id.vendor)
 292                                 continue;
 293
 294                 if (id->flags & INPUT_DEVICE_ID_MATCH_PRODUCT)
 295                         if (id->id.product != dev->id.product)
 296                                 continue;
 297
 298                 if (id->flags & INPUT_DEVICE_ID_MATCH_VERSION)
 299                         if (id->id.version != dev->id.version)
 300                                 continue;
 301
 302                 MATCH_BIT(evbit,  EV_MAX);
 303                 MATCH_BIT(keybit, KEY_MAX);
 304                 MATCH_BIT(relbit, REL_MAX);
 305                 MATCH_BIT(absbit, ABS_MAX);
 306                 MATCH_BIT(mscbit, MSC_MAX);
 307                 MATCH_BIT(ledbit, LED_MAX);
 308                 MATCH_BIT(sndbit, SND_MAX);
 309                 MATCH_BIT(ffbit,  FF_MAX);
 310                 MATCH_BIT(swbit,  SW_MAX);
 311
 312                 return id;
 313         }
 314
 315         return NULL;
 316 }
 317
 318 static int input_print_bitmap(char *buf, int buf_size, unsigned long *bitmap, int max)
 319 {
 320         int i;
 321         int len = 0;
 322
 323         for (i = NBITS(max) - 1; i > 0; i--)
 324                 if (bitmap[i])
 325                         break;
 326
 327         for (; i >= 0; i--)
 328                 len += snprintf(buf + len, max(buf_size - len, 0),
 329                                 "%lx%s", bitmap[i], i > 0 ? " " : "");
 330         return len;
 331 }
 332
 333 #ifdef CONFIG_PROC_FS
 334
 335 static struct proc_dir_entry *proc_bus_input_dir;
 336 static DECLARE_WAIT_QUEUE_HEAD(input_devices_poll_wait);
 337 static int input_devices_state;
 338
 339 static inline void input_wakeup_procfs_readers(void)
 340 {
 341         input_devices_state++;
 342         wake_up(&input_devices_poll_wait);
 343 }
 344
 345 static unsigned int input_devices_poll(struct file *file, poll_table *wait)
 346 {
 347         int state = input_devices_state;
 348         poll_wait(file, &input_devices_poll_wait, wait);
 349         if (state != input_devices_state)
 350                 return POLLIN | POLLRDNORM;
 351         return 0;
 352 }
 353
 354 #define SPRINTF_BIT(ev, bm)                                             \
 355         do {                                                            \
 356                 len += sprintf(buf + len, "B: %s=", #ev);               \
 357                 len += input_print_bitmap(buf + len, INT_MAX,           \
 358                                         dev->bm##bit, ev##_MAX);        \
 359                 len += sprintf(buf + len, "\n");                        \
 360         } while (0)
 361
 362 #define TEST_AND_SPRINTF_BIT(ev, bm)                                    \
 363         do {                                                            \
 364                 if (test_bit(EV_##ev, dev->evbit))                      \
 365                         SPRINTF_BIT(ev, bm);                            \
 366         } while (0)
 367
 368 static int input_devices_read(char *buf, char **start, off_t pos, int count, int *eof, void *data)
 369 {
 370         struct input_dev *dev;
 371         struct input_handle *handle;
 372         const char *path;
 373
 374         off_t at = 0;
 375         int len, cnt = 0;
 376
 377         list_for_each_entry(dev, &input_dev_list, node) {
 378
 379                 path = kobject_get_path(&dev->cdev.kobj, GFP_KERNEL);
 380
 381                 len = sprintf(buf, "I: Bus=%04x Vendor=%04x Product=%04x Version=%04x\n",
 382                         dev->id.bustype, dev->id.vendor, dev->id.product, dev->id.version);
 383
 384                 len += sprintf(buf + len, "N: Name=\"%s\"\n", dev->name ? dev->name : "");
 385                 len += sprintf(buf + len, "P: Phys=%s\n", dev->phys ? dev->phys : "");
 386                 len += sprintf(buf + len, "S: Sysfs=%s\n", path ? path : "");
 387                 len += sprintf(buf + len, "H: Handlers=");
 388
 389                 list_for_each_entry(handle, &dev->h_list, d_node)
 390                         len += sprintf(buf + len, "%s ", handle->name);
 391
 392                 len += sprintf(buf + len, "\n");
 393
 394                 SPRINTF_BIT(EV, ev);
 395                 TEST_AND_SPRINTF_BIT(KEY, key);
 396                 TEST_AND_SPRINTF_BIT(REL, rel);
 397                 TEST_AND_SPRINTF_BIT(ABS, abs);
 398                 TEST_AND_SPRINTF_BIT(MSC, msc);
 399                 TEST_AND_SPRINTF_BIT(LED, led);
 400                 TEST_AND_SPRINTF_BIT(SND, snd);
 401                 TEST_AND_SPRINTF_BIT(FF, ff);
 402                 TEST_AND_SPRINTF_BIT(SW, sw);
 403
 404                 len += sprintf(buf + len, "\n");
 405
 406                 at += len;
 407
 408                 if (at >= pos) {
 409                         if (!*start) {
 410                                 *start = buf + (pos - (at - len));
 411                                 cnt = at - pos;
 412                         } else  cnt += len;
 413                         buf += len;
 414                         if (cnt >= count)
 415                                 break;
 416                 }
 417
 418                 kfree(path);
 419         }
 420
 421         if (&dev->node == &input_dev_list)
 422                 *eof = 1;
 423
 424         return (count > cnt) ? cnt : count;
 425 }
 426
 427 static int input_handlers_read(char *buf, char **start, off_t pos, int count, int *eof, void *data)
 428 {
 429         struct input_handler *handler;
 430
 431         off_t at = 0;
 432         int len = 0, cnt = 0;
 433         int i = 0;
 434
 435         list_for_each_entry(handler, &input_handler_list, node) {
 436
 437                 if (handler->fops)
 438                         len = sprintf(buf, "N: Number=%d Name=%s Minor=%d\n",
 439                                 i++, handler->name, handler->minor);
 440                 else
 441                         len = sprintf(buf, "N: Number=%d Name=%s\n",
 442                                 i++, handler->name);
 443
 444                 at += len;
 445
 446                 if (at >= pos) {
 447                         if (!*start) {
 448                                 *start = buf + (pos - (at - len));
 449                                 cnt = at - pos;
 450                         } else  cnt += len;
 451                         buf += len;
 452                         if (cnt >= count)
 453                                 break;
 454                 }
 455         }
 456         if (&handler->node == &input_handler_list)
 457                 *eof = 1;
 458
 459         return (count > cnt) ? cnt : count;
 460 }
 461
 462 static struct file_operations input_fileops;
 463
 464 static int __init input_proc_init(void)
 465 {
 466         struct proc_dir_entry *entry;
 467
 468         proc_bus_input_dir = proc_mkdir("input", proc_bus);
 469         if (!proc_bus_input_dir)
 470                 return -ENOMEM;
 471
 472         proc_bus_input_dir->owner = THIS_MODULE;
 473
 474         entry = create_proc_read_entry("devices", 0, proc_bus_input_dir, input_devices_read, NULL);
 475         if (!entry)
 476                 goto fail1;
 477
 478         entry->owner = THIS_MODULE;
 479         input_fileops = *entry->proc_fops;
 480         input_fileops.poll = input_devices_poll;
 481         entry->proc_fops = &input_fileops;
 482
 483         entry = create_proc_read_entry("handlers", 0, proc_bus_input_dir, input_handlers_read, NULL);
 484         if (!entry)
 485                 goto fail2;
 486
 487         entry->owner = THIS_MODULE;
 488
 489         return 0;
 490
 491  fail2: remove_proc_entry("devices", proc_bus_input_dir);
 492  fail1: remove_proc_entry("input", proc_bus);
 493         return -ENOMEM;
 494 }
 495
 496 static void input_proc_exit(void)
 497 {
 498         remove_proc_entry("devices", proc_bus_input_dir);
 499         remove_proc_entry("handlers", proc_bus_input_dir);
 500         remove_proc_entry("input", proc_bus);
 501 }
 502
 503 #else /* !CONFIG_PROC_FS */
 504 static inline void input_wakeup_procfs_readers(void) { }
 505 static inline int input_proc_init(void) { return 0; }
 506 static inline void input_proc_exit(void) { }
 507 #endif
 508
 509 #define INPUT_DEV_STRING_ATTR_SHOW(name)                                        \
 510 static ssize_t input_dev_show_##name(struct class_device *dev, char *buf)       \
 511 {                                                                               \
 512         struct input_dev *input_dev = to_input_dev(dev);                        \
 513         int retval;                                                             \
 514                                                                                 \
 515         retval = down_interruptible(&input_dev->sem);                           \
 516         if (retval)                                                             \
 517                 return retval;                                                  \
 518                                                                                 \
 519         retval = sprintf(buf, "%s\n", input_dev->name ? input_dev->name : "");  \
 520                                                                                 \
 521         up(&input_dev->sem);                                                    \
 522                                                                                 \
 523         return retval;                                                          \
 524 }                                                                               \
 525 static CLASS_DEVICE_ATTR(name, S_IRUGO, input_dev_show_##name, NULL);
 526
 527 INPUT_DEV_STRING_ATTR_SHOW(name);
 528 INPUT_DEV_STRING_ATTR_SHOW(phys);
 529 INPUT_DEV_STRING_ATTR_SHOW(uniq);
 530
 531 static int print_modalias_bits(char *buf, int size, char prefix, unsigned long *arr,
 532                                unsigned int min, unsigned int max)
 533 {
 534         int len, i;
 535
 536         len = snprintf(buf, size, "%c", prefix);
 537         for (i = min; i < max; i++)
 538                 if (arr[LONG(i)] & BIT(i))
 539                         len += snprintf(buf + len, size - len, "%X,", i);
 540         return len;
 541 }
 542
 543 static int print_modalias(char *buf, int size, struct input_dev *id)
 544 {
 545         int len;
 546
 547         len = snprintf(buf, size, "input:b%04Xv%04Xp%04Xe%04X-",
 548                        id->id.bustype,
 549                        id->id.vendor,
 550                        id->id.product,
 551                        id->id.version);
 552
 553         len += print_modalias_bits(buf + len, size - len, 'e', id->evbit,
 554                                    0, EV_MAX);
 555         len += print_modalias_bits(buf + len, size - len, 'k', id->keybit,
 556                                    KEY_MIN_INTERESTING, KEY_MAX);
 557         len += print_modalias_bits(buf + len, size - len, 'r', id->relbit,
 558                                    0, REL_MAX);
 559         len += print_modalias_bits(buf + len, size - len, 'a', id->absbit,
 560                                    0, ABS_MAX);
 561         len += print_modalias_bits(buf + len, size - len, 'm', id->mscbit,
 562                                    0, MSC_MAX);
 563         len += print_modalias_bits(buf + len, size - len, 'l', id->ledbit,
 564                                    0, LED_MAX);
 565         len += print_modalias_bits(buf + len, size - len, 's', id->sndbit,
 566                                    0, SND_MAX);
 567         len += print_modalias_bits(buf + len, size - len, 'f', id->ffbit,
 568                                    0, FF_MAX);
 569         len += print_modalias_bits(buf + len, size - len, 'w', id->swbit,
 570                                    0, SW_MAX);
 571         return len;
 572 }
 573
 574 static ssize_t input_dev_show_modalias(struct class_device *dev, char *buf)
 575 {
 576         struct input_dev *id = to_input_dev(dev);
 577         ssize_t len;
 578
 579         len = print_modalias(buf, PAGE_SIZE, id);
 580         len += snprintf(buf + len, PAGE_SIZE-len, "\n");
 581         return len;
 582 }
 583 static CLASS_DEVICE_ATTR(modalias, S_IRUGO, input_dev_show_modalias, NULL);
 584
 585 static struct attribute *input_dev_attrs[] = {
 586         &class_device_attr_name.attr,
 587         &class_device_attr_phys.attr,
 588         &class_device_attr_uniq.attr,
 589         &class_device_attr_modalias.attr,
 590         NULL
 591 };
 592
 593 static struct attribute_group input_dev_attr_group = {
 594         .attrs  = input_dev_attrs,
 595 };
 596
 597 #define INPUT_DEV_ID_ATTR(name)                                                 \
 598 static ssize_t input_dev_show_id_##name(struct class_device *dev, char *buf)    \
 599 {                                                                               \
 600         struct input_dev *input_dev = to_input_dev(dev);                        \
 601         return sprintf(buf, "%04x\n", input_dev->id.name);                      \
 602 }                                                                               \
 603 static CLASS_DEVICE_ATTR(name, S_IRUGO, input_dev_show_id_##name, NULL);
 604
 605 INPUT_DEV_ID_ATTR(bustype);
 606 INPUT_DEV_ID_ATTR(vendor);
 607 INPUT_DEV_ID_ATTR(product);
 608 INPUT_DEV_ID_ATTR(version);
 609
 610 static struct attribute *input_dev_id_attrs[] = {
 611         &class_device_attr_bustype.attr,
 612         &class_device_attr_vendor.attr,
 613         &class_device_attr_product.attr,
 614         &class_device_attr_version.attr,
 615         NULL
 616 };
 617
 618 static struct attribute_group input_dev_id_attr_group = {
 619         .name   = "id",
 620         .attrs  = input_dev_id_attrs,
 621 };
 622
 623 #define INPUT_DEV_CAP_ATTR(ev, bm)                                              \
 624 static ssize_t input_dev_show_cap_##bm(struct class_device *dev, char *buf)     \
 625 {                                                                               \
 626         struct input_dev *input_dev = to_input_dev(dev);                        \
 627         return input_print_bitmap(buf, PAGE_SIZE, input_dev->bm##bit, ev##_MAX);\
 628 }                                                                               \
 629 static CLASS_DEVICE_ATTR(bm, S_IRUGO, input_dev_show_cap_##bm, NULL);
 630
 631 INPUT_DEV_CAP_ATTR(EV, ev);
 632 INPUT_DEV_CAP_ATTR(KEY, key);
 633 INPUT_DEV_CAP_ATTR(REL, rel);
 634 INPUT_DEV_CAP_ATTR(ABS, abs);
 635 INPUT_DEV_CAP_ATTR(MSC, msc);
 636 INPUT_DEV_CAP_ATTR(LED, led);
 637 INPUT_DEV_CAP_ATTR(SND, snd);
 638 INPUT_DEV_CAP_ATTR(FF, ff);
 639 INPUT_DEV_CAP_ATTR(SW, sw);
 640
 641 static struct attribute *input_dev_caps_attrs[] = {
 642         &class_device_attr_ev.attr,
 643         &class_device_attr_key.attr,
 644         &class_device_attr_rel.attr,
 645         &class_device_attr_abs.attr,
 646         &class_device_attr_msc.attr,
 647         &class_device_attr_led.attr,
 648         &class_device_attr_snd.attr,
 649         &class_device_attr_ff.attr,
 650         &class_device_attr_sw.attr,
 651         NULL
 652 };
 653
 654 static struct attribute_group input_dev_caps_attr_group = {
 655         .name   = "capabilities",
 656         .attrs  = input_dev_caps_attrs,
 657 };
 658
 659 static void input_dev_release(struct class_device *class_dev)
 660 {
 661         struct input_dev *dev = to_input_dev(class_dev);
 662
 663         kfree(dev);
 664         module_put(THIS_MODULE);
 665 }
 666
 667 /*
 668  * Input uevent interface - loading event handlers based on
 669  * device bitfields.
 670  */
 671 static int input_add_uevent_bm_var(char **envp, int num_envp, int *cur_index,
 672                                     char *buffer, int buffer_size, int *cur_len,
 673                                     const char *name, unsigned long *bitmap, int max)
 674 {
 675         if (*cur_index >= num_envp - 1)
 676                 return -ENOMEM;
 677
 678         envp[*cur_index] = buffer + *cur_len;
 679
 680         *cur_len += snprintf(buffer + *cur_len, max(buffer_size - *cur_len, 0), name);
 681         if (*cur_len > buffer_size)
 682                 return -ENOMEM;
 683
 684         *cur_len += input_print_bitmap(buffer + *cur_len,
 685                                         max(buffer_size - *cur_len, 0),
 686                                         bitmap, max) + 1;
 687         if (*cur_len > buffer_size)
 688                 return -ENOMEM;
 689
 690         (*cur_index)++;
 691         return 0;
 692 }
 693
 694 #define INPUT_ADD_HOTPLUG_VAR(fmt, val...)                              \
 695         do {                                                            \
 696                 int err = add_uevent_var(envp, num_envp, &i,    \
 697                                         buffer, buffer_size, &len,      \
 698                                         fmt, val);                      \
 699                 if (err)                                                \
 700                         return err;                                     \
 701         } while (0)
 702
 703 #define INPUT_ADD_HOTPLUG_BM_VAR(name, bm, max)                         \
 704         do {                                                            \
 705                 int err = input_add_uevent_bm_var(envp, num_envp, &i,   \
 706                                         buffer, buffer_size, &len,      \
 707                                         name, bm, max);                 \
 708                 if (err)                                                \
 709                         return err;                                     \
 710         } while (0)
 711
 712 static int input_dev_uevent(struct class_device *cdev, char **envp,
 713                             int num_envp, char *buffer, int buffer_size)
 714 {
 715         struct input_dev *dev = to_input_dev(cdev);
 716         int i = 0;
 717         int len = 0;
 718
 719         INPUT_ADD_HOTPLUG_VAR("PRODUCT=%x/%x/%x/%x",
 720                                 dev->id.bustype, dev->id.vendor,
 721                                 dev->id.product, dev->id.version);
 722         if (dev->name)
 723                 INPUT_ADD_HOTPLUG_VAR("NAME=\"%s\"", dev->name);
 724         if (dev->phys)
 725                 INPUT_ADD_HOTPLUG_VAR("PHYS=\"%s\"", dev->phys);
 726         if (dev->uniq)
 727                 INPUT_ADD_HOTPLUG_VAR("UNIQ=\"%s\"", dev->uniq);
 728
 729         INPUT_ADD_HOTPLUG_BM_VAR("EV=", dev->evbit, EV_MAX);
 730         if (test_bit(EV_KEY, dev->evbit))
 731                 INPUT_ADD_HOTPLUG_BM_VAR("KEY=", dev->keybit, KEY_MAX);
 732         if (test_bit(EV_REL, dev->evbit))
 733                 INPUT_ADD_HOTPLUG_BM_VAR("REL=", dev->relbit, REL_MAX);
 734         if (test_bit(EV_ABS, dev->evbit))
 735                 INPUT_ADD_HOTPLUG_BM_VAR("ABS=", dev->absbit, ABS_MAX);
 736         if (test_bit(EV_MSC, dev->evbit))
 737                 INPUT_ADD_HOTPLUG_BM_VAR("MSC=", dev->mscbit, MSC_MAX);
 738         if (test_bit(EV_LED, dev->evbit))
 739                 INPUT_ADD_HOTPLUG_BM_VAR("LED=", dev->ledbit, LED_MAX);
 740         if (test_bit(EV_SND, dev->evbit))
 741                 INPUT_ADD_HOTPLUG_BM_VAR("SND=", dev->sndbit, SND_MAX);
 742         if (test_bit(EV_FF, dev->evbit))
 743                 INPUT_ADD_HOTPLUG_BM_VAR("FF=", dev->ffbit, FF_MAX);
 744         if (test_bit(EV_SW, dev->evbit))
 745                 INPUT_ADD_HOTPLUG_BM_VAR("SW=", dev->swbit, SW_MAX);
 746
 747         envp[i++] = buffer + len;
 748         len += snprintf(buffer + len, buffer_size - len, "MODALIAS=");
 749         len += print_modalias(buffer + len, buffer_size - len, dev) + 1;
 750
 751         envp[i] = NULL;
 752         return 0;
 753 }
 754
 755 struct class input_class = {
 756         .name                   = "input",
 757         .release                = input_dev_release,
 758         .uevent                 = input_dev_uevent,
 759 };
 760
 761 struct input_dev *input_allocate_device(void)
 762 {
 763         struct input_dev *dev;
 764
 765         dev = kzalloc(sizeof(struct input_dev), GFP_KERNEL);
 766         if (dev) {
 767                 dev->dynalloc = 1;
 768                 dev->cdev.class = &input_class;
 769                 class_device_initialize(&dev->cdev);
 770                 INIT_LIST_HEAD(&dev->h_list);
 771                 INIT_LIST_HEAD(&dev->node);
 772         }
 773
 774         return dev;
 775 }
 776
 777 int input_register_device(struct input_dev *dev)
 778 {
 779         static atomic_t input_no = ATOMIC_INIT(0);
 780         struct input_handle *handle;
 781         struct input_handler *handler;
 782         struct input_device_id *id;
 783         const char *path;
 784         int error;
 785
 786         if (!dev->dynalloc) {
 787                 printk(KERN_WARNING "input: device %s is statically allocated, will not register\n"
 788                         "Please convert to input_allocate_device() or contact dtor_core@ameritech.net\n",
 789                         dev->name ? dev->name : "<Unknown>");
 790                 return -EINVAL;
 791         }
 792
 793         init_MUTEX(&dev->sem);
 794         set_bit(EV_SYN, dev->evbit);
 795
 796         /*
 797          * If delay and period are pre-set by the driver, then autorepeating
 798          * is handled by the driver itself and we don't do it in input.c.
 799          */
 800
 801         init_timer(&dev->timer);
 802         if (!dev->rep[REP_DELAY] && !dev->rep[REP_PERIOD]) {
 803                 dev->timer.data = (long) dev;
 804                 dev->timer.function = input_repeat_key;
 805                 dev->rep[REP_DELAY] = 250;
 806                 dev->rep[REP_PERIOD] = 33;
 807         }
 808
 809         INIT_LIST_HEAD(&dev->h_list);
 810         list_add_tail(&dev->node, &input_dev_list);
 811
 812         dev->cdev.class = &input_class;
 813         snprintf(dev->cdev.class_id, sizeof(dev->cdev.class_id),
 814                  "input%ld", (unsigned long) atomic_inc_return(&input_no) - 1);
 815
 816         error = class_device_add(&dev->cdev);
 817         if (error)
 818                 return error;
 819
 820         error = sysfs_create_group(&dev->cdev.kobj, &input_dev_attr_group);
 821         if (error)
 822                 goto fail1;
 823
 824         error = sysfs_create_group(&dev->cdev.kobj, &input_dev_id_attr_group);
 825         if (error)
 826                 goto fail2;
 827
 828         error = sysfs_create_group(&dev->cdev.kobj, &input_dev_caps_attr_group);
 829         if (error)
 830                 goto fail3;
 831
 832         __module_get(THIS_MODULE);
 833
 834         path = kobject_get_path(&dev->cdev.kobj, GFP_KERNEL);
 835         printk(KERN_INFO "input: %s as %s\n",
 836                 dev->name ? dev->name : "Unspecified device", path ? path : "N/A");
 837         kfree(path);
 838
 839         list_for_each_entry(handler, &input_handler_list, node)
 840                 if (!handler->blacklist || !input_match_device(handler->blacklist, dev))
 841                         if ((id = input_match_device(handler->id_table, dev)))
 842                                 if ((handle = handler->connect(handler, dev, id)))
 843                                         input_link_handle(handle);
 844
 845         input_wakeup_procfs_readers();
 846
 847         return 0;
 848
 849  fail3: sysfs_remove_group(&dev->cdev.kobj, &input_dev_id_attr_group);
 850  fail2: sysfs_remove_group(&dev->cdev.kobj, &input_dev_attr_group);
 851  fail1: class_device_del(&dev->cdev);
 852         return error;
 853 }
 854
 855 void input_unregister_device(struct input_dev *dev)
 856 {
 857         struct list_head * node, * next;
 858
 859         if (!dev) return;
 860
 861         del_timer_sync(&dev->timer);
 862
 863         list_for_each_safe(node, next, &dev->h_list) {
 864                 struct input_handle * handle = to_handle(node);
 865                 list_del_init(&handle->d_node);
 866                 list_del_init(&handle->h_node);
 867                 handle->handler->disconnect(handle);
 868         }
 869
 870         list_del_init(&dev->node);
 871
 872         sysfs_remove_group(&dev->cdev.kobj, &input_dev_caps_attr_group);
 873         sysfs_remove_group(&dev->cdev.kobj, &input_dev_id_attr_group);
 874         sysfs_remove_group(&dev->cdev.kobj, &input_dev_attr_group);
 875         class_device_unregister(&dev->cdev);
 876
 877         input_wakeup_procfs_readers();
 878 }
 879
 880 void input_register_handler(struct input_handler *handler)
 881 {
 882         struct input_dev *dev;
 883         struct input_handle *handle;
 884         struct input_device_id *id;
 885
 886         if (!handler) return;
 887
 888         INIT_LIST_HEAD(&handler->h_list);
 889
 890         if (handler->fops != NULL)
 891                 input_table[handler->minor >> 5] = handler;
 892
 893         list_add_tail(&handler->node, &input_handler_list);
 894
 895         list_for_each_entry(dev, &input_dev_list, node)
 896                 if (!handler->blacklist || !input_match_device(handler->blacklist, dev))
 897                         if ((id = input_match_device(handler->id_table, dev)))
 898                                 if ((handle = handler->connect(handler, dev, id)))
 899                                         input_link_handle(handle);
 900
 901         input_wakeup_procfs_readers();
 902 }
 903
 904 void input_unregister_handler(struct input_handler *handler)
 905 {
 906         struct list_head * node, * next;
 907
 908         list_for_each_safe(node, next, &handler->h_list) {
 909                 struct input_handle * handle = to_handle_h(node);
 910                 list_del_init(&handle->h_node);
 911                 list_del_init(&handle->d_node);
 912                 handler->disconnect(handle);
 913         }
 914
 915         list_del_init(&handler->node);
 916
 917         if (handler->fops != NULL)
 918                 input_table[handler->minor >> 5] = NULL;
 919
 920         input_wakeup_procfs_readers();
 921 }
 922
 923 static int input_open_file(struct inode *inode, struct file *file)
 924 {
 925         struct input_handler *handler = input_table[iminor(inode) >> 5];
 926         struct file_operations *old_fops, *new_fops = NULL;
 927         int err;
 928
 929         /* No load-on-demand here? */
 930         if (!handler || !(new_fops = fops_get(handler->fops)))
 931                 return -ENODEV;
 932
 933         /*
 934          * That's _really_ odd. Usually NULL ->open means "nothing special",
 935          * not "no device". Oh, well...
 936          */
 937         if (!new_fops->open) {
 938                 fops_put(new_fops);
 939                 return -ENODEV;
 940         }
 941         old_fops = file->f_op;
 942         file->f_op = new_fops;
 943
 944         err = new_fops->open(inode, file);
 945
 946         if (err) {
 947                 fops_put(file->f_op);
 948                 file->f_op = fops_get(old_fops);
 949         }
 950         fops_put(old_fops);
 951         return err;
 952 }
 953
 954 static struct file_operations input_fops = {
 955         .owner = THIS_MODULE,
 956         .open = input_open_file,
 957 };
 958
 959 static int __init input_init(void)
 960 {
 961         int err;
 962
 963         err = class_register(&input_class);
 964         if (err) {
 965                 printk(KERN_ERR "input: unable to register input_dev class\n");
 966                 return err;
 967         }
 968
 969         err = input_proc_init();
 970         if (err)
 971                 goto fail1;
 972
 973         err = register_chrdev(INPUT_MAJOR, "input", &input_fops);
 974         if (err) {
 975                 printk(KERN_ERR "input: unable to register char major %d", INPUT_MAJOR);
 976                 goto fail2;
 977         }
 978
 979         return 0;
 980
 981  fail2: input_proc_exit();
 982  fail1: class_unregister(&input_class);
 983         return err;
 984 }
 985
 986 static void __exit input_exit(void)
 987 {
 988         input_proc_exit();
 989         unregister_chrdev(INPUT_MAJOR, "input");
 990         class_unregister(&input_class);
 991 }
 992
 993 subsys_initcall(input_init);
 994 module_exit(input_exit);