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 #define pr_fmt(fmt) KBUILD_BASENAME ": " fmt
  14
  15 #include <linux/init.h>
  16 #include <linux/types.h>
  17 #include <linux/input.h>
  18 #include <linux/module.h>
  19 #include <linux/slab.h>
  20 #include <linux/random.h>
  21 #include <linux/major.h>
  22 #include <linux/proc_fs.h>
  23 #include <linux/sched.h>
  24 #include <linux/seq_file.h>
  25 #include <linux/poll.h>
  26 #include <linux/device.h>
  27 #include <linux/mutex.h>
  28 #include <linux/rcupdate.h>
  29 #include <linux/smp_lock.h>
  30 #include "input-compat.h"
  31
  32 MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
  33 MODULE_DESCRIPTION("Input core");
  34 MODULE_LICENSE("GPL");
  35
  36 #define INPUT_DEVICES   256
  37
  38 static LIST_HEAD(input_dev_list);
  39 static LIST_HEAD(input_handler_list);
  40
  41 /*
  42  * input_mutex protects access to both input_dev_list and input_handler_list.
  43  * This also causes input_[un]register_device and input_[un]register_handler
  44  * be mutually exclusive which simplifies locking in drivers implementing
  45  * input handlers.
  46  */
  47 static DEFINE_MUTEX(input_mutex);
  48
  49 static struct input_handler *input_table[8];
  50
  51 static inline int is_event_supported(unsigned int code,
  52                                      unsigned long *bm, unsigned int max)
  53 {
  54         return code <= max && test_bit(code, bm);
  55 }
  56
  57 static int input_defuzz_abs_event(int value, int old_val, int fuzz)
  58 {
  59         if (fuzz) {
  60                 if (value > old_val - fuzz / 2 && value < old_val + fuzz / 2)
  61                         return old_val;
  62
  63                 if (value > old_val - fuzz && value < old_val + fuzz)
  64                         return (old_val * 3 + value) / 4;
  65
  66                 if (value > old_val - fuzz * 2 && value < old_val + fuzz * 2)
  67                         return (old_val + value) / 2;
  68         }
  69
  70         return value;
  71 }
  72
  73 /*
  74  * Pass event first through all filters and then, if event has not been
  75  * filtered out, through all open handles. This function is called with
  76  * dev->event_lock held and interrupts disabled.
  77  */
  78 static void input_pass_event(struct input_dev *dev,
  79                              struct input_handler *src_handler,
  80                              unsigned int type, unsigned int code, int value)
  81 {
  82         struct input_handler *handler;
  83         struct input_handle *handle;
  84
  85         rcu_read_lock();
  86
  87         handle = rcu_dereference(dev->grab);
  88         if (handle)
  89                 handle->handler->event(handle, type, code, value);
  90         else {
  91                 bool filtered = false;
  92
  93                 list_for_each_entry_rcu(handle, &dev->h_list, d_node) {
  94                         if (!handle->open)
  95                                 continue;
  96
  97                         handler = handle->handler;
  98
  99                         /*
 100                          * If this is the handler that injected this
 101                          * particular event we want to skip it to avoid
 102                          * filters firing again and again.
 103                          */
 104                         if (handler == src_handler)
 105                                 continue;
 106
 107                         if (!handler->filter) {
 108                                 if (filtered)
 109                                         break;
 110
 111                                 handler->event(handle, type, code, value);
 112
 113                         } else if (handler->filter(handle, type, code, value))
 114                                 filtered = true;
 115                 }
 116         }
 117
 118         rcu_read_unlock();
 119 }
 120
 121 /*
 122  * Generate software autorepeat event. Note that we take
 123  * dev->event_lock here to avoid racing with input_event
 124  * which may cause keys get "stuck".
 125  */
 126 static void input_repeat_key(unsigned long data)
 127 {
 128         struct input_dev *dev = (void *) data;
 129         unsigned long flags;
 130
 131         spin_lock_irqsave(&dev->event_lock, flags);
 132
 133         if (test_bit(dev->repeat_key, dev->key) &&
 134             is_event_supported(dev->repeat_key, dev->keybit, KEY_MAX)) {
 135
 136                 input_pass_event(dev, NULL, EV_KEY, dev->repeat_key, 2);
 137
 138                 if (dev->sync) {
 139                         /*
 140                          * Only send SYN_REPORT if we are not in a middle
 141                          * of driver parsing a new hardware packet.
 142                          * Otherwise assume that the driver will send
 143                          * SYN_REPORT once it's done.
 144                          */
 145                         input_pass_event(dev, NULL, EV_SYN, SYN_REPORT, 1);
 146                 }
 147
 148                 if (dev->rep[REP_PERIOD])
 149                         mod_timer(&dev->timer, jiffies +
 150                                         msecs_to_jiffies(dev->rep[REP_PERIOD]));
 151         }
 152
 153         spin_unlock_irqrestore(&dev->event_lock, flags);
 154 }
 155
 156 static void input_start_autorepeat(struct input_dev *dev, int code)
 157 {
 158         if (test_bit(EV_REP, dev->evbit) &&
 159             dev->rep[REP_PERIOD] && dev->rep[REP_DELAY] &&
 160             dev->timer.data) {
 161                 dev->repeat_key = code;
 162                 mod_timer(&dev->timer,
 163                           jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]));
 164         }
 165 }
 166
 167 static void input_stop_autorepeat(struct input_dev *dev)
 168 {
 169         del_timer(&dev->timer);
 170 }
 171
 172 #define INPUT_IGNORE_EVENT      0
 173 #define INPUT_PASS_TO_HANDLERS  1
 174 #define INPUT_PASS_TO_DEVICE    2
 175 #define INPUT_PASS_TO_ALL       (INPUT_PASS_TO_HANDLERS | INPUT_PASS_TO_DEVICE)
 176
 177 static int input_handle_abs_event(struct input_dev *dev,
 178                                   struct input_handler *src_handler,
 179                                   unsigned int code, int *pval)
 180 {
 181         bool is_mt_event;
 182         int *pold;
 183
 184         if (code == ABS_MT_SLOT) {
 185                 /*
 186                  * "Stage" the event; we'll flush it later, when we
 187                  * get actual touch data.
 188                  */
 189                 if (*pval >= 0 && *pval < dev->mtsize)
 190                         dev->slot = *pval;
 191
 192                 return INPUT_IGNORE_EVENT;
 193         }
 194
 195         is_mt_event = code >= ABS_MT_FIRST && code <= ABS_MT_LAST;
 196
 197         if (!is_mt_event) {
 198                 pold = &dev->absinfo[code].value;
 199         } else if (dev->mt) {
 200                 struct input_mt_slot *mtslot = &dev->mt[dev->slot];
 201                 pold = &mtslot->abs[code - ABS_MT_FIRST];
 202         } else {
 203                 /*
 204                  * Bypass filtering for multi-touch events when
 205                  * not employing slots.
 206                  */
 207                 pold = NULL;
 208         }
 209
 210         if (pold) {
 211                 *pval = input_defuzz_abs_event(*pval, *pold,
 212                                                 dev->absinfo[code].fuzz);
 213                 if (*pold == *pval)
 214                         return INPUT_IGNORE_EVENT;
 215
 216                 *pold = *pval;
 217         }
 218
 219         /* Flush pending "slot" event */
 220         if (is_mt_event && dev->slot != input_abs_get_val(dev, ABS_MT_SLOT)) {
 221                 input_abs_set_val(dev, ABS_MT_SLOT, dev->slot);
 222                 input_pass_event(dev, src_handler,
 223                                  EV_ABS, ABS_MT_SLOT, dev->slot);
 224         }
 225
 226         return INPUT_PASS_TO_HANDLERS;
 227 }
 228
 229 static void input_handle_event(struct input_dev *dev,
 230                                struct input_handler *src_handler,
 231                                unsigned int type, unsigned int code, int value)
 232 {
 233         int disposition = INPUT_IGNORE_EVENT;
 234
 235         switch (type) {
 236
 237         case EV_SYN:
 238                 switch (code) {
 239                 case SYN_CONFIG:
 240                         disposition = INPUT_PASS_TO_ALL;
 241                         break;
 242
 243                 case SYN_REPORT:
 244                         if (!dev->sync) {
 245                                 dev->sync = true;
 246                                 disposition = INPUT_PASS_TO_HANDLERS;
 247                         }
 248                         break;
 249                 case SYN_MT_REPORT:
 250                         dev->sync = false;
 251                         disposition = INPUT_PASS_TO_HANDLERS;
 252                         break;
 253                 }
 254                 break;
 255
 256         case EV_KEY:
 257                 if (is_event_supported(code, dev->keybit, KEY_MAX) &&
 258                     !!test_bit(code, dev->key) != value) {
 259
 260                         if (value != 2) {
 261                                 __change_bit(code, dev->key);
 262                                 if (value)
 263                                         input_start_autorepeat(dev, code);
 264                                 else
 265                                         input_stop_autorepeat(dev);
 266                         }
 267
 268                         disposition = INPUT_PASS_TO_HANDLERS;
 269                 }
 270                 break;
 271
 272         case EV_SW:
 273                 if (is_event_supported(code, dev->swbit, SW_MAX) &&
 274                     !!test_bit(code, dev->sw) != value) {
 275
 276                         __change_bit(code, dev->sw);
 277                         disposition = INPUT_PASS_TO_HANDLERS;
 278                 }
 279                 break;
 280
 281         case EV_ABS:
 282                 if (is_event_supported(code, dev->absbit, ABS_MAX))
 283                         disposition = input_handle_abs_event(dev, src_handler,
 284                                                              code, &value);
 285
 286                 break;
 287
 288         case EV_REL:
 289                 if (is_event_supported(code, dev->relbit, REL_MAX) && value)
 290                         disposition = INPUT_PASS_TO_HANDLERS;
 291
 292                 break;
 293
 294         case EV_MSC:
 295                 if (is_event_supported(code, dev->mscbit, MSC_MAX))
 296                         disposition = INPUT_PASS_TO_ALL;
 297
 298                 break;
 299
 300         case EV_LED:
 301                 if (is_event_supported(code, dev->ledbit, LED_MAX) &&
 302                     !!test_bit(code, dev->led) != value) {
 303
 304                         __change_bit(code, dev->led);
 305                         disposition = INPUT_PASS_TO_ALL;
 306                 }
 307                 break;
 308
 309         case EV_SND:
 310                 if (is_event_supported(code, dev->sndbit, SND_MAX)) {
 311
 312                         if (!!test_bit(code, dev->snd) != !!value)
 313                                 __change_bit(code, dev->snd);
 314                         disposition = INPUT_PASS_TO_ALL;
 315                 }
 316                 break;
 317
 318         case EV_REP:
 319                 if (code <= REP_MAX && value >= 0 && dev->rep[code] != value) {
 320                         dev->rep[code] = value;
 321                         disposition = INPUT_PASS_TO_ALL;
 322                 }
 323                 break;
 324
 325         case EV_FF:
 326                 if (value >= 0)
 327                         disposition = INPUT_PASS_TO_ALL;
 328                 break;
 329
 330         case EV_PWR:
 331                 disposition = INPUT_PASS_TO_ALL;
 332                 break;
 333         }
 334
 335         if (disposition != INPUT_IGNORE_EVENT && type != EV_SYN)
 336                 dev->sync = false;
 337
 338         if ((disposition & INPUT_PASS_TO_DEVICE) && dev->event)
 339                 dev->event(dev, type, code, value);
 340
 341         if (disposition & INPUT_PASS_TO_HANDLERS)
 342                 input_pass_event(dev, src_handler, type, code, value);
 343 }
 344
 345 /**
 346  * input_event() - report new input event
 347  * @dev: device that generated the event
 348  * @type: type of the event
 349  * @code: event code
 350  * @value: value of the event
 351  *
 352  * This function should be used by drivers implementing various input
 353  * devices to report input events. See also input_inject_event().
 354  *
 355  * NOTE: input_event() may be safely used right after input device was
 356  * allocated with input_allocate_device(), even before it is registered
 357  * with input_register_device(), but the event will not reach any of the
 358  * input handlers. Such early invocation of input_event() may be used
 359  * to 'seed' initial state of a switch or initial position of absolute
 360  * axis, etc.
 361  */
 362 void input_event(struct input_dev *dev,
 363                  unsigned int type, unsigned int code, int value)
 364 {
 365         unsigned long flags;
 366
 367         if (is_event_supported(type, dev->evbit, EV_MAX)) {
 368
 369                 spin_lock_irqsave(&dev->event_lock, flags);
 370                 add_input_randomness(type, code, value);
 371                 input_handle_event(dev, NULL, type, code, value);
 372                 spin_unlock_irqrestore(&dev->event_lock, flags);
 373         }
 374 }
 375 EXPORT_SYMBOL(input_event);
 376
 377 /**
 378  * input_inject_event() - send input event from input handler
 379  * @handle: input handle to send event through
 380  * @type: type of the event
 381  * @code: event code
 382  * @value: value of the event
 383  *
 384  * Similar to input_event() but will ignore event if device is
 385  * "grabbed" and handle injecting event is not the one that owns
 386  * the device.
 387  */
 388 void input_inject_event(struct input_handle *handle,
 389                         unsigned int type, unsigned int code, int value)
 390 {
 391         struct input_dev *dev = handle->dev;
 392         struct input_handle *grab;
 393         unsigned long flags;
 394
 395         if (is_event_supported(type, dev->evbit, EV_MAX)) {
 396                 spin_lock_irqsave(&dev->event_lock, flags);
 397
 398                 rcu_read_lock();
 399                 grab = rcu_dereference(dev->grab);
 400                 if (!grab || grab == handle)
 401                         input_handle_event(dev, handle->handler,
 402                                            type, code, value);
 403                 rcu_read_unlock();
 404
 405                 spin_unlock_irqrestore(&dev->event_lock, flags);
 406         }
 407 }
 408 EXPORT_SYMBOL(input_inject_event);
 409
 410 /**
 411  * input_alloc_absinfo - allocates array of input_absinfo structs
 412  * @dev: the input device emitting absolute events
 413  *
 414  * If the absinfo struct the caller asked for is already allocated, this
 415  * functions will not do anything.
 416  */
 417 void input_alloc_absinfo(struct input_dev *dev)
 418 {
 419         if (!dev->absinfo)
 420                 dev->absinfo = kcalloc(ABS_CNT, sizeof(struct input_absinfo),
 421                                         GFP_KERNEL);
 422
 423         WARN(!dev->absinfo, "%s(): kcalloc() failed?\n", __func__);
 424 }
 425 EXPORT_SYMBOL(input_alloc_absinfo);
 426
 427 void input_set_abs_params(struct input_dev *dev, unsigned int axis,
 428                           int min, int max, int fuzz, int flat)
 429 {
 430         struct input_absinfo *absinfo;
 431
 432         input_alloc_absinfo(dev);
 433         if (!dev->absinfo)
 434                 return;
 435
 436         absinfo = &dev->absinfo[axis];
 437         absinfo->minimum = min;
 438         absinfo->maximum = max;
 439         absinfo->fuzz = fuzz;
 440         absinfo->flat = flat;
 441
 442         dev->absbit[BIT_WORD(axis)] |= BIT_MASK(axis);
 443 }
 444 EXPORT_SYMBOL(input_set_abs_params);
 445
 446
 447 /**
 448  * input_grab_device - grabs device for exclusive use
 449  * @handle: input handle that wants to own the device
 450  *
 451  * When a device is grabbed by an input handle all events generated by
 452  * the device are delivered only to this handle. Also events injected
 453  * by other input handles are ignored while device is grabbed.
 454  */
 455 int input_grab_device(struct input_handle *handle)
 456 {
 457         struct input_dev *dev = handle->dev;
 458         int retval;
 459
 460         retval = mutex_lock_interruptible(&dev->mutex);
 461         if (retval)
 462                 return retval;
 463
 464         if (dev->grab) {
 465                 retval = -EBUSY;
 466                 goto out;
 467         }
 468
 469         rcu_assign_pointer(dev->grab, handle);
 470         synchronize_rcu();
 471
 472  out:
 473         mutex_unlock(&dev->mutex);
 474         return retval;
 475 }
 476 EXPORT_SYMBOL(input_grab_device);
 477
 478 static void __input_release_device(struct input_handle *handle)
 479 {
 480         struct input_dev *dev = handle->dev;
 481
 482         if (dev->grab == handle) {
 483                 rcu_assign_pointer(dev->grab, NULL);
 484                 /* Make sure input_pass_event() notices that grab is gone */
 485                 synchronize_rcu();
 486
 487                 list_for_each_entry(handle, &dev->h_list, d_node)
 488                         if (handle->open && handle->handler->start)
 489                                 handle->handler->start(handle);
 490         }
 491 }
 492
 493 /**
 494  * input_release_device - release previously grabbed device
 495  * @handle: input handle that owns the device
 496  *
 497  * Releases previously grabbed device so that other input handles can
 498  * start receiving input events. Upon release all handlers attached
 499  * to the device have their start() method called so they have a change
 500  * to synchronize device state with the rest of the system.
 501  */
 502 void input_release_device(struct input_handle *handle)
 503 {
 504         struct input_dev *dev = handle->dev;
 505
 506         mutex_lock(&dev->mutex);
 507         __input_release_device(handle);
 508         mutex_unlock(&dev->mutex);
 509 }
 510 EXPORT_SYMBOL(input_release_device);
 511
 512 /**
 513  * input_open_device - open input device
 514  * @handle: handle through which device is being accessed
 515  *
 516  * This function should be called by input handlers when they
 517  * want to start receive events from given input device.
 518  */
 519 int input_open_device(struct input_handle *handle)
 520 {
 521         struct input_dev *dev = handle->dev;
 522         int retval;
 523
 524         retval = mutex_lock_interruptible(&dev->mutex);
 525         if (retval)
 526                 return retval;
 527
 528         if (dev->going_away) {
 529                 retval = -ENODEV;
 530                 goto out;
 531         }
 532
 533         handle->open++;
 534
 535         if (!dev->users++ && dev->open)
 536                 retval = dev->open(dev);
 537
 538         if (retval) {
 539                 dev->users--;
 540                 if (!--handle->open) {
 541                         /*
 542                          * Make sure we are not delivering any more events
 543                          * through this handle
 544                          */
 545                         synchronize_rcu();
 546                 }
 547         }
 548
 549  out:
 550         mutex_unlock(&dev->mutex);
 551         return retval;
 552 }
 553 EXPORT_SYMBOL(input_open_device);
 554
 555 int input_flush_device(struct input_handle *handle, struct file *file)
 556 {
 557         struct input_dev *dev = handle->dev;
 558         int retval;
 559
 560         retval = mutex_lock_interruptible(&dev->mutex);
 561         if (retval)
 562                 return retval;
 563
 564         if (dev->flush)
 565                 retval = dev->flush(dev, file);
 566
 567         mutex_unlock(&dev->mutex);
 568         return retval;
 569 }
 570 EXPORT_SYMBOL(input_flush_device);
 571
 572 /**
 573  * input_close_device - close input device
 574  * @handle: handle through which device is being accessed
 575  *
 576  * This function should be called by input handlers when they
 577  * want to stop receive events from given input device.
 578  */
 579 void input_close_device(struct input_handle *handle)
 580 {
 581         struct input_dev *dev = handle->dev;
 582
 583         mutex_lock(&dev->mutex);
 584
 585         __input_release_device(handle);
 586
 587         if (!--dev->users && dev->close)
 588                 dev->close(dev);
 589
 590         if (!--handle->open) {
 591                 /*
 592                  * synchronize_rcu() makes sure that input_pass_event()
 593                  * completed and that no more input events are delivered
 594                  * through this handle
 595                  */
 596                 synchronize_rcu();
 597         }
 598
 599         mutex_unlock(&dev->mutex);
 600 }
 601 EXPORT_SYMBOL(input_close_device);
 602
 603 /*
 604  * Simulate keyup events for all keys that are marked as pressed.
 605  * The function must be called with dev->event_lock held.
 606  */
 607 static void input_dev_release_keys(struct input_dev *dev)
 608 {
 609         int code;
 610
 611         if (is_event_supported(EV_KEY, dev->evbit, EV_MAX)) {
 612                 for (code = 0; code <= KEY_MAX; code++) {
 613                         if (is_event_supported(code, dev->keybit, KEY_MAX) &&
 614                             __test_and_clear_bit(code, dev->key)) {
 615                                 input_pass_event(dev, NULL, EV_KEY, code, 0);
 616                         }
 617                 }
 618                 input_pass_event(dev, NULL, EV_SYN, SYN_REPORT, 1);
 619         }
 620 }
 621
 622 /*
 623  * Prepare device for unregistering
 624  */
 625 static void input_disconnect_device(struct input_dev *dev)
 626 {
 627         struct input_handle *handle;
 628
 629         /*
 630          * Mark device as going away. Note that we take dev->mutex here
 631          * not to protect access to dev->going_away but rather to ensure
 632          * that there are no threads in the middle of input_open_device()
 633          */
 634         mutex_lock(&dev->mutex);
 635         dev->going_away = true;
 636         mutex_unlock(&dev->mutex);
 637
 638         spin_lock_irq(&dev->event_lock);
 639
 640         /*
 641          * Simulate keyup events for all pressed keys so that handlers
 642          * are not left with "stuck" keys. The driver may continue
 643          * generate events even after we done here but they will not
 644          * reach any handlers.
 645          */
 646         input_dev_release_keys(dev);
 647
 648         list_for_each_entry(handle, &dev->h_list, d_node)
 649                 handle->open = 0;
 650
 651         spin_unlock_irq(&dev->event_lock);
 652 }
 653
 654 /**
 655  * input_scancode_to_scalar() - converts scancode in &struct input_keymap_entry
 656  * @ke: keymap entry containing scancode to be converted.
 657  * @scancode: pointer to the location where converted scancode should
 658  *      be stored.
 659  *
 660  * This function is used to convert scancode stored in &struct keymap_entry
 661  * into scalar form understood by legacy keymap handling methods. These
 662  * methods expect scancodes to be represented as 'unsigned int'.
 663  */
 664 int input_scancode_to_scalar(const struct input_keymap_entry *ke,
 665                              unsigned int *scancode)
 666 {
 667         switch (ke->len) {
 668         case 1:
 669                 *scancode = *((u8 *)ke->scancode);
 670                 break;
 671
 672         case 2:
 673                 *scancode = *((u16 *)ke->scancode);
 674                 break;
 675
 676         case 4:
 677                 *scancode = *((u32 *)ke->scancode);
 678                 break;
 679
 680         default:
 681                 return -EINVAL;
 682         }
 683
 684         return 0;
 685 }
 686 EXPORT_SYMBOL(input_scancode_to_scalar);
 687
 688 /*
 689  * Those routines handle the default case where no [gs]etkeycode() is
 690  * defined. In this case, an array indexed by the scancode is used.
 691  */
 692
 693 static unsigned int input_fetch_keycode(struct input_dev *dev,
 694                                         unsigned int index)
 695 {
 696         switch (dev->keycodesize) {
 697         case 1:
 698                 return ((u8 *)dev->keycode)[index];
 699
 700         case 2:
 701                 return ((u16 *)dev->keycode)[index];
 702
 703         default:
 704                 return ((u32 *)dev->keycode)[index];
 705         }
 706 }
 707
 708 static int input_default_getkeycode(struct input_dev *dev,
 709                                     struct input_keymap_entry *ke)
 710 {
 711         unsigned int index;
 712         int error;
 713
 714         if (!dev->keycodesize)
 715                 return -EINVAL;
 716
 717         if (ke->flags & INPUT_KEYMAP_BY_INDEX)
 718                 index = ke->index;
 719         else {
 720                 error = input_scancode_to_scalar(ke, &index);
 721                 if (error)
 722                         return error;
 723         }
 724
 725         if (index >= dev->keycodemax)
 726                 return -EINVAL;
 727
 728         ke->keycode = input_fetch_keycode(dev, index);
 729         ke->index = index;
 730         ke->len = sizeof(index);
 731         memcpy(ke->scancode, &index, sizeof(index));
 732
 733         return 0;
 734 }
 735
 736 static int input_default_setkeycode(struct input_dev *dev,
 737                                     const struct input_keymap_entry *ke,
 738                                     unsigned int *old_keycode)
 739 {
 740         unsigned int index;
 741         int error;
 742         int i;
 743
 744         if (!dev->keycodesize)
 745                 return -EINVAL;
 746
 747         if (ke->flags & INPUT_KEYMAP_BY_INDEX) {
 748                 index = ke->index;
 749         } else {
 750                 error = input_scancode_to_scalar(ke, &index);
 751                 if (error)
 752                         return error;
 753         }
 754
 755         if (index >= dev->keycodemax)
 756                 return -EINVAL;
 757
 758         if (dev->keycodesize < sizeof(dev->keycode) &&
 759                         (ke->keycode >> (dev->keycodesize * 8)))
 760                 return -EINVAL;
 761
 762         switch (dev->keycodesize) {
 763                 case 1: {
 764                         u8 *k = (u8 *)dev->keycode;
 765                         *old_keycode = k[index];
 766                         k[index] = ke->keycode;
 767                         break;
 768                 }
 769                 case 2: {
 770                         u16 *k = (u16 *)dev->keycode;
 771                         *old_keycode = k[index];
 772                         k[index] = ke->keycode;
 773                         break;
 774                 }
 775                 default: {
 776                         u32 *k = (u32 *)dev->keycode;
 777                         *old_keycode = k[index];
 778                         k[index] = ke->keycode;
 779                         break;
 780                 }
 781         }
 782
 783         __clear_bit(*old_keycode, dev->keybit);
 784         __set_bit(ke->keycode, dev->keybit);
 785
 786         for (i = 0; i < dev->keycodemax; i++) {
 787                 if (input_fetch_keycode(dev, i) == *old_keycode) {
 788                         __set_bit(*old_keycode, dev->keybit);
 789                         break; /* Setting the bit twice is useless, so break */
 790                 }
 791         }
 792
 793         return 0;
 794 }
 795
 796 /**
 797  * input_get_keycode - retrieve keycode currently mapped to a given scancode
 798  * @dev: input device which keymap is being queried
 799  * @ke: keymap entry
 800  *
 801  * This function should be called by anyone interested in retrieving current
 802  * keymap. Presently evdev handlers use it.
 803  */
 804 int input_get_keycode(struct input_dev *dev, struct input_keymap_entry *ke)
 805 {
 806         unsigned long flags;
 807         int retval;
 808
 809         spin_lock_irqsave(&dev->event_lock, flags);
 810
 811         if (dev->getkeycode) {
 812                 /*
 813                  * Support for legacy drivers, that don't implement the new
 814                  * ioctls
 815                  */
 816                 u32 scancode = ke->index;
 817
 818                 memcpy(ke->scancode, &scancode, sizeof(scancode));
 819                 ke->len = sizeof(scancode);
 820                 retval = dev->getkeycode(dev, scancode, &ke->keycode);
 821         } else {
 822                 retval = dev->getkeycode_new(dev, ke);
 823         }
 824
 825         spin_unlock_irqrestore(&dev->event_lock, flags);
 826         return retval;
 827 }
 828 EXPORT_SYMBOL(input_get_keycode);
 829
 830 /**
 831  * input_set_keycode - attribute a keycode to a given scancode
 832  * @dev: input device which keymap is being updated
 833  * @ke: new keymap entry
 834  *
 835  * This function should be called by anyone needing to update current
 836  * keymap. Presently keyboard and evdev handlers use it.
 837  */
 838 int input_set_keycode(struct input_dev *dev,
 839                       const struct input_keymap_entry *ke)
 840 {
 841         unsigned long flags;
 842         unsigned int old_keycode;
 843         int retval;
 844
 845         if (ke->keycode > KEY_MAX)
 846                 return -EINVAL;
 847
 848         spin_lock_irqsave(&dev->event_lock, flags);
 849
 850         if (dev->setkeycode) {
 851                 /*
 852                  * Support for legacy drivers, that don't implement the new
 853                  * ioctls
 854                  */
 855                 unsigned int scancode;
 856
 857                 retval = input_scancode_to_scalar(ke, &scancode);
 858                 if (retval)
 859                         goto out;
 860
 861                 /*
 862                  * We need to know the old scancode, in order to generate a
 863                  * keyup effect, if the set operation happens successfully
 864                  */
 865                 if (!dev->getkeycode) {
 866                         retval = -EINVAL;
 867                         goto out;
 868                 }
 869
 870                 retval = dev->getkeycode(dev, scancode, &old_keycode);
 871                 if (retval)
 872                         goto out;
 873
 874                 retval = dev->setkeycode(dev, scancode, ke->keycode);
 875         } else {
 876                 retval = dev->setkeycode_new(dev, ke, &old_keycode);
 877         }
 878
 879         if (retval)
 880                 goto out;
 881
 882         /* Make sure KEY_RESERVED did not get enabled. */
 883         __clear_bit(KEY_RESERVED, dev->keybit);
 884
 885         /*
 886          * Simulate keyup event if keycode is not present
 887          * in the keymap anymore
 888          */
 889         if (test_bit(EV_KEY, dev->evbit) &&
 890             !is_event_supported(old_keycode, dev->keybit, KEY_MAX) &&
 891             __test_and_clear_bit(old_keycode, dev->key)) {
 892
 893                 input_pass_event(dev, NULL, EV_KEY, old_keycode, 0);
 894                 if (dev->sync)
 895                         input_pass_event(dev, NULL, EV_SYN, SYN_REPORT, 1);
 896         }
 897
 898  out:
 899         spin_unlock_irqrestore(&dev->event_lock, flags);
 900
 901         return retval;
 902 }
 903 EXPORT_SYMBOL(input_set_keycode);
 904
 905 #define MATCH_BIT(bit, max) \
 906                 for (i = 0; i < BITS_TO_LONGS(max); i++) \
 907                         if ((id->bit[i] & dev->bit[i]) != id->bit[i]) \
 908                                 break; \
 909                 if (i != BITS_TO_LONGS(max)) \
 910                         continue;
 911
 912 static const struct input_device_id *input_match_device(struct input_handler *handler,
 913                                                         struct input_dev *dev)
 914 {
 915         const struct input_device_id *id;
 916         int i;
 917
 918         for (id = handler->id_table; id->flags || id->driver_info; id++) {
 919
 920                 if (id->flags & INPUT_DEVICE_ID_MATCH_BUS)
 921                         if (id->bustype != dev->id.bustype)
 922                                 continue;
 923
 924                 if (id->flags & INPUT_DEVICE_ID_MATCH_VENDOR)
 925                         if (id->vendor != dev->id.vendor)
 926                                 continue;
 927
 928                 if (id->flags & INPUT_DEVICE_ID_MATCH_PRODUCT)
 929                         if (id->product != dev->id.product)
 930                                 continue;
 931
 932                 if (id->flags & INPUT_DEVICE_ID_MATCH_VERSION)
 933                         if (id->version != dev->id.version)
 934                                 continue;
 935
 936                 MATCH_BIT(evbit,  EV_MAX);
 937                 MATCH_BIT(keybit, KEY_MAX);
 938                 MATCH_BIT(relbit, REL_MAX);
 939                 MATCH_BIT(absbit, ABS_MAX);
 940                 MATCH_BIT(mscbit, MSC_MAX);
 941                 MATCH_BIT(ledbit, LED_MAX);
 942                 MATCH_BIT(sndbit, SND_MAX);
 943                 MATCH_BIT(ffbit,  FF_MAX);
 944                 MATCH_BIT(swbit,  SW_MAX);
 945
 946                 if (!handler->match || handler->match(handler, dev))
 947                         return id;
 948         }
 949
 950         return NULL;
 951 }
 952
 953 static int input_attach_handler(struct input_dev *dev, struct input_handler *handler)
 954 {
 955         const struct input_device_id *id;
 956         int error;
 957
 958         id = input_match_device(handler, dev);
 959         if (!id)
 960                 return -ENODEV;
 961
 962         error = handler->connect(handler, dev, id);
 963         if (error && error != -ENODEV)
 964                 pr_err("failed to attach handler %s to device %s, error: %d\n",
 965                        handler->name, kobject_name(&dev->dev.kobj), error);
 966
 967         return error;
 968 }
 969
 970 #ifdef CONFIG_COMPAT
 971
 972 static int input_bits_to_string(char *buf, int buf_size,
 973                                 unsigned long bits, bool skip_empty)
 974 {
 975         int len = 0;
 976
 977         if (INPUT_COMPAT_TEST) {
 978                 u32 dword = bits >> 32;
 979                 if (dword || !skip_empty)
 980                         len += snprintf(buf, buf_size, "%x ", dword);
 981
 982                 dword = bits & 0xffffffffUL;
 983                 if (dword || !skip_empty || len)
 984                         len += snprintf(buf + len, max(buf_size - len, 0),
 985                                         "%x", dword);
 986         } else {
 987                 if (bits || !skip_empty)
 988                         len += snprintf(buf, buf_size, "%lx", bits);
 989         }
 990
 991         return len;
 992 }
 993
 994 #else /* !CONFIG_COMPAT */
 995
 996 static int input_bits_to_string(char *buf, int buf_size,
 997                                 unsigned long bits, bool skip_empty)
 998 {
 999         return bits || !skip_empty ?
1000                 snprintf(buf, buf_size, "%lx", bits) : 0;
1001 }
1002
1003 #endif
1004
1005 #ifdef CONFIG_PROC_FS
1006
1007 static struct proc_dir_entry *proc_bus_input_dir;
1008 static DECLARE_WAIT_QUEUE_HEAD(input_devices_poll_wait);
1009 static int input_devices_state;
1010
1011 static inline void input_wakeup_procfs_readers(void)
1012 {
1013         input_devices_state++;
1014         wake_up(&input_devices_poll_wait);
1015 }
1016
1017 static unsigned int input_proc_devices_poll(struct file *file, poll_table *wait)
1018 {
1019         poll_wait(file, &input_devices_poll_wait, wait);
1020         if (file->f_version != input_devices_state) {
1021                 file->f_version = input_devices_state;
1022                 return POLLIN | POLLRDNORM;
1023         }
1024
1025         return 0;
1026 }
1027
1028 union input_seq_state {
1029         struct {
1030                 unsigned short pos;
1031                 bool mutex_acquired;
1032         };
1033         void *p;
1034 };
1035
1036 static void *input_devices_seq_start(struct seq_file *seq, loff_t *pos)
1037 {
1038         union input_seq_state *state = (union input_seq_state *)&seq->private;
1039         int error;
1040
1041         /* We need to fit into seq->private pointer */
1042         BUILD_BUG_ON(sizeof(union input_seq_state) != sizeof(seq->private));
1043
1044         error = mutex_lock_interruptible(&input_mutex);
1045         if (error) {
1046                 state->mutex_acquired = false;
1047                 return ERR_PTR(error);
1048         }
1049
1050         state->mutex_acquired = true;
1051
1052         return seq_list_start(&input_dev_list, *pos);
1053 }
1054
1055 static void *input_devices_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1056 {
1057         return seq_list_next(v, &input_dev_list, pos);
1058 }
1059
1060 static void input_seq_stop(struct seq_file *seq, void *v)
1061 {
1062         union input_seq_state *state = (union input_seq_state *)&seq->private;
1063
1064         if (state->mutex_acquired)
1065                 mutex_unlock(&input_mutex);
1066 }
1067
1068 static void input_seq_print_bitmap(struct seq_file *seq, const char *name,
1069                                    unsigned long *bitmap, int max)
1070 {
1071         int i;
1072         bool skip_empty = true;
1073         char buf[18];
1074
1075         seq_printf(seq, "B: %s=", name);
1076
1077         for (i = BITS_TO_LONGS(max) - 1; i >= 0; i--) {
1078                 if (input_bits_to_string(buf, sizeof(buf),
1079                                          bitmap[i], skip_empty)) {
1080                         skip_empty = false;
1081                         seq_printf(seq, "%s%s", buf, i > 0 ? " " : "");
1082                 }
1083         }
1084
1085         /*
1086          * If no output was produced print a single 0.
1087          */
1088         if (skip_empty)
1089                 seq_puts(seq, "0");
1090
1091         seq_putc(seq, '\n');
1092 }
1093
1094 static int input_devices_seq_show(struct seq_file *seq, void *v)
1095 {
1096         struct input_dev *dev = container_of(v, struct input_dev, node);
1097         const char *path = kobject_get_path(&dev->dev.kobj, GFP_KERNEL);
1098         struct input_handle *handle;
1099
1100         seq_printf(seq, "I: Bus=%04x Vendor=%04x Product=%04x Version=%04x\n",
1101                    dev->id.bustype, dev->id.vendor, dev->id.product, dev->id.version);
1102
1103         seq_printf(seq, "N: Name=\"%s\"\n", dev->name ? dev->name : "");
1104         seq_printf(seq, "P: Phys=%s\n", dev->phys ? dev->phys : "");
1105         seq_printf(seq, "S: Sysfs=%s\n", path ? path : "");
1106         seq_printf(seq, "U: Uniq=%s\n", dev->uniq ? dev->uniq : "");
1107         seq_printf(seq, "H: Handlers=");
1108
1109         list_for_each_entry(handle, &dev->h_list, d_node)
1110                 seq_printf(seq, "%s ", handle->name);
1111         seq_putc(seq, '\n');
1112
1113         input_seq_print_bitmap(seq, "EV", dev->evbit, EV_MAX);
1114         if (test_bit(EV_KEY, dev->evbit))
1115                 input_seq_print_bitmap(seq, "KEY", dev->keybit, KEY_MAX);
1116         if (test_bit(EV_REL, dev->evbit))
1117                 input_seq_print_bitmap(seq, "REL", dev->relbit, REL_MAX);
1118         if (test_bit(EV_ABS, dev->evbit))
1119                 input_seq_print_bitmap(seq, "ABS", dev->absbit, ABS_MAX);
1120         if (test_bit(EV_MSC, dev->evbit))
1121                 input_seq_print_bitmap(seq, "MSC", dev->mscbit, MSC_MAX);
1122         if (test_bit(EV_LED, dev->evbit))
1123                 input_seq_print_bitmap(seq, "LED", dev->ledbit, LED_MAX);
1124         if (test_bit(EV_SND, dev->evbit))
1125                 input_seq_print_bitmap(seq, "SND", dev->sndbit, SND_MAX);
1126         if (test_bit(EV_FF, dev->evbit))
1127                 input_seq_print_bitmap(seq, "FF", dev->ffbit, FF_MAX);
1128         if (test_bit(EV_SW, dev->evbit))
1129                 input_seq_print_bitmap(seq, "SW", dev->swbit, SW_MAX);
1130
1131         seq_putc(seq, '\n');
1132
1133         kfree(path);
1134         return 0;
1135 }
1136
1137 static const struct seq_operations input_devices_seq_ops = {
1138         .start  = input_devices_seq_start,
1139         .next   = input_devices_seq_next,
1140         .stop   = input_seq_stop,
1141         .show   = input_devices_seq_show,
1142 };
1143
1144 static int input_proc_devices_open(struct inode *inode, struct file *file)
1145 {
1146         return seq_open(file, &input_devices_seq_ops);
1147 }
1148
1149 static const struct file_operations input_devices_fileops = {
1150         .owner          = THIS_MODULE,
1151         .open           = input_proc_devices_open,
1152         .poll           = input_proc_devices_poll,
1153         .read           = seq_read,
1154         .llseek         = seq_lseek,
1155         .release        = seq_release,
1156 };
1157
1158 static void *input_handlers_seq_start(struct seq_file *seq, loff_t *pos)
1159 {
1160         union input_seq_state *state = (union input_seq_state *)&seq->private;
1161         int error;
1162
1163         /* We need to fit into seq->private pointer */
1164         BUILD_BUG_ON(sizeof(union input_seq_state) != sizeof(seq->private));
1165
1166         error = mutex_lock_interruptible(&input_mutex);
1167         if (error) {
1168                 state->mutex_acquired = false;
1169                 return ERR_PTR(error);
1170         }
1171
1172         state->mutex_acquired = true;
1173         state->pos = *pos;
1174
1175         return seq_list_start(&input_handler_list, *pos);
1176 }
1177
1178 static void *input_handlers_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1179 {
1180         union input_seq_state *state = (union input_seq_state *)&seq->private;
1181
1182         state->pos = *pos + 1;
1183         return seq_list_next(v, &input_handler_list, pos);
1184 }
1185
1186 static int input_handlers_seq_show(struct seq_file *seq, void *v)
1187 {
1188         struct input_handler *handler = container_of(v, struct input_handler, node);
1189         union input_seq_state *state = (union input_seq_state *)&seq->private;
1190
1191         seq_printf(seq, "N: Number=%u Name=%s", state->pos, handler->name);
1192         if (handler->filter)
1193                 seq_puts(seq, " (filter)");
1194         if (handler->fops)
1195                 seq_printf(seq, " Minor=%d", handler->minor);
1196         seq_putc(seq, '\n');
1197
1198         return 0;
1199 }
1200
1201 static const struct seq_operations input_handlers_seq_ops = {
1202         .start  = input_handlers_seq_start,
1203         .next   = input_handlers_seq_next,
1204         .stop   = input_seq_stop,
1205         .show   = input_handlers_seq_show,
1206 };
1207
1208 static int input_proc_handlers_open(struct inode *inode, struct file *file)
1209 {
1210         return seq_open(file, &input_handlers_seq_ops);
1211 }
1212
1213 static const struct file_operations input_handlers_fileops = {
1214         .owner          = THIS_MODULE,
1215         .open           = input_proc_handlers_open,
1216         .read           = seq_read,
1217         .llseek         = seq_lseek,
1218         .release        = seq_release,
1219 };
1220
1221 static int __init input_proc_init(void)
1222 {
1223         struct proc_dir_entry *entry;
1224
1225         proc_bus_input_dir = proc_mkdir("bus/input", NULL);
1226         if (!proc_bus_input_dir)
1227                 return -ENOMEM;
1228
1229         entry = proc_create("devices", 0, proc_bus_input_dir,
1230                             &input_devices_fileops);
1231         if (!entry)
1232                 goto fail1;
1233
1234         entry = proc_create("handlers", 0, proc_bus_input_dir,
1235                             &input_handlers_fileops);
1236         if (!entry)
1237                 goto fail2;
1238
1239         return 0;
1240
1241  fail2: remove_proc_entry("devices", proc_bus_input_dir);
1242  fail1: remove_proc_entry("bus/input", NULL);
1243         return -ENOMEM;
1244 }
1245
1246 static void input_proc_exit(void)
1247 {
1248         remove_proc_entry("devices", proc_bus_input_dir);
1249         remove_proc_entry("handlers", proc_bus_input_dir);
1250         remove_proc_entry("bus/input", NULL);
1251 }
1252
1253 #else /* !CONFIG_PROC_FS */
1254 static inline void input_wakeup_procfs_readers(void) { }
1255 static inline int input_proc_init(void) { return 0; }
1256 static inline void input_proc_exit(void) { }
1257 #endif
1258
1259 #define INPUT_DEV_STRING_ATTR_SHOW(name)                                \
1260 static ssize_t input_dev_show_##name(struct device *dev,                \
1261                                      struct device_attribute *attr,     \
1262                                      char *buf)                         \
1263 {                                                                       \
1264         struct input_dev *input_dev = to_input_dev(dev);                \
1265                                                                         \
1266         return scnprintf(buf, PAGE_SIZE, "%s\n",                        \
1267                          input_dev->name ? input_dev->name : "");       \
1268 }                                                                       \
1269 static DEVICE_ATTR(name, S_IRUGO, input_dev_show_##name, NULL)
1270
1271 INPUT_DEV_STRING_ATTR_SHOW(name);
1272 INPUT_DEV_STRING_ATTR_SHOW(phys);
1273 INPUT_DEV_STRING_ATTR_SHOW(uniq);
1274
1275 static int input_print_modalias_bits(char *buf, int size,
1276                                      char name, unsigned long *bm,
1277                                      unsigned int min_bit, unsigned int max_bit)
1278 {
1279         int len = 0, i;
1280
1281         len += snprintf(buf, max(size, 0), "%c", name);
1282         for (i = min_bit; i < max_bit; i++)
1283                 if (bm[BIT_WORD(i)] & BIT_MASK(i))
1284                         len += snprintf(buf + len, max(size - len, 0), "%X,", i);
1285         return len;
1286 }
1287
1288 static int input_print_modalias(char *buf, int size, struct input_dev *id,
1289                                 int add_cr)
1290 {
1291         int len;
1292
1293         len = snprintf(buf, max(size, 0),
1294                        "input:b%04Xv%04Xp%04Xe%04X-",
1295                        id->id.bustype, id->id.vendor,
1296                        id->id.product, id->id.version);
1297
1298         len += input_print_modalias_bits(buf + len, size - len,
1299                                 'e', id->evbit, 0, EV_MAX);
1300         len += input_print_modalias_bits(buf + len, size - len,
1301                                 'k', id->keybit, KEY_MIN_INTERESTING, KEY_MAX);
1302         len += input_print_modalias_bits(buf + len, size - len,
1303                                 'r', id->relbit, 0, REL_MAX);
1304         len += input_print_modalias_bits(buf + len, size - len,
1305                                 'a', id->absbit, 0, ABS_MAX);
1306         len += input_print_modalias_bits(buf + len, size - len,
1307                                 'm', id->mscbit, 0, MSC_MAX);
1308         len += input_print_modalias_bits(buf + len, size - len,
1309                                 'l', id->ledbit, 0, LED_MAX);
1310         len += input_print_modalias_bits(buf + len, size - len,
1311                                 's', id->sndbit, 0, SND_MAX);
1312         len += input_print_modalias_bits(buf + len, size - len,
1313                                 'f', id->ffbit, 0, FF_MAX);
1314         len += input_print_modalias_bits(buf + len, size - len,
1315                                 'w', id->swbit, 0, SW_MAX);
1316
1317         if (add_cr)
1318                 len += snprintf(buf + len, max(size - len, 0), "\n");
1319
1320         return len;
1321 }
1322
1323 static ssize_t input_dev_show_modalias(struct device *dev,
1324                                        struct device_attribute *attr,
1325                                        char *buf)
1326 {
1327         struct input_dev *id = to_input_dev(dev);
1328         ssize_t len;
1329
1330         len = input_print_modalias(buf, PAGE_SIZE, id, 1);
1331
1332         return min_t(int, len, PAGE_SIZE);
1333 }
1334 static DEVICE_ATTR(modalias, S_IRUGO, input_dev_show_modalias, NULL);
1335
1336 static struct attribute *input_dev_attrs[] = {
1337         &dev_attr_name.attr,
1338         &dev_attr_phys.attr,
1339         &dev_attr_uniq.attr,
1340         &dev_attr_modalias.attr,
1341         NULL
1342 };
1343
1344 static struct attribute_group input_dev_attr_group = {
1345         .attrs  = input_dev_attrs,
1346 };
1347
1348 #define INPUT_DEV_ID_ATTR(name)                                         \
1349 static ssize_t input_dev_show_id_##name(struct device *dev,             \
1350                                         struct device_attribute *attr,  \
1351                                         char *buf)                      \
1352 {                                                                       \
1353         struct input_dev *input_dev = to_input_dev(dev);                \
1354         return scnprintf(buf, PAGE_SIZE, "%04x\n", input_dev->id.name); \
1355 }                                                                       \
1356 static DEVICE_ATTR(name, S_IRUGO, input_dev_show_id_##name, NULL)
1357
1358 INPUT_DEV_ID_ATTR(bustype);
1359 INPUT_DEV_ID_ATTR(vendor);
1360 INPUT_DEV_ID_ATTR(product);
1361 INPUT_DEV_ID_ATTR(version);
1362
1363 static struct attribute *input_dev_id_attrs[] = {
1364         &dev_attr_bustype.attr,
1365         &dev_attr_vendor.attr,
1366         &dev_attr_product.attr,
1367         &dev_attr_version.attr,
1368         NULL
1369 };
1370
1371 static struct attribute_group input_dev_id_attr_group = {
1372         .name   = "id",
1373         .attrs  = input_dev_id_attrs,
1374 };
1375
1376 static int input_print_bitmap(char *buf, int buf_size, unsigned long *bitmap,
1377                               int max, int add_cr)
1378 {
1379         int i;
1380         int len = 0;
1381         bool skip_empty = true;
1382
1383         for (i = BITS_TO_LONGS(max) - 1; i >= 0; i--) {
1384                 len += input_bits_to_string(buf + len, max(buf_size - len, 0),
1385                                             bitmap[i], skip_empty);
1386                 if (len) {
1387                         skip_empty = false;
1388                         if (i > 0)
1389                                 len += snprintf(buf + len, max(buf_size - len, 0), " ");
1390                 }
1391         }
1392
1393         /*
1394          * If no output was produced print a single 0.
1395          */
1396         if (len == 0)
1397                 len = snprintf(buf, buf_size, "%d", 0);
1398
1399         if (add_cr)
1400                 len += snprintf(buf + len, max(buf_size - len, 0), "\n");
1401
1402         return len;
1403 }
1404
1405 #define INPUT_DEV_CAP_ATTR(ev, bm)                                      \
1406 static ssize_t input_dev_show_cap_##bm(struct device *dev,              \
1407                                        struct device_attribute *attr,   \
1408                                        char *buf)                       \
1409 {                                                                       \
1410         struct input_dev *input_dev = to_input_dev(dev);                \
1411         int len = input_print_bitmap(buf, PAGE_SIZE,                    \
1412                                      input_dev->bm##bit, ev##_MAX,      \
1413                                      true);                             \
1414         return min_t(int, len, PAGE_SIZE);                              \
1415 }                                                                       \
1416 static DEVICE_ATTR(bm, S_IRUGO, input_dev_show_cap_##bm, NULL)
1417
1418 INPUT_DEV_CAP_ATTR(EV, ev);
1419 INPUT_DEV_CAP_ATTR(KEY, key);
1420 INPUT_DEV_CAP_ATTR(REL, rel);
1421 INPUT_DEV_CAP_ATTR(ABS, abs);
1422 INPUT_DEV_CAP_ATTR(MSC, msc);
1423 INPUT_DEV_CAP_ATTR(LED, led);
1424 INPUT_DEV_CAP_ATTR(SND, snd);
1425 INPUT_DEV_CAP_ATTR(FF, ff);
1426 INPUT_DEV_CAP_ATTR(SW, sw);
1427
1428 static struct attribute *input_dev_caps_attrs[] = {
1429         &dev_attr_ev.attr,
1430         &dev_attr_key.attr,
1431         &dev_attr_rel.attr,
1432         &dev_attr_abs.attr,
1433         &dev_attr_msc.attr,
1434         &dev_attr_led.attr,
1435         &dev_attr_snd.attr,
1436         &dev_attr_ff.attr,
1437         &dev_attr_sw.attr,
1438         NULL
1439 };
1440
1441 static struct attribute_group input_dev_caps_attr_group = {
1442         .name   = "capabilities",
1443         .attrs  = input_dev_caps_attrs,
1444 };
1445
1446 static const struct attribute_group *input_dev_attr_groups[] = {
1447         &input_dev_attr_group,
1448         &input_dev_id_attr_group,
1449         &input_dev_caps_attr_group,
1450         NULL
1451 };
1452
1453 static void input_dev_release(struct device *device)
1454 {
1455         struct input_dev *dev = to_input_dev(device);
1456
1457         input_ff_destroy(dev);
1458         input_mt_destroy_slots(dev);
1459         kfree(dev->absinfo);
1460         kfree(dev);
1461
1462         module_put(THIS_MODULE);
1463 }
1464
1465 /*
1466  * Input uevent interface - loading event handlers based on
1467  * device bitfields.
1468  */
1469 static int input_add_uevent_bm_var(struct kobj_uevent_env *env,
1470                                    const char *name, unsigned long *bitmap, int max)
1471 {
1472         int len;
1473
1474         if (add_uevent_var(env, "%s=", name))
1475                 return -ENOMEM;
1476
1477         len = input_print_bitmap(&env->buf[env->buflen - 1],
1478                                  sizeof(env->buf) - env->buflen,
1479                                  bitmap, max, false);
1480         if (len >= (sizeof(env->buf) - env->buflen))
1481                 return -ENOMEM;
1482
1483         env->buflen += len;
1484         return 0;
1485 }
1486
1487 static int input_add_uevent_modalias_var(struct kobj_uevent_env *env,
1488                                          struct input_dev *dev)
1489 {
1490         int len;
1491
1492         if (add_uevent_var(env, "MODALIAS="))
1493                 return -ENOMEM;
1494
1495         len = input_print_modalias(&env->buf[env->buflen - 1],
1496                                    sizeof(env->buf) - env->buflen,
1497                                    dev, 0);
1498         if (len >= (sizeof(env->buf) - env->buflen))
1499                 return -ENOMEM;
1500
1501         env->buflen += len;
1502         return 0;
1503 }
1504
1505 #define INPUT_ADD_HOTPLUG_VAR(fmt, val...)                              \
1506         do {                                                            \
1507                 int err = add_uevent_var(env, fmt, val);                \
1508                 if (err)                                                \
1509                         return err;                                     \
1510         } while (0)
1511
1512 #define INPUT_ADD_HOTPLUG_BM_VAR(name, bm, max)                         \
1513         do {                                                            \
1514                 int err = input_add_uevent_bm_var(env, name, bm, max);  \
1515                 if (err)                                                \
1516                         return err;                                     \
1517         } while (0)
1518
1519 #define INPUT_ADD_HOTPLUG_MODALIAS_VAR(dev)                             \
1520         do {                                                            \
1521                 int err = input_add_uevent_modalias_var(env, dev);      \
1522                 if (err)                                                \
1523                         return err;                                     \
1524         } while (0)
1525
1526 static int input_dev_uevent(struct device *device, struct kobj_uevent_env *env)
1527 {
1528         struct input_dev *dev = to_input_dev(device);
1529
1530         INPUT_ADD_HOTPLUG_VAR("PRODUCT=%x/%x/%x/%x",
1531                                 dev->id.bustype, dev->id.vendor,
1532                                 dev->id.product, dev->id.version);
1533         if (dev->name)
1534                 INPUT_ADD_HOTPLUG_VAR("NAME=\"%s\"", dev->name);
1535         if (dev->phys)
1536                 INPUT_ADD_HOTPLUG_VAR("PHYS=\"%s\"", dev->phys);
1537         if (dev->uniq)
1538                 INPUT_ADD_HOTPLUG_VAR("UNIQ=\"%s\"", dev->uniq);
1539
1540         INPUT_ADD_HOTPLUG_BM_VAR("EV=", dev->evbit, EV_MAX);
1541         if (test_bit(EV_KEY, dev->evbit))
1542                 INPUT_ADD_HOTPLUG_BM_VAR("KEY=", dev->keybit, KEY_MAX);
1543         if (test_bit(EV_REL, dev->evbit))
1544                 INPUT_ADD_HOTPLUG_BM_VAR("REL=", dev->relbit, REL_MAX);
1545         if (test_bit(EV_ABS, dev->evbit))
1546                 INPUT_ADD_HOTPLUG_BM_VAR("ABS=", dev->absbit, ABS_MAX);
1547         if (test_bit(EV_MSC, dev->evbit))
1548                 INPUT_ADD_HOTPLUG_BM_VAR("MSC=", dev->mscbit, MSC_MAX);
1549         if (test_bit(EV_LED, dev->evbit))
1550                 INPUT_ADD_HOTPLUG_BM_VAR("LED=", dev->ledbit, LED_MAX);
1551         if (test_bit(EV_SND, dev->evbit))
1552                 INPUT_ADD_HOTPLUG_BM_VAR("SND=", dev->sndbit, SND_MAX);
1553         if (test_bit(EV_FF, dev->evbit))
1554                 INPUT_ADD_HOTPLUG_BM_VAR("FF=", dev->ffbit, FF_MAX);
1555         if (test_bit(EV_SW, dev->evbit))
1556                 INPUT_ADD_HOTPLUG_BM_VAR("SW=", dev->swbit, SW_MAX);
1557
1558         INPUT_ADD_HOTPLUG_MODALIAS_VAR(dev);
1559
1560         return 0;
1561 }
1562
1563 #define INPUT_DO_TOGGLE(dev, type, bits, on)                            \
1564         do {                                                            \
1565                 int i;                                                  \
1566                 bool active;                                            \
1567                                                                         \
1568                 if (!test_bit(EV_##type, dev->evbit))                   \
1569                         break;                                          \
1570                                                                         \
1571                 for (i = 0; i < type##_MAX; i++) {                      \
1572                         if (!test_bit(i, dev->bits##bit))               \
1573                                 continue;                               \
1574                                                                         \
1575                         active = test_bit(i, dev->bits);                \
1576                         if (!active && !on)                             \
1577                                 continue;                               \
1578                                                                         \
1579                         dev->event(dev, EV_##type, i, on ? active : 0); \
1580                 }                                                       \
1581         } while (0)
1582
1583 static void input_dev_toggle(struct input_dev *dev, bool activate)
1584 {
1585         if (!dev->event)
1586                 return;
1587
1588         INPUT_DO_TOGGLE(dev, LED, led, activate);
1589         INPUT_DO_TOGGLE(dev, SND, snd, activate);
1590
1591         if (activate && test_bit(EV_REP, dev->evbit)) {
1592                 dev->event(dev, EV_REP, REP_PERIOD, dev->rep[REP_PERIOD]);
1593                 dev->event(dev, EV_REP, REP_DELAY, dev->rep[REP_DELAY]);
1594         }
1595 }
1596
1597 /**
1598  * input_reset_device() - reset/restore the state of input device
1599  * @dev: input device whose state needs to be reset
1600  *
1601  * This function tries to reset the state of an opened input device and
1602  * bring internal state and state if the hardware in sync with each other.
1603  * We mark all keys as released, restore LED state, repeat rate, etc.
1604  */
1605 void input_reset_device(struct input_dev *dev)
1606 {
1607         mutex_lock(&dev->mutex);
1608
1609         if (dev->users) {
1610                 input_dev_toggle(dev, true);
1611
1612                 /*
1613                  * Keys that have been pressed at suspend time are unlikely
1614                  * to be still pressed when we resume.
1615                  */
1616                 spin_lock_irq(&dev->event_lock);
1617                 input_dev_release_keys(dev);
1618                 spin_unlock_irq(&dev->event_lock);
1619         }
1620
1621         mutex_unlock(&dev->mutex);
1622 }
1623 EXPORT_SYMBOL(input_reset_device);
1624
1625 #ifdef CONFIG_PM
1626 static int input_dev_suspend(struct device *dev)
1627 {
1628         struct input_dev *input_dev = to_input_dev(dev);
1629
1630         mutex_lock(&input_dev->mutex);
1631
1632         if (input_dev->users)
1633                 input_dev_toggle(input_dev, false);
1634
1635         mutex_unlock(&input_dev->mutex);
1636
1637         return 0;
1638 }
1639
1640 static int input_dev_resume(struct device *dev)
1641 {
1642         struct input_dev *input_dev = to_input_dev(dev);
1643
1644         input_reset_device(input_dev);
1645
1646         return 0;
1647 }
1648
1649 static const struct dev_pm_ops input_dev_pm_ops = {
1650         .suspend        = input_dev_suspend,
1651         .resume         = input_dev_resume,
1652         .poweroff       = input_dev_suspend,
1653         .restore        = input_dev_resume,
1654 };
1655 #endif /* CONFIG_PM */
1656
1657 static struct device_type input_dev_type = {
1658         .groups         = input_dev_attr_groups,
1659         .release        = input_dev_release,
1660         .uevent         = input_dev_uevent,
1661 #ifdef CONFIG_PM
1662         .pm             = &input_dev_pm_ops,
1663 #endif
1664 };
1665
1666 static char *input_devnode(struct device *dev, mode_t *mode)
1667 {
1668         return kasprintf(GFP_KERNEL, "input/%s", dev_name(dev));
1669 }
1670
1671 struct class input_class = {
1672         .name           = "input",
1673         .devnode        = input_devnode,
1674 };
1675 EXPORT_SYMBOL_GPL(input_class);
1676
1677 /**
1678  * input_allocate_device - allocate memory for new input device
1679  *
1680  * Returns prepared struct input_dev or NULL.
1681  *
1682  * NOTE: Use input_free_device() to free devices that have not been
1683  * registered; input_unregister_device() should be used for already
1684  * registered devices.
1685  */
1686 struct input_dev *input_allocate_device(void)
1687 {
1688         struct input_dev *dev;
1689
1690         dev = kzalloc(sizeof(struct input_dev), GFP_KERNEL);
1691         if (dev) {
1692                 dev->dev.type = &input_dev_type;
1693                 dev->dev.class = &input_class;
1694                 device_initialize(&dev->dev);
1695                 mutex_init(&dev->mutex);
1696                 spin_lock_init(&dev->event_lock);
1697                 INIT_LIST_HEAD(&dev->h_list);
1698                 INIT_LIST_HEAD(&dev->node);
1699
1700                 __module_get(THIS_MODULE);
1701         }
1702
1703         return dev;
1704 }
1705 EXPORT_SYMBOL(input_allocate_device);
1706
1707 /**
1708  * input_free_device - free memory occupied by input_dev structure
1709  * @dev: input device to free
1710  *
1711  * This function should only be used if input_register_device()
1712  * was not called yet or if it failed. Once device was registered
1713  * use input_unregister_device() and memory will be freed once last
1714  * reference to the device is dropped.
1715  *
1716  * Device should be allocated by input_allocate_device().
1717  *
1718  * NOTE: If there are references to the input device then memory
1719  * will not be freed until last reference is dropped.
1720  */
1721 void input_free_device(struct input_dev *dev)
1722 {
1723         if (dev)
1724                 input_put_device(dev);
1725 }
1726 EXPORT_SYMBOL(input_free_device);
1727
1728 /**
1729  * input_mt_create_slots() - create MT input slots
1730  * @dev: input device supporting MT events and finger tracking
1731  * @num_slots: number of slots used by the device
1732  *
1733  * This function allocates all necessary memory for MT slot handling in the
1734  * input device, and adds ABS_MT_SLOT to the device capabilities. All slots
1735  * are initially marked as unused by setting ABS_MT_TRACKING_ID to -1.
1736  */
1737 int input_mt_create_slots(struct input_dev *dev, unsigned int num_slots)
1738 {
1739         int i;
1740
1741         if (!num_slots)
1742                 return 0;
1743
1744         dev->mt = kcalloc(num_slots, sizeof(struct input_mt_slot), GFP_KERNEL);
1745         if (!dev->mt)
1746                 return -ENOMEM;
1747
1748         dev->mtsize = num_slots;
1749         input_set_abs_params(dev, ABS_MT_SLOT, 0, num_slots - 1, 0, 0);
1750
1751         /* Mark slots as 'unused' */
1752         for (i = 0; i < num_slots; i++)
1753                 dev->mt[i].abs[ABS_MT_TRACKING_ID - ABS_MT_FIRST] = -1;
1754
1755         return 0;
1756 }
1757 EXPORT_SYMBOL(input_mt_create_slots);
1758
1759 /**
1760  * input_mt_destroy_slots() - frees the MT slots of the input device
1761  * @dev: input device with allocated MT slots
1762  *
1763  * This function is only needed in error path as the input core will
1764  * automatically free the MT slots when the device is destroyed.
1765  */
1766 void input_mt_destroy_slots(struct input_dev *dev)
1767 {
1768         kfree(dev->mt);
1769         dev->mt = NULL;
1770         dev->mtsize = 0;
1771 }
1772 EXPORT_SYMBOL(input_mt_destroy_slots);
1773
1774 /**
1775  * input_set_capability - mark device as capable of a certain event
1776  * @dev: device that is capable of emitting or accepting event
1777  * @type: type of the event (EV_KEY, EV_REL, etc...)
1778  * @code: event code
1779  *
1780  * In addition to setting up corresponding bit in appropriate capability
1781  * bitmap the function also adjusts dev->evbit.
1782  */
1783 void input_set_capability(struct input_dev *dev, unsigned int type, unsigned int code)
1784 {
1785         switch (type) {
1786         case EV_KEY:
1787                 __set_bit(code, dev->keybit);
1788                 break;
1789
1790         case EV_REL:
1791                 __set_bit(code, dev->relbit);
1792                 break;
1793
1794         case EV_ABS:
1795                 __set_bit(code, dev->absbit);
1796                 break;
1797
1798         case EV_MSC:
1799                 __set_bit(code, dev->mscbit);
1800                 break;
1801
1802         case EV_SW:
1803                 __set_bit(code, dev->swbit);
1804                 break;
1805
1806         case EV_LED:
1807                 __set_bit(code, dev->ledbit);
1808                 break;
1809
1810         case EV_SND:
1811                 __set_bit(code, dev->sndbit);
1812                 break;
1813
1814         case EV_FF:
1815                 __set_bit(code, dev->ffbit);
1816                 break;
1817
1818         case EV_PWR:
1819                 /* do nothing */
1820                 break;
1821
1822         default:
1823                 pr_err("input_set_capability: unknown type %u (code %u)\n",
1824                        type, code);
1825                 dump_stack();
1826                 return;
1827         }
1828
1829         __set_bit(type, dev->evbit);
1830 }
1831 EXPORT_SYMBOL(input_set_capability);
1832
1833 #define INPUT_CLEANSE_BITMASK(dev, type, bits)                          \
1834         do {                                                            \
1835                 if (!test_bit(EV_##type, dev->evbit))                   \
1836                         memset(dev->bits##bit, 0,                       \
1837                                 sizeof(dev->bits##bit));                \
1838         } while (0)
1839
1840 static void input_cleanse_bitmasks(struct input_dev *dev)
1841 {
1842         INPUT_CLEANSE_BITMASK(dev, KEY, key);
1843         INPUT_CLEANSE_BITMASK(dev, REL, rel);
1844         INPUT_CLEANSE_BITMASK(dev, ABS, abs);
1845         INPUT_CLEANSE_BITMASK(dev, MSC, msc);
1846         INPUT_CLEANSE_BITMASK(dev, LED, led);
1847         INPUT_CLEANSE_BITMASK(dev, SND, snd);
1848         INPUT_CLEANSE_BITMASK(dev, FF, ff);
1849         INPUT_CLEANSE_BITMASK(dev, SW, sw);
1850 }
1851
1852 /**
1853  * input_register_device - register device with input core
1854  * @dev: device to be registered
1855  *
1856  * This function registers device with input core. The device must be
1857  * allocated with input_allocate_device() and all it's capabilities
1858  * set up before registering.
1859  * If function fails the device must be freed with input_free_device().
1860  * Once device has been successfully registered it can be unregistered
1861  * with input_unregister_device(); input_free_device() should not be
1862  * called in this case.
1863  */
1864 int input_register_device(struct input_dev *dev)
1865 {
1866         static atomic_t input_no = ATOMIC_INIT(0);
1867         struct input_handler *handler;
1868         const char *path;
1869         int error;
1870
1871         /* Every input device generates EV_SYN/SYN_REPORT events. */
1872         __set_bit(EV_SYN, dev->evbit);
1873
1874         /* KEY_RESERVED is not supposed to be transmitted to userspace. */
1875         __clear_bit(KEY_RESERVED, dev->keybit);
1876
1877         /* Make sure that bitmasks not mentioned in dev->evbit are clean. */
1878         input_cleanse_bitmasks(dev);
1879
1880         /*
1881          * If delay and period are pre-set by the driver, then autorepeating
1882          * is handled by the driver itself and we don't do it in input.c.
1883          */
1884         init_timer(&dev->timer);
1885         if (!dev->rep[REP_DELAY] && !dev->rep[REP_PERIOD]) {
1886                 dev->timer.data = (long) dev;
1887                 dev->timer.function = input_repeat_key;
1888                 dev->rep[REP_DELAY] = 250;
1889                 dev->rep[REP_PERIOD] = 33;
1890         }
1891
1892         if (!dev->getkeycode && !dev->getkeycode_new)
1893                 dev->getkeycode_new = input_default_getkeycode;
1894
1895         if (!dev->setkeycode && !dev->setkeycode_new)
1896                 dev->setkeycode_new = input_default_setkeycode;
1897
1898         dev_set_name(&dev->dev, "input%ld",
1899                      (unsigned long) atomic_inc_return(&input_no) - 1);
1900
1901         error = device_add(&dev->dev);
1902         if (error)
1903                 return error;
1904
1905         path = kobject_get_path(&dev->dev.kobj, GFP_KERNEL);
1906         pr_info("%s as %s\n",
1907                 dev->name ? dev->name : "Unspecified device",
1908                 path ? path : "N/A");
1909         kfree(path);
1910
1911         error = mutex_lock_interruptible(&input_mutex);
1912         if (error) {
1913                 device_del(&dev->dev);
1914                 return error;
1915         }
1916
1917         list_add_tail(&dev->node, &input_dev_list);
1918
1919         list_for_each_entry(handler, &input_handler_list, node)
1920                 input_attach_handler(dev, handler);
1921
1922         input_wakeup_procfs_readers();
1923
1924         mutex_unlock(&input_mutex);
1925
1926         return 0;
1927 }
1928 EXPORT_SYMBOL(input_register_device);
1929
1930 /**
1931  * input_unregister_device - unregister previously registered device
1932  * @dev: device to be unregistered
1933  *
1934  * This function unregisters an input device. Once device is unregistered
1935  * the caller should not try to access it as it may get freed at any moment.
1936  */
1937 void input_unregister_device(struct input_dev *dev)
1938 {
1939         struct input_handle *handle, *next;
1940
1941         input_disconnect_device(dev);
1942
1943         mutex_lock(&input_mutex);
1944
1945         list_for_each_entry_safe(handle, next, &dev->h_list, d_node)
1946                 handle->handler->disconnect(handle);
1947         WARN_ON(!list_empty(&dev->h_list));
1948
1949         del_timer_sync(&dev->timer);
1950         list_del_init(&dev->node);
1951
1952         input_wakeup_procfs_readers();
1953
1954         mutex_unlock(&input_mutex);
1955
1956         device_unregister(&dev->dev);
1957 }
1958 EXPORT_SYMBOL(input_unregister_device);
1959
1960 /**
1961  * input_register_handler - register a new input handler
1962  * @handler: handler to be registered
1963  *
1964  * This function registers a new input handler (interface) for input
1965  * devices in the system and attaches it to all input devices that
1966  * are compatible with the handler.
1967  */
1968 int input_register_handler(struct input_handler *handler)
1969 {
1970         struct input_dev *dev;
1971         int retval;
1972
1973         retval = mutex_lock_interruptible(&input_mutex);
1974         if (retval)
1975                 return retval;
1976
1977         INIT_LIST_HEAD(&handler->h_list);
1978
1979         if (handler->fops != NULL) {
1980                 if (input_table[handler->minor >> 5]) {
1981                         retval = -EBUSY;
1982                         goto out;
1983                 }
1984                 input_table[handler->minor >> 5] = handler;
1985         }
1986
1987         list_add_tail(&handler->node, &input_handler_list);
1988
1989         list_for_each_entry(dev, &input_dev_list, node)
1990                 input_attach_handler(dev, handler);
1991
1992         input_wakeup_procfs_readers();
1993
1994  out:
1995         mutex_unlock(&input_mutex);
1996         return retval;
1997 }
1998 EXPORT_SYMBOL(input_register_handler);
1999
2000 /**
2001  * input_unregister_handler - unregisters an input handler
2002  * @handler: handler to be unregistered
2003  *
2004  * This function disconnects a handler from its input devices and
2005  * removes it from lists of known handlers.
2006  */
2007 void input_unregister_handler(struct input_handler *handler)
2008 {
2009         struct input_handle *handle, *next;
2010
2011         mutex_lock(&input_mutex);
2012
2013         list_for_each_entry_safe(handle, next, &handler->h_list, h_node)
2014                 handler->disconnect(handle);
2015         WARN_ON(!list_empty(&handler->h_list));
2016
2017         list_del_init(&handler->node);
2018
2019         if (handler->fops != NULL)
2020                 input_table[handler->minor >> 5] = NULL;
2021
2022         input_wakeup_procfs_readers();
2023
2024         mutex_unlock(&input_mutex);
2025 }
2026 EXPORT_SYMBOL(input_unregister_handler);
2027
2028 /**
2029  * input_handler_for_each_handle - handle iterator
2030  * @handler: input handler to iterate
2031  * @data: data for the callback
2032  * @fn: function to be called for each handle
2033  *
2034  * Iterate over @bus's list of devices, and call @fn for each, passing
2035  * it @data and stop when @fn returns a non-zero value. The function is
2036  * using RCU to traverse the list and therefore may be usind in atonic
2037  * contexts. The @fn callback is invoked from RCU critical section and
2038  * thus must not sleep.
2039  */
2040 int input_handler_for_each_handle(struct input_handler *handler, void *data,
2041                                   int (*fn)(struct input_handle *, void *))
2042 {
2043         struct input_handle *handle;
2044         int retval = 0;
2045
2046         rcu_read_lock();
2047
2048         list_for_each_entry_rcu(handle, &handler->h_list, h_node) {
2049                 retval = fn(handle, data);
2050                 if (retval)
2051                         break;
2052         }
2053
2054         rcu_read_unlock();
2055
2056         return retval;
2057 }
2058 EXPORT_SYMBOL(input_handler_for_each_handle);
2059
2060 /**
2061  * input_register_handle - register a new input handle
2062  * @handle: handle to register
2063  *
2064  * This function puts a new input handle onto device's
2065  * and handler's lists so that events can flow through
2066  * it once it is opened using input_open_device().
2067  *
2068  * This function is supposed to be called from handler's
2069  * connect() method.
2070  */
2071 int input_register_handle(struct input_handle *handle)
2072 {
2073         struct input_handler *handler = handle->handler;
2074         struct input_dev *dev = handle->dev;
2075         int error;
2076
2077         /*
2078          * We take dev->mutex here to prevent race with
2079          * input_release_device().
2080          */
2081         error = mutex_lock_interruptible(&dev->mutex);
2082         if (error)
2083                 return error;
2084
2085         /*
2086          * Filters go to the head of the list, normal handlers
2087          * to the tail.
2088          */
2089         if (handler->filter)
2090                 list_add_rcu(&handle->d_node, &dev->h_list);
2091         else
2092                 list_add_tail_rcu(&handle->d_node, &dev->h_list);
2093
2094         mutex_unlock(&dev->mutex);
2095
2096         /*
2097          * Since we are supposed to be called from ->connect()
2098          * which is mutually exclusive with ->disconnect()
2099          * we can't be racing with input_unregister_handle()
2100          * and so separate lock is not needed here.
2101          */
2102         list_add_tail_rcu(&handle->h_node, &handler->h_list);
2103
2104         if (handler->start)
2105                 handler->start(handle);
2106
2107         return 0;
2108 }
2109 EXPORT_SYMBOL(input_register_handle);
2110
2111 /**
2112  * input_unregister_handle - unregister an input handle
2113  * @handle: handle to unregister
2114  *
2115  * This function removes input handle from device's
2116  * and handler's lists.
2117  *
2118  * This function is supposed to be called from handler's
2119  * disconnect() method.
2120  */
2121 void input_unregister_handle(struct input_handle *handle)
2122 {
2123         struct input_dev *dev = handle->dev;
2124
2125         list_del_rcu(&handle->h_node);
2126
2127         /*
2128          * Take dev->mutex to prevent race with input_release_device().
2129          */
2130         mutex_lock(&dev->mutex);
2131         list_del_rcu(&handle->d_node);
2132         mutex_unlock(&dev->mutex);
2133
2134         synchronize_rcu();
2135 }
2136 EXPORT_SYMBOL(input_unregister_handle);
2137
2138 static int input_open_file(struct inode *inode, struct file *file)
2139 {
2140         struct input_handler *handler;
2141         const struct file_operations *old_fops, *new_fops = NULL;
2142         int err;
2143
2144         err = mutex_lock_interruptible(&input_mutex);
2145         if (err)
2146                 return err;
2147
2148         /* No load-on-demand here? */
2149         handler = input_table[iminor(inode) >> 5];
2150         if (handler)
2151                 new_fops = fops_get(handler->fops);
2152
2153         mutex_unlock(&input_mutex);
2154
2155         /*
2156          * That's _really_ odd. Usually NULL ->open means "nothing special",
2157          * not "no device". Oh, well...
2158          */
2159         if (!new_fops || !new_fops->open) {
2160                 fops_put(new_fops);
2161                 err = -ENODEV;
2162                 goto out;
2163         }
2164
2165         old_fops = file->f_op;
2166         file->f_op = new_fops;
2167
2168         err = new_fops->open(inode, file);
2169         if (err) {
2170                 fops_put(file->f_op);
2171                 file->f_op = fops_get(old_fops);
2172         }
2173         fops_put(old_fops);
2174 out:
2175         return err;
2176 }
2177
2178 static const struct file_operations input_fops = {
2179         .owner = THIS_MODULE,
2180         .open = input_open_file,
2181         .llseek = noop_llseek,
2182 };
2183
2184 static int __init input_init(void)
2185 {
2186         int err;
2187
2188         err = class_register(&input_class);
2189         if (err) {
2190                 pr_err("unable to register input_dev class\n");
2191                 return err;
2192         }
2193
2194         err = input_proc_init();
2195         if (err)
2196                 goto fail1;
2197
2198         err = register_chrdev(INPUT_MAJOR, "input", &input_fops);
2199         if (err) {
2200                 pr_err("unable to register char major %d", INPUT_MAJOR);
2201                 goto fail2;
2202         }
2203
2204         return 0;
2205
2206  fail2: input_proc_exit();
2207  fail1: class_unregister(&input_class);
2208         return err;
2209 }
2210
2211 static void __exit input_exit(void)
2212 {
2213         input_proc_exit();
2214         unregister_chrdev(INPUT_MAJOR, "input");
2215         class_unregister(&input_class);
2216 }
2217
2218 subsys_initcall(input_init);
2219 module_exit(input_exit);