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/mt.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(ke->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, "PROP", dev->propbit, INPUT_PROP_MAX);
1114
1115         input_seq_print_bitmap(seq, "EV", dev->evbit, EV_MAX);
1116         if (test_bit(EV_KEY, dev->evbit))
1117                 input_seq_print_bitmap(seq, "KEY", dev->keybit, KEY_MAX);
1118         if (test_bit(EV_REL, dev->evbit))
1119                 input_seq_print_bitmap(seq, "REL", dev->relbit, REL_MAX);
1120         if (test_bit(EV_ABS, dev->evbit))
1121                 input_seq_print_bitmap(seq, "ABS", dev->absbit, ABS_MAX);
1122         if (test_bit(EV_MSC, dev->evbit))
1123                 input_seq_print_bitmap(seq, "MSC", dev->mscbit, MSC_MAX);
1124         if (test_bit(EV_LED, dev->evbit))
1125                 input_seq_print_bitmap(seq, "LED", dev->ledbit, LED_MAX);
1126         if (test_bit(EV_SND, dev->evbit))
1127                 input_seq_print_bitmap(seq, "SND", dev->sndbit, SND_MAX);
1128         if (test_bit(EV_FF, dev->evbit))
1129                 input_seq_print_bitmap(seq, "FF", dev->ffbit, FF_MAX);
1130         if (test_bit(EV_SW, dev->evbit))
1131                 input_seq_print_bitmap(seq, "SW", dev->swbit, SW_MAX);
1132
1133         seq_putc(seq, '\n');
1134
1135         kfree(path);
1136         return 0;
1137 }
1138
1139 static const struct seq_operations input_devices_seq_ops = {
1140         .start  = input_devices_seq_start,
1141         .next   = input_devices_seq_next,
1142         .stop   = input_seq_stop,
1143         .show   = input_devices_seq_show,
1144 };
1145
1146 static int input_proc_devices_open(struct inode *inode, struct file *file)
1147 {
1148         return seq_open(file, &input_devices_seq_ops);
1149 }
1150
1151 static const struct file_operations input_devices_fileops = {
1152         .owner          = THIS_MODULE,
1153         .open           = input_proc_devices_open,
1154         .poll           = input_proc_devices_poll,
1155         .read           = seq_read,
1156         .llseek         = seq_lseek,
1157         .release        = seq_release,
1158 };
1159
1160 static void *input_handlers_seq_start(struct seq_file *seq, loff_t *pos)
1161 {
1162         union input_seq_state *state = (union input_seq_state *)&seq->private;
1163         int error;
1164
1165         /* We need to fit into seq->private pointer */
1166         BUILD_BUG_ON(sizeof(union input_seq_state) != sizeof(seq->private));
1167
1168         error = mutex_lock_interruptible(&input_mutex);
1169         if (error) {
1170                 state->mutex_acquired = false;
1171                 return ERR_PTR(error);
1172         }
1173
1174         state->mutex_acquired = true;
1175         state->pos = *pos;
1176
1177         return seq_list_start(&input_handler_list, *pos);
1178 }
1179
1180 static void *input_handlers_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1181 {
1182         union input_seq_state *state = (union input_seq_state *)&seq->private;
1183
1184         state->pos = *pos + 1;
1185         return seq_list_next(v, &input_handler_list, pos);
1186 }
1187
1188 static int input_handlers_seq_show(struct seq_file *seq, void *v)
1189 {
1190         struct input_handler *handler = container_of(v, struct input_handler, node);
1191         union input_seq_state *state = (union input_seq_state *)&seq->private;
1192
1193         seq_printf(seq, "N: Number=%u Name=%s", state->pos, handler->name);
1194         if (handler->filter)
1195                 seq_puts(seq, " (filter)");
1196         if (handler->fops)
1197                 seq_printf(seq, " Minor=%d", handler->minor);
1198         seq_putc(seq, '\n');
1199
1200         return 0;
1201 }
1202
1203 static const struct seq_operations input_handlers_seq_ops = {
1204         .start  = input_handlers_seq_start,
1205         .next   = input_handlers_seq_next,
1206         .stop   = input_seq_stop,
1207         .show   = input_handlers_seq_show,
1208 };
1209
1210 static int input_proc_handlers_open(struct inode *inode, struct file *file)
1211 {
1212         return seq_open(file, &input_handlers_seq_ops);
1213 }
1214
1215 static const struct file_operations input_handlers_fileops = {
1216         .owner          = THIS_MODULE,
1217         .open           = input_proc_handlers_open,
1218         .read           = seq_read,
1219         .llseek         = seq_lseek,
1220         .release        = seq_release,
1221 };
1222
1223 static int __init input_proc_init(void)
1224 {
1225         struct proc_dir_entry *entry;
1226
1227         proc_bus_input_dir = proc_mkdir("bus/input", NULL);
1228         if (!proc_bus_input_dir)
1229                 return -ENOMEM;
1230
1231         entry = proc_create("devices", 0, proc_bus_input_dir,
1232                             &input_devices_fileops);
1233         if (!entry)
1234                 goto fail1;
1235
1236         entry = proc_create("handlers", 0, proc_bus_input_dir,
1237                             &input_handlers_fileops);
1238         if (!entry)
1239                 goto fail2;
1240
1241         return 0;
1242
1243  fail2: remove_proc_entry("devices", proc_bus_input_dir);
1244  fail1: remove_proc_entry("bus/input", NULL);
1245         return -ENOMEM;
1246 }
1247
1248 static void input_proc_exit(void)
1249 {
1250         remove_proc_entry("devices", proc_bus_input_dir);
1251         remove_proc_entry("handlers", proc_bus_input_dir);
1252         remove_proc_entry("bus/input", NULL);
1253 }
1254
1255 #else /* !CONFIG_PROC_FS */
1256 static inline void input_wakeup_procfs_readers(void) { }
1257 static inline int input_proc_init(void) { return 0; }
1258 static inline void input_proc_exit(void) { }
1259 #endif
1260
1261 #define INPUT_DEV_STRING_ATTR_SHOW(name)                                \
1262 static ssize_t input_dev_show_##name(struct device *dev,                \
1263                                      struct device_attribute *attr,     \
1264                                      char *buf)                         \
1265 {                                                                       \
1266         struct input_dev *input_dev = to_input_dev(dev);                \
1267                                                                         \
1268         return scnprintf(buf, PAGE_SIZE, "%s\n",                        \
1269                          input_dev->name ? input_dev->name : "");       \
1270 }                                                                       \
1271 static DEVICE_ATTR(name, S_IRUGO, input_dev_show_##name, NULL)
1272
1273 INPUT_DEV_STRING_ATTR_SHOW(name);
1274 INPUT_DEV_STRING_ATTR_SHOW(phys);
1275 INPUT_DEV_STRING_ATTR_SHOW(uniq);
1276
1277 static int input_print_modalias_bits(char *buf, int size,
1278                                      char name, unsigned long *bm,
1279                                      unsigned int min_bit, unsigned int max_bit)
1280 {
1281         int len = 0, i;
1282
1283         len += snprintf(buf, max(size, 0), "%c", name);
1284         for (i = min_bit; i < max_bit; i++)
1285                 if (bm[BIT_WORD(i)] & BIT_MASK(i))
1286                         len += snprintf(buf + len, max(size - len, 0), "%X,", i);
1287         return len;
1288 }
1289
1290 static int input_print_modalias(char *buf, int size, struct input_dev *id,
1291                                 int add_cr)
1292 {
1293         int len;
1294
1295         len = snprintf(buf, max(size, 0),
1296                        "input:b%04Xv%04Xp%04Xe%04X-",
1297                        id->id.bustype, id->id.vendor,
1298                        id->id.product, id->id.version);
1299
1300         len += input_print_modalias_bits(buf + len, size - len,
1301                                 'e', id->evbit, 0, EV_MAX);
1302         len += input_print_modalias_bits(buf + len, size - len,
1303                                 'k', id->keybit, KEY_MIN_INTERESTING, KEY_MAX);
1304         len += input_print_modalias_bits(buf + len, size - len,
1305                                 'r', id->relbit, 0, REL_MAX);
1306         len += input_print_modalias_bits(buf + len, size - len,
1307                                 'a', id->absbit, 0, ABS_MAX);
1308         len += input_print_modalias_bits(buf + len, size - len,
1309                                 'm', id->mscbit, 0, MSC_MAX);
1310         len += input_print_modalias_bits(buf + len, size - len,
1311                                 'l', id->ledbit, 0, LED_MAX);
1312         len += input_print_modalias_bits(buf + len, size - len,
1313                                 's', id->sndbit, 0, SND_MAX);
1314         len += input_print_modalias_bits(buf + len, size - len,
1315                                 'f', id->ffbit, 0, FF_MAX);
1316         len += input_print_modalias_bits(buf + len, size - len,
1317                                 'w', id->swbit, 0, SW_MAX);
1318
1319         if (add_cr)
1320                 len += snprintf(buf + len, max(size - len, 0), "\n");
1321
1322         return len;
1323 }
1324
1325 static ssize_t input_dev_show_modalias(struct device *dev,
1326                                        struct device_attribute *attr,
1327                                        char *buf)
1328 {
1329         struct input_dev *id = to_input_dev(dev);
1330         ssize_t len;
1331
1332         len = input_print_modalias(buf, PAGE_SIZE, id, 1);
1333
1334         return min_t(int, len, PAGE_SIZE);
1335 }
1336 static DEVICE_ATTR(modalias, S_IRUGO, input_dev_show_modalias, NULL);
1337
1338 static int input_print_bitmap(char *buf, int buf_size, unsigned long *bitmap,
1339                               int max, int add_cr);
1340
1341 static ssize_t input_dev_show_properties(struct device *dev,
1342                                          struct device_attribute *attr,
1343                                          char *buf)
1344 {
1345         struct input_dev *input_dev = to_input_dev(dev);
1346         int len = input_print_bitmap(buf, PAGE_SIZE, input_dev->propbit,
1347                                      INPUT_PROP_MAX, true);
1348         return min_t(int, len, PAGE_SIZE);
1349 }
1350 static DEVICE_ATTR(properties, S_IRUGO, input_dev_show_properties, NULL);
1351
1352 static struct attribute *input_dev_attrs[] = {
1353         &dev_attr_name.attr,
1354         &dev_attr_phys.attr,
1355         &dev_attr_uniq.attr,
1356         &dev_attr_modalias.attr,
1357         &dev_attr_properties.attr,
1358         NULL
1359 };
1360
1361 static struct attribute_group input_dev_attr_group = {
1362         .attrs  = input_dev_attrs,
1363 };
1364
1365 #define INPUT_DEV_ID_ATTR(name)                                         \
1366 static ssize_t input_dev_show_id_##name(struct device *dev,             \
1367                                         struct device_attribute *attr,  \
1368                                         char *buf)                      \
1369 {                                                                       \
1370         struct input_dev *input_dev = to_input_dev(dev);                \
1371         return scnprintf(buf, PAGE_SIZE, "%04x\n", input_dev->id.name); \
1372 }                                                                       \
1373 static DEVICE_ATTR(name, S_IRUGO, input_dev_show_id_##name, NULL)
1374
1375 INPUT_DEV_ID_ATTR(bustype);
1376 INPUT_DEV_ID_ATTR(vendor);
1377 INPUT_DEV_ID_ATTR(product);
1378 INPUT_DEV_ID_ATTR(version);
1379
1380 static struct attribute *input_dev_id_attrs[] = {
1381         &dev_attr_bustype.attr,
1382         &dev_attr_vendor.attr,
1383         &dev_attr_product.attr,
1384         &dev_attr_version.attr,
1385         NULL
1386 };
1387
1388 static struct attribute_group input_dev_id_attr_group = {
1389         .name   = "id",
1390         .attrs  = input_dev_id_attrs,
1391 };
1392
1393 static int input_print_bitmap(char *buf, int buf_size, unsigned long *bitmap,
1394                               int max, int add_cr)
1395 {
1396         int i;
1397         int len = 0;
1398         bool skip_empty = true;
1399
1400         for (i = BITS_TO_LONGS(max) - 1; i >= 0; i--) {
1401                 len += input_bits_to_string(buf + len, max(buf_size - len, 0),
1402                                             bitmap[i], skip_empty);
1403                 if (len) {
1404                         skip_empty = false;
1405                         if (i > 0)
1406                                 len += snprintf(buf + len, max(buf_size - len, 0), " ");
1407                 }
1408         }
1409
1410         /*
1411          * If no output was produced print a single 0.
1412          */
1413         if (len == 0)
1414                 len = snprintf(buf, buf_size, "%d", 0);
1415
1416         if (add_cr)
1417                 len += snprintf(buf + len, max(buf_size - len, 0), "\n");
1418
1419         return len;
1420 }
1421
1422 #define INPUT_DEV_CAP_ATTR(ev, bm)                                      \
1423 static ssize_t input_dev_show_cap_##bm(struct device *dev,              \
1424                                        struct device_attribute *attr,   \
1425                                        char *buf)                       \
1426 {                                                                       \
1427         struct input_dev *input_dev = to_input_dev(dev);                \
1428         int len = input_print_bitmap(buf, PAGE_SIZE,                    \
1429                                      input_dev->bm##bit, ev##_MAX,      \
1430                                      true);                             \
1431         return min_t(int, len, PAGE_SIZE);                              \
1432 }                                                                       \
1433 static DEVICE_ATTR(bm, S_IRUGO, input_dev_show_cap_##bm, NULL)
1434
1435 INPUT_DEV_CAP_ATTR(EV, ev);
1436 INPUT_DEV_CAP_ATTR(KEY, key);
1437 INPUT_DEV_CAP_ATTR(REL, rel);
1438 INPUT_DEV_CAP_ATTR(ABS, abs);
1439 INPUT_DEV_CAP_ATTR(MSC, msc);
1440 INPUT_DEV_CAP_ATTR(LED, led);
1441 INPUT_DEV_CAP_ATTR(SND, snd);
1442 INPUT_DEV_CAP_ATTR(FF, ff);
1443 INPUT_DEV_CAP_ATTR(SW, sw);
1444
1445 static struct attribute *input_dev_caps_attrs[] = {
1446         &dev_attr_ev.attr,
1447         &dev_attr_key.attr,
1448         &dev_attr_rel.attr,
1449         &dev_attr_abs.attr,
1450         &dev_attr_msc.attr,
1451         &dev_attr_led.attr,
1452         &dev_attr_snd.attr,
1453         &dev_attr_ff.attr,
1454         &dev_attr_sw.attr,
1455         NULL
1456 };
1457
1458 static struct attribute_group input_dev_caps_attr_group = {
1459         .name   = "capabilities",
1460         .attrs  = input_dev_caps_attrs,
1461 };
1462
1463 static const struct attribute_group *input_dev_attr_groups[] = {
1464         &input_dev_attr_group,
1465         &input_dev_id_attr_group,
1466         &input_dev_caps_attr_group,
1467         NULL
1468 };
1469
1470 static void input_dev_release(struct device *device)
1471 {
1472         struct input_dev *dev = to_input_dev(device);
1473
1474         input_ff_destroy(dev);
1475         input_mt_destroy_slots(dev);
1476         kfree(dev->absinfo);
1477         kfree(dev);
1478
1479         module_put(THIS_MODULE);
1480 }
1481
1482 /*
1483  * Input uevent interface - loading event handlers based on
1484  * device bitfields.
1485  */
1486 static int input_add_uevent_bm_var(struct kobj_uevent_env *env,
1487                                    const char *name, unsigned long *bitmap, int max)
1488 {
1489         int len;
1490
1491         if (add_uevent_var(env, "%s", name))
1492                 return -ENOMEM;
1493
1494         len = input_print_bitmap(&env->buf[env->buflen - 1],
1495                                  sizeof(env->buf) - env->buflen,
1496                                  bitmap, max, false);
1497         if (len >= (sizeof(env->buf) - env->buflen))
1498                 return -ENOMEM;
1499
1500         env->buflen += len;
1501         return 0;
1502 }
1503
1504 static int input_add_uevent_modalias_var(struct kobj_uevent_env *env,
1505                                          struct input_dev *dev)
1506 {
1507         int len;
1508
1509         if (add_uevent_var(env, "MODALIAS="))
1510                 return -ENOMEM;
1511
1512         len = input_print_modalias(&env->buf[env->buflen - 1],
1513                                    sizeof(env->buf) - env->buflen,
1514                                    dev, 0);
1515         if (len >= (sizeof(env->buf) - env->buflen))
1516                 return -ENOMEM;
1517
1518         env->buflen += len;
1519         return 0;
1520 }
1521
1522 #define INPUT_ADD_HOTPLUG_VAR(fmt, val...)                              \
1523         do {                                                            \
1524                 int err = add_uevent_var(env, fmt, val);                \
1525                 if (err)                                                \
1526                         return err;                                     \
1527         } while (0)
1528
1529 #define INPUT_ADD_HOTPLUG_BM_VAR(name, bm, max)                         \
1530         do {                                                            \
1531                 int err = input_add_uevent_bm_var(env, name, bm, max);  \
1532                 if (err)                                                \
1533                         return err;                                     \
1534         } while (0)
1535
1536 #define INPUT_ADD_HOTPLUG_MODALIAS_VAR(dev)                             \
1537         do {                                                            \
1538                 int err = input_add_uevent_modalias_var(env, dev);      \
1539                 if (err)                                                \
1540                         return err;                                     \
1541         } while (0)
1542
1543 static int input_dev_uevent(struct device *device, struct kobj_uevent_env *env)
1544 {
1545         struct input_dev *dev = to_input_dev(device);
1546
1547         INPUT_ADD_HOTPLUG_VAR("PRODUCT=%x/%x/%x/%x",
1548                                 dev->id.bustype, dev->id.vendor,
1549                                 dev->id.product, dev->id.version);
1550         if (dev->name)
1551                 INPUT_ADD_HOTPLUG_VAR("NAME=\"%s\"", dev->name);
1552         if (dev->phys)
1553                 INPUT_ADD_HOTPLUG_VAR("PHYS=\"%s\"", dev->phys);
1554         if (dev->uniq)
1555                 INPUT_ADD_HOTPLUG_VAR("UNIQ=\"%s\"", dev->uniq);
1556
1557         INPUT_ADD_HOTPLUG_BM_VAR("PROP=", dev->propbit, INPUT_PROP_MAX);
1558
1559         INPUT_ADD_HOTPLUG_BM_VAR("EV=", dev->evbit, EV_MAX);
1560         if (test_bit(EV_KEY, dev->evbit))
1561                 INPUT_ADD_HOTPLUG_BM_VAR("KEY=", dev->keybit, KEY_MAX);
1562         if (test_bit(EV_REL, dev->evbit))
1563                 INPUT_ADD_HOTPLUG_BM_VAR("REL=", dev->relbit, REL_MAX);
1564         if (test_bit(EV_ABS, dev->evbit))
1565                 INPUT_ADD_HOTPLUG_BM_VAR("ABS=", dev->absbit, ABS_MAX);
1566         if (test_bit(EV_MSC, dev->evbit))
1567                 INPUT_ADD_HOTPLUG_BM_VAR("MSC=", dev->mscbit, MSC_MAX);
1568         if (test_bit(EV_LED, dev->evbit))
1569                 INPUT_ADD_HOTPLUG_BM_VAR("LED=", dev->ledbit, LED_MAX);
1570         if (test_bit(EV_SND, dev->evbit))
1571                 INPUT_ADD_HOTPLUG_BM_VAR("SND=", dev->sndbit, SND_MAX);
1572         if (test_bit(EV_FF, dev->evbit))
1573                 INPUT_ADD_HOTPLUG_BM_VAR("FF=", dev->ffbit, FF_MAX);
1574         if (test_bit(EV_SW, dev->evbit))
1575                 INPUT_ADD_HOTPLUG_BM_VAR("SW=", dev->swbit, SW_MAX);
1576
1577         INPUT_ADD_HOTPLUG_MODALIAS_VAR(dev);
1578
1579         return 0;
1580 }
1581
1582 #define INPUT_DO_TOGGLE(dev, type, bits, on)                            \
1583         do {                                                            \
1584                 int i;                                                  \
1585                 bool active;                                            \
1586                                                                         \
1587                 if (!test_bit(EV_##type, dev->evbit))                   \
1588                         break;                                          \
1589                                                                         \
1590                 for (i = 0; i < type##_MAX; i++) {                      \
1591                         if (!test_bit(i, dev->bits##bit))               \
1592                                 continue;                               \
1593                                                                         \
1594                         active = test_bit(i, dev->bits);                \
1595                         if (!active && !on)                             \
1596                                 continue;                               \
1597                                                                         \
1598                         dev->event(dev, EV_##type, i, on ? active : 0); \
1599                 }                                                       \
1600         } while (0)
1601
1602 static void input_dev_toggle(struct input_dev *dev, bool activate)
1603 {
1604         if (!dev->event)
1605                 return;
1606
1607         INPUT_DO_TOGGLE(dev, LED, led, activate);
1608         INPUT_DO_TOGGLE(dev, SND, snd, activate);
1609
1610         if (activate && test_bit(EV_REP, dev->evbit)) {
1611                 dev->event(dev, EV_REP, REP_PERIOD, dev->rep[REP_PERIOD]);
1612                 dev->event(dev, EV_REP, REP_DELAY, dev->rep[REP_DELAY]);
1613         }
1614 }
1615
1616 /**
1617  * input_reset_device() - reset/restore the state of input device
1618  * @dev: input device whose state needs to be reset
1619  *
1620  * This function tries to reset the state of an opened input device and
1621  * bring internal state and state if the hardware in sync with each other.
1622  * We mark all keys as released, restore LED state, repeat rate, etc.
1623  */
1624 void input_reset_device(struct input_dev *dev)
1625 {
1626         mutex_lock(&dev->mutex);
1627
1628         if (dev->users) {
1629                 input_dev_toggle(dev, true);
1630
1631                 /*
1632                  * Keys that have been pressed at suspend time are unlikely
1633                  * to be still pressed when we resume.
1634                  */
1635                 spin_lock_irq(&dev->event_lock);
1636                 input_dev_release_keys(dev);
1637                 spin_unlock_irq(&dev->event_lock);
1638         }
1639
1640         mutex_unlock(&dev->mutex);
1641 }
1642 EXPORT_SYMBOL(input_reset_device);
1643
1644 #ifdef CONFIG_PM
1645 static int input_dev_suspend(struct device *dev)
1646 {
1647         struct input_dev *input_dev = to_input_dev(dev);
1648
1649         mutex_lock(&input_dev->mutex);
1650
1651         if (input_dev->users)
1652                 input_dev_toggle(input_dev, false);
1653
1654         mutex_unlock(&input_dev->mutex);
1655
1656         return 0;
1657 }
1658
1659 static int input_dev_resume(struct device *dev)
1660 {
1661         struct input_dev *input_dev = to_input_dev(dev);
1662
1663         input_reset_device(input_dev);
1664
1665         return 0;
1666 }
1667
1668 static const struct dev_pm_ops input_dev_pm_ops = {
1669         .suspend        = input_dev_suspend,
1670         .resume         = input_dev_resume,
1671         .poweroff       = input_dev_suspend,
1672         .restore        = input_dev_resume,
1673 };
1674 #endif /* CONFIG_PM */
1675
1676 static struct device_type input_dev_type = {
1677         .groups         = input_dev_attr_groups,
1678         .release        = input_dev_release,
1679         .uevent         = input_dev_uevent,
1680 #ifdef CONFIG_PM
1681         .pm             = &input_dev_pm_ops,
1682 #endif
1683 };
1684
1685 static char *input_devnode(struct device *dev, mode_t *mode)
1686 {
1687         return kasprintf(GFP_KERNEL, "input/%s", dev_name(dev));
1688 }
1689
1690 struct class input_class = {
1691         .name           = "input",
1692         .devnode        = input_devnode,
1693 };
1694 EXPORT_SYMBOL_GPL(input_class);
1695
1696 /**
1697  * input_allocate_device - allocate memory for new input device
1698  *
1699  * Returns prepared struct input_dev or NULL.
1700  *
1701  * NOTE: Use input_free_device() to free devices that have not been
1702  * registered; input_unregister_device() should be used for already
1703  * registered devices.
1704  */
1705 struct input_dev *input_allocate_device(void)
1706 {
1707         struct input_dev *dev;
1708
1709         dev = kzalloc(sizeof(struct input_dev), GFP_KERNEL);
1710         if (dev) {
1711                 dev->dev.type = &input_dev_type;
1712                 dev->dev.class = &input_class;
1713                 device_initialize(&dev->dev);
1714                 mutex_init(&dev->mutex);
1715                 spin_lock_init(&dev->event_lock);
1716                 INIT_LIST_HEAD(&dev->h_list);
1717                 INIT_LIST_HEAD(&dev->node);
1718
1719                 __module_get(THIS_MODULE);
1720         }
1721
1722         return dev;
1723 }
1724 EXPORT_SYMBOL(input_allocate_device);
1725
1726 /**
1727  * input_free_device - free memory occupied by input_dev structure
1728  * @dev: input device to free
1729  *
1730  * This function should only be used if input_register_device()
1731  * was not called yet or if it failed. Once device was registered
1732  * use input_unregister_device() and memory will be freed once last
1733  * reference to the device is dropped.
1734  *
1735  * Device should be allocated by input_allocate_device().
1736  *
1737  * NOTE: If there are references to the input device then memory
1738  * will not be freed until last reference is dropped.
1739  */
1740 void input_free_device(struct input_dev *dev)
1741 {
1742         if (dev)
1743                 input_put_device(dev);
1744 }
1745 EXPORT_SYMBOL(input_free_device);
1746
1747 /**
1748  * input_set_capability - mark device as capable of a certain event
1749  * @dev: device that is capable of emitting or accepting event
1750  * @type: type of the event (EV_KEY, EV_REL, etc...)
1751  * @code: event code
1752  *
1753  * In addition to setting up corresponding bit in appropriate capability
1754  * bitmap the function also adjusts dev->evbit.
1755  */
1756 void input_set_capability(struct input_dev *dev, unsigned int type, unsigned int code)
1757 {
1758         switch (type) {
1759         case EV_KEY:
1760                 __set_bit(code, dev->keybit);
1761                 break;
1762
1763         case EV_REL:
1764                 __set_bit(code, dev->relbit);
1765                 break;
1766
1767         case EV_ABS:
1768                 __set_bit(code, dev->absbit);
1769                 break;
1770
1771         case EV_MSC:
1772                 __set_bit(code, dev->mscbit);
1773                 break;
1774
1775         case EV_SW:
1776                 __set_bit(code, dev->swbit);
1777                 break;
1778
1779         case EV_LED:
1780                 __set_bit(code, dev->ledbit);
1781                 break;
1782
1783         case EV_SND:
1784                 __set_bit(code, dev->sndbit);
1785                 break;
1786
1787         case EV_FF:
1788                 __set_bit(code, dev->ffbit);
1789                 break;
1790
1791         case EV_PWR:
1792                 /* do nothing */
1793                 break;
1794
1795         default:
1796                 pr_err("input_set_capability: unknown type %u (code %u)\n",
1797                        type, code);
1798                 dump_stack();
1799                 return;
1800         }
1801
1802         __set_bit(type, dev->evbit);
1803 }
1804 EXPORT_SYMBOL(input_set_capability);
1805
1806 #define INPUT_CLEANSE_BITMASK(dev, type, bits)                          \
1807         do {                                                            \
1808                 if (!test_bit(EV_##type, dev->evbit))                   \
1809                         memset(dev->bits##bit, 0,                       \
1810                                 sizeof(dev->bits##bit));                \
1811         } while (0)
1812
1813 static void input_cleanse_bitmasks(struct input_dev *dev)
1814 {
1815         INPUT_CLEANSE_BITMASK(dev, KEY, key);
1816         INPUT_CLEANSE_BITMASK(dev, REL, rel);
1817         INPUT_CLEANSE_BITMASK(dev, ABS, abs);
1818         INPUT_CLEANSE_BITMASK(dev, MSC, msc);
1819         INPUT_CLEANSE_BITMASK(dev, LED, led);
1820         INPUT_CLEANSE_BITMASK(dev, SND, snd);
1821         INPUT_CLEANSE_BITMASK(dev, FF, ff);
1822         INPUT_CLEANSE_BITMASK(dev, SW, sw);
1823 }
1824
1825 /**
1826  * input_register_device - register device with input core
1827  * @dev: device to be registered
1828  *
1829  * This function registers device with input core. The device must be
1830  * allocated with input_allocate_device() and all it's capabilities
1831  * set up before registering.
1832  * If function fails the device must be freed with input_free_device().
1833  * Once device has been successfully registered it can be unregistered
1834  * with input_unregister_device(); input_free_device() should not be
1835  * called in this case.
1836  */
1837 int input_register_device(struct input_dev *dev)
1838 {
1839         static atomic_t input_no = ATOMIC_INIT(0);
1840         struct input_handler *handler;
1841         const char *path;
1842         int error;
1843
1844         /* Every input device generates EV_SYN/SYN_REPORT events. */
1845         __set_bit(EV_SYN, dev->evbit);
1846
1847         /* KEY_RESERVED is not supposed to be transmitted to userspace. */
1848         __clear_bit(KEY_RESERVED, dev->keybit);
1849
1850         /* Make sure that bitmasks not mentioned in dev->evbit are clean. */
1851         input_cleanse_bitmasks(dev);
1852
1853         /*
1854          * If delay and period are pre-set by the driver, then autorepeating
1855          * is handled by the driver itself and we don't do it in input.c.
1856          */
1857         init_timer(&dev->timer);
1858         if (!dev->rep[REP_DELAY] && !dev->rep[REP_PERIOD]) {
1859                 dev->timer.data = (long) dev;
1860                 dev->timer.function = input_repeat_key;
1861                 dev->rep[REP_DELAY] = 250;
1862                 dev->rep[REP_PERIOD] = 33;
1863         }
1864
1865         if (!dev->getkeycode && !dev->getkeycode_new)
1866                 dev->getkeycode_new = input_default_getkeycode;
1867
1868         if (!dev->setkeycode && !dev->setkeycode_new)
1869                 dev->setkeycode_new = input_default_setkeycode;
1870
1871         dev_set_name(&dev->dev, "input%ld",
1872                      (unsigned long) atomic_inc_return(&input_no) - 1);
1873
1874         error = device_add(&dev->dev);
1875         if (error)
1876                 return error;
1877
1878         path = kobject_get_path(&dev->dev.kobj, GFP_KERNEL);
1879         pr_info("%s as %s\n",
1880                 dev->name ? dev->name : "Unspecified device",
1881                 path ? path : "N/A");
1882         kfree(path);
1883
1884         error = mutex_lock_interruptible(&input_mutex);
1885         if (error) {
1886                 device_del(&dev->dev);
1887                 return error;
1888         }
1889
1890         list_add_tail(&dev->node, &input_dev_list);
1891
1892         list_for_each_entry(handler, &input_handler_list, node)
1893                 input_attach_handler(dev, handler);
1894
1895         input_wakeup_procfs_readers();
1896
1897         mutex_unlock(&input_mutex);
1898
1899         return 0;
1900 }
1901 EXPORT_SYMBOL(input_register_device);
1902
1903 /**
1904  * input_unregister_device - unregister previously registered device
1905  * @dev: device to be unregistered
1906  *
1907  * This function unregisters an input device. Once device is unregistered
1908  * the caller should not try to access it as it may get freed at any moment.
1909  */
1910 void input_unregister_device(struct input_dev *dev)
1911 {
1912         struct input_handle *handle, *next;
1913
1914         input_disconnect_device(dev);
1915
1916         mutex_lock(&input_mutex);
1917
1918         list_for_each_entry_safe(handle, next, &dev->h_list, d_node)
1919                 handle->handler->disconnect(handle);
1920         WARN_ON(!list_empty(&dev->h_list));
1921
1922         del_timer_sync(&dev->timer);
1923         list_del_init(&dev->node);
1924
1925         input_wakeup_procfs_readers();
1926
1927         mutex_unlock(&input_mutex);
1928
1929         device_unregister(&dev->dev);
1930 }
1931 EXPORT_SYMBOL(input_unregister_device);
1932
1933 /**
1934  * input_register_handler - register a new input handler
1935  * @handler: handler to be registered
1936  *
1937  * This function registers a new input handler (interface) for input
1938  * devices in the system and attaches it to all input devices that
1939  * are compatible with the handler.
1940  */
1941 int input_register_handler(struct input_handler *handler)
1942 {
1943         struct input_dev *dev;
1944         int retval;
1945
1946         retval = mutex_lock_interruptible(&input_mutex);
1947         if (retval)
1948                 return retval;
1949
1950         INIT_LIST_HEAD(&handler->h_list);
1951
1952         if (handler->fops != NULL) {
1953                 if (input_table[handler->minor >> 5]) {
1954                         retval = -EBUSY;
1955                         goto out;
1956                 }
1957                 input_table[handler->minor >> 5] = handler;
1958         }
1959
1960         list_add_tail(&handler->node, &input_handler_list);
1961
1962         list_for_each_entry(dev, &input_dev_list, node)
1963                 input_attach_handler(dev, handler);
1964
1965         input_wakeup_procfs_readers();
1966
1967  out:
1968         mutex_unlock(&input_mutex);
1969         return retval;
1970 }
1971 EXPORT_SYMBOL(input_register_handler);
1972
1973 /**
1974  * input_unregister_handler - unregisters an input handler
1975  * @handler: handler to be unregistered
1976  *
1977  * This function disconnects a handler from its input devices and
1978  * removes it from lists of known handlers.
1979  */
1980 void input_unregister_handler(struct input_handler *handler)
1981 {
1982         struct input_handle *handle, *next;
1983
1984         mutex_lock(&input_mutex);
1985
1986         list_for_each_entry_safe(handle, next, &handler->h_list, h_node)
1987                 handler->disconnect(handle);
1988         WARN_ON(!list_empty(&handler->h_list));
1989
1990         list_del_init(&handler->node);
1991
1992         if (handler->fops != NULL)
1993                 input_table[handler->minor >> 5] = NULL;
1994
1995         input_wakeup_procfs_readers();
1996
1997         mutex_unlock(&input_mutex);
1998 }
1999 EXPORT_SYMBOL(input_unregister_handler);
2000
2001 /**
2002  * input_handler_for_each_handle - handle iterator
2003  * @handler: input handler to iterate
2004  * @data: data for the callback
2005  * @fn: function to be called for each handle
2006  *
2007  * Iterate over @bus's list of devices, and call @fn for each, passing
2008  * it @data and stop when @fn returns a non-zero value. The function is
2009  * using RCU to traverse the list and therefore may be usind in atonic
2010  * contexts. The @fn callback is invoked from RCU critical section and
2011  * thus must not sleep.
2012  */
2013 int input_handler_for_each_handle(struct input_handler *handler, void *data,
2014                                   int (*fn)(struct input_handle *, void *))
2015 {
2016         struct input_handle *handle;
2017         int retval = 0;
2018
2019         rcu_read_lock();
2020
2021         list_for_each_entry_rcu(handle, &handler->h_list, h_node) {
2022                 retval = fn(handle, data);
2023                 if (retval)
2024                         break;
2025         }
2026
2027         rcu_read_unlock();
2028
2029         return retval;
2030 }
2031 EXPORT_SYMBOL(input_handler_for_each_handle);
2032
2033 /**
2034  * input_register_handle - register a new input handle
2035  * @handle: handle to register
2036  *
2037  * This function puts a new input handle onto device's
2038  * and handler's lists so that events can flow through
2039  * it once it is opened using input_open_device().
2040  *
2041  * This function is supposed to be called from handler's
2042  * connect() method.
2043  */
2044 int input_register_handle(struct input_handle *handle)
2045 {
2046         struct input_handler *handler = handle->handler;
2047         struct input_dev *dev = handle->dev;
2048         int error;
2049
2050         /*
2051          * We take dev->mutex here to prevent race with
2052          * input_release_device().
2053          */
2054         error = mutex_lock_interruptible(&dev->mutex);
2055         if (error)
2056                 return error;
2057
2058         /*
2059          * Filters go to the head of the list, normal handlers
2060          * to the tail.
2061          */
2062         if (handler->filter)
2063                 list_add_rcu(&handle->d_node, &dev->h_list);
2064         else
2065                 list_add_tail_rcu(&handle->d_node, &dev->h_list);
2066
2067         mutex_unlock(&dev->mutex);
2068
2069         /*
2070          * Since we are supposed to be called from ->connect()
2071          * which is mutually exclusive with ->disconnect()
2072          * we can't be racing with input_unregister_handle()
2073          * and so separate lock is not needed here.
2074          */
2075         list_add_tail_rcu(&handle->h_node, &handler->h_list);
2076
2077         if (handler->start)
2078                 handler->start(handle);
2079
2080         return 0;
2081 }
2082 EXPORT_SYMBOL(input_register_handle);
2083
2084 /**
2085  * input_unregister_handle - unregister an input handle
2086  * @handle: handle to unregister
2087  *
2088  * This function removes input handle from device's
2089  * and handler's lists.
2090  *
2091  * This function is supposed to be called from handler's
2092  * disconnect() method.
2093  */
2094 void input_unregister_handle(struct input_handle *handle)
2095 {
2096         struct input_dev *dev = handle->dev;
2097
2098         list_del_rcu(&handle->h_node);
2099
2100         /*
2101          * Take dev->mutex to prevent race with input_release_device().
2102          */
2103         mutex_lock(&dev->mutex);
2104         list_del_rcu(&handle->d_node);
2105         mutex_unlock(&dev->mutex);
2106
2107         synchronize_rcu();
2108 }
2109 EXPORT_SYMBOL(input_unregister_handle);
2110
2111 static int input_open_file(struct inode *inode, struct file *file)
2112 {
2113         struct input_handler *handler;
2114         const struct file_operations *old_fops, *new_fops = NULL;
2115         int err;
2116
2117         err = mutex_lock_interruptible(&input_mutex);
2118         if (err)
2119                 return err;
2120
2121         /* No load-on-demand here? */
2122         handler = input_table[iminor(inode) >> 5];
2123         if (handler)
2124                 new_fops = fops_get(handler->fops);
2125
2126         mutex_unlock(&input_mutex);
2127
2128         /*
2129          * That's _really_ odd. Usually NULL ->open means "nothing special",
2130          * not "no device". Oh, well...
2131          */
2132         if (!new_fops || !new_fops->open) {
2133                 fops_put(new_fops);
2134                 err = -ENODEV;
2135                 goto out;
2136         }
2137
2138         old_fops = file->f_op;
2139         file->f_op = new_fops;
2140
2141         err = new_fops->open(inode, file);
2142         if (err) {
2143                 fops_put(file->f_op);
2144                 file->f_op = fops_get(old_fops);
2145         }
2146         fops_put(old_fops);
2147 out:
2148         return err;
2149 }
2150
2151 static const struct file_operations input_fops = {
2152         .owner = THIS_MODULE,
2153         .open = input_open_file,
2154         .llseek = noop_llseek,
2155 };
2156
2157 static int __init input_init(void)
2158 {
2159         int err;
2160
2161         err = class_register(&input_class);
2162         if (err) {
2163                 pr_err("unable to register input_dev class\n");
2164                 return err;
2165         }
2166
2167         err = input_proc_init();
2168         if (err)
2169                 goto fail1;
2170
2171         err = register_chrdev(INPUT_MAJOR, "input", &input_fops);
2172         if (err) {
2173                 pr_err("unable to register char major %d", INPUT_MAJOR);
2174                 goto fail2;
2175         }
2176
2177         return 0;
2178
2179  fail2: input_proc_exit();
2180  fail1: class_unregister(&input_class);
2181         return err;
2182 }
2183
2184 static void __exit input_exit(void)
2185 {
2186         input_proc_exit();
2187         unregister_chrdev(INPUT_MAJOR, "input");
2188         class_unregister(&input_class);
2189 }
2190
2191 subsys_initcall(input_init);
2192 module_exit(input_exit);