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