drivers/platform/x86/panasonic-laptop.c

   1 /*
   2  *  Panasonic HotKey and LCD brightness control driver
   3  *  (C) 2004 Hiroshi Miura <miura@da-cha.org>
   4  *  (C) 2004 NTT DATA Intellilink Co. http://www.intellilink.co.jp/
   5  *  (C) YOKOTA Hiroshi <yokota (at) netlab. is. tsukuba. ac. jp>
   6  *  (C) 2004 David Bronaugh <dbronaugh>
   7  *  (C) 2006-2008 Harald Welte <laforge@gnumonks.org>
   8  *
   9  *  derived from toshiba_acpi.c, Copyright (C) 2002-2004 John Belmonte
  10  *
  11  *  This program is free software; you can redistribute it and/or modify
  12  *  it under the terms of the GNU General Public License version 2 as
  13  *  publicshed by the Free Software Foundation.
  14  *
  15  *  This program is distributed in the hope that it will be useful,
  16  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  *  GNU General Public License for more details.
  19  *
  20  *  You should have received a copy of the GNU General Public License
  21  *  along with this program; if not, write to the Free Software
  22  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307  USA
  23  *
  24  *---------------------------------------------------------------------------
  25  *
  26  * ChangeLog:
  27  *      Sep.23, 2008    Harald Welte <laforge@gnumonks.org>
  28  *              -v0.95  rename driver from drivers/acpi/pcc_acpi.c to
  29  *                      drivers/misc/panasonic-laptop.c
  30  *
  31  *      Jul.04, 2008    Harald Welte <laforge@gnumonks.org>
  32  *              -v0.94  replace /proc interface with device attributes
  33  *                      support {set,get}keycode on th input device
  34  *
  35  *      Jun.27, 2008    Harald Welte <laforge@gnumonks.org>
  36  *              -v0.92  merge with 2.6.26-rc6 input API changes
  37  *                      remove broken <= 2.6.15 kernel support
  38  *                      resolve all compiler warnings
  39  *                      various coding style fixes (checkpatch.pl)
  40  *                      add support for backlight api
  41  *                      major code restructuring
  42  *
  43  *      Dac.28, 2007    Harald Welte <laforge@gnumonks.org>
  44  *              -v0.91  merge with 2.6.24-rc6 ACPI changes
  45  *
  46  *      Nov.04, 2006    Hiroshi Miura <miura@da-cha.org>
  47  *              -v0.9   remove warning about section reference.
  48  *                      remove acpi_os_free
  49  *                      add /proc/acpi/pcc/brightness interface for HAL access
  50  *                      merge dbronaugh's enhancement
  51  *                      Aug.17, 2004 David Bronaugh (dbronaugh)
  52  *                              - Added screen brightness setting interface
  53  *                                Thanks to FreeBSD crew (acpi_panasonic.c)
  54  *                                for the ideas I needed to accomplish it
  55  *
  56  *      May.29, 2006    Hiroshi Miura <miura@da-cha.org>
  57  *              -v0.8.4 follow to change keyinput structure
  58  *                      thanks Fabian Yamaguchi <fabs@cs.tu-berlin.de>,
  59  *                      Jacob Bower <jacob.bower@ic.ac.uk> and
  60  *                      Hiroshi Yokota for providing solutions.
  61  *
  62  *      Oct.02, 2004    Hiroshi Miura <miura@da-cha.org>
  63  *              -v0.8.2 merge code of YOKOTA Hiroshi
  64  *                                      <yokota@netlab.is.tsukuba.ac.jp>.
  65  *                      Add sticky key mode interface.
  66  *                      Refactoring acpi_pcc_generate_keyinput().
  67  *
  68  *      Sep.15, 2004    Hiroshi Miura <miura@da-cha.org>
  69  *              -v0.8   Generate key input event on input subsystem.
  70  *                      This is based on yet another driver written by
  71  *                                                      Ryuta Nakanishi.
  72  *
  73  *      Sep.10, 2004    Hiroshi Miura <miura@da-cha.org>
  74  *              -v0.7   Change proc interface functions using seq_file
  75  *                      facility as same as other ACPI drivers.
  76  *
  77  *      Aug.28, 2004    Hiroshi Miura <miura@da-cha.org>
  78  *              -v0.6.4 Fix a silly error with status checking
  79  *
  80  *      Aug.25, 2004    Hiroshi Miura <miura@da-cha.org>
  81  *              -v0.6.3 replace read_acpi_int by standard function
  82  *                                                      acpi_evaluate_integer
  83  *                      some clean up and make smart copyright notice.
  84  *                      fix return value of pcc_acpi_get_key()
  85  *                      fix checking return value of acpi_bus_register_driver()
  86  *
  87  *      Aug.22, 2004    David Bronaugh <dbronaugh@linuxboxen.org>
  88  *              -v0.6.2 Add check on ACPI data (num_sifr)
  89  *                      Coding style cleanups, better error messages/handling
  90  *                      Fixed an off-by-one error in memory allocation
  91  *
  92  *      Aug.21, 2004    David Bronaugh <dbronaugh@linuxboxen.org>
  93  *              -v0.6.1 Fix a silly error with status checking
  94  *
  95  *      Aug.20, 2004    David Bronaugh <dbronaugh@linuxboxen.org>
  96  *              - v0.6  Correct brightness controls to reflect reality
  97  *                      based on information gleaned by Hiroshi Miura
  98  *                      and discussions with Hiroshi Miura
  99  *
 100  *      Aug.10, 2004    Hiroshi Miura <miura@da-cha.org>
 101  *              - v0.5  support LCD brightness control
 102  *                      based on the disclosed information by MEI.
 103  *
 104  *      Jul.25, 2004    Hiroshi Miura <miura@da-cha.org>
 105  *              - v0.4  first post version
 106  *                      add function to retrive SIFR
 107  *
 108  *      Jul.24, 2004    Hiroshi Miura <miura@da-cha.org>
 109  *              - v0.3  get proper status of hotkey
 110  *
 111  *      Jul.22, 2004    Hiroshi Miura <miura@da-cha.org>
 112  *              - v0.2  add HotKey handler
 113  *
 114  *      Jul.17, 2004    Hiroshi Miura <miura@da-cha.org>
 115  *              - v0.1  start from toshiba_acpi driver written by John Belmonte
 116  *
 117  */
 118
 119 #include <linux/kernel.h>
 120 #include <linux/module.h>
 121 #include <linux/init.h>
 122 #include <linux/types.h>
 123 #include <linux/backlight.h>
 124 #include <linux/ctype.h>
 125 #include <linux/seq_file.h>
 126 #include <linux/uaccess.h>
 127 #include <acpi/acpi_bus.h>
 128 #include <acpi/acpi_drivers.h>
 129 #include <linux/input.h>
 130
 131
 132 #ifndef ACPI_HOTKEY_COMPONENT
 133 #define ACPI_HOTKEY_COMPONENT   0x10000000
 134 #endif
 135
 136 #define _COMPONENT              ACPI_HOTKEY_COMPONENT
 137
 138 MODULE_AUTHOR("Hiroshi Miura, David Bronaugh and Harald Welte");
 139 MODULE_DESCRIPTION("ACPI HotKey driver for Panasonic Let's Note laptops");
 140 MODULE_LICENSE("GPL");
 141
 142 #define LOGPREFIX "pcc_acpi: "
 143
 144 /* Define ACPI PATHs */
 145 /* Lets note hotkeys */
 146 #define METHOD_HKEY_QUERY       "HINF"
 147 #define METHOD_HKEY_SQTY        "SQTY"
 148 #define METHOD_HKEY_SINF        "SINF"
 149 #define METHOD_HKEY_SSET        "SSET"
 150 #define HKEY_NOTIFY              0x80
 151
 152 #define ACPI_PCC_DRIVER_NAME    "Panasonic Laptop Support"
 153 #define ACPI_PCC_DEVICE_NAME    "Hotkey"
 154 #define ACPI_PCC_CLASS          "pcc"
 155
 156 #define ACPI_PCC_INPUT_PHYS     "panasonic/hkey0"
 157
 158 /* LCD_TYPEs: 0 = Normal, 1 = Semi-transparent
 159    ENV_STATEs: Normal temp=0x01, High temp=0x81, N/A=0x00
 160 */
 161 enum SINF_BITS { SINF_NUM_BATTERIES = 0,
 162                  SINF_LCD_TYPE,
 163                  SINF_AC_MAX_BRIGHT,
 164                  SINF_AC_MIN_BRIGHT,
 165                  SINF_AC_CUR_BRIGHT,
 166                  SINF_DC_MAX_BRIGHT,
 167                  SINF_DC_MIN_BRIGHT,
 168                  SINF_DC_CUR_BRIGHT,
 169                  SINF_MUTE,
 170                  SINF_RESERVED,
 171                  SINF_ENV_STATE,
 172                  SINF_STICKY_KEY = 0x80,
 173         };
 174 /* R1 handles SINF_AC_CUR_BRIGHT as SINF_CUR_BRIGHT, doesn't know AC state */
 175
 176 static int acpi_pcc_hotkey_add(struct acpi_device *device);
 177 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type);
 178 static int acpi_pcc_hotkey_resume(struct acpi_device *device);
 179
 180 static const struct acpi_device_id pcc_device_ids[] = {
 181         { "MAT0012", 0},
 182         { "MAT0013", 0},
 183         { "MAT0018", 0},
 184         { "MAT0019", 0},
 185         { "", 0},
 186 };
 187 MODULE_DEVICE_TABLE(acpi, pcc_device_ids);
 188
 189 static struct acpi_driver acpi_pcc_driver = {
 190         .name =         ACPI_PCC_DRIVER_NAME,
 191         .class =        ACPI_PCC_CLASS,
 192         .ids =          pcc_device_ids,
 193         .ops =          {
 194                                 .add =          acpi_pcc_hotkey_add,
 195                                 .remove =       acpi_pcc_hotkey_remove,
 196                                 .resume =       acpi_pcc_hotkey_resume,
 197                         },
 198 };
 199
 200 #define KEYMAP_SIZE             11
 201 static const int initial_keymap[KEYMAP_SIZE] = {
 202         /*  0 */ KEY_RESERVED,
 203         /*  1 */ KEY_BRIGHTNESSDOWN,
 204         /*  2 */ KEY_BRIGHTNESSUP,
 205         /*  3 */ KEY_DISPLAYTOGGLE,
 206         /*  4 */ KEY_MUTE,
 207         /*  5 */ KEY_VOLUMEDOWN,
 208         /*  6 */ KEY_VOLUMEUP,
 209         /*  7 */ KEY_SLEEP,
 210         /*  8 */ KEY_PROG1, /* Change CPU boost */
 211         /*  9 */ KEY_BATTERY,
 212         /* 10 */ KEY_SUSPEND,
 213 };
 214
 215 struct pcc_acpi {
 216         acpi_handle             handle;
 217         unsigned long           num_sifr;
 218         int                     sticky_mode;
 219         u32                     *sinf;
 220         struct acpi_device      *device;
 221         struct input_dev        *input_dev;
 222         struct backlight_device *backlight;
 223         int                     keymap[KEYMAP_SIZE];
 224 };
 225
 226 struct pcc_keyinput {
 227         struct acpi_hotkey      *hotkey;
 228 };
 229
 230 /* method access functions */
 231 static int acpi_pcc_write_sset(struct pcc_acpi *pcc, int func, int val)
 232 {
 233         union acpi_object in_objs[] = {
 234                 { .integer.type  = ACPI_TYPE_INTEGER,
 235                   .integer.value = func, },
 236                 { .integer.type  = ACPI_TYPE_INTEGER,
 237                   .integer.value = val, },
 238         };
 239         struct acpi_object_list params = {
 240                 .count   = ARRAY_SIZE(in_objs),
 241                 .pointer = in_objs,
 242         };
 243         acpi_status status = AE_OK;
 244
 245         status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SSET,
 246                                       &params, NULL);
 247
 248         return status == AE_OK;
 249 }
 250
 251 static inline int acpi_pcc_get_sqty(struct acpi_device *device)
 252 {
 253         unsigned long long s;
 254         acpi_status status;
 255
 256         status = acpi_evaluate_integer(device->handle, METHOD_HKEY_SQTY,
 257                                        NULL, &s);
 258         if (ACPI_SUCCESS(status))
 259                 return s;
 260         else {
 261                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 262                                   "evaluation error HKEY.SQTY\n"));
 263                 return -EINVAL;
 264         }
 265 }
 266
 267 static int acpi_pcc_retrieve_biosdata(struct pcc_acpi *pcc, u32 *sinf)
 268 {
 269         acpi_status status;
 270         struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
 271         union acpi_object *hkey = NULL;
 272         int i;
 273
 274         status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SINF, 0,
 275                                       &buffer);
 276         if (ACPI_FAILURE(status)) {
 277                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 278                                   "evaluation error HKEY.SINF\n"));
 279                 return 0;
 280         }
 281
 282         hkey = buffer.pointer;
 283         if (!hkey || (hkey->type != ACPI_TYPE_PACKAGE)) {
 284                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid HKEY.SINF\n"));
 285                 goto end;
 286         }
 287
 288         if (pcc->num_sifr < hkey->package.count) {
 289                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 290                                  "SQTY reports bad SINF length\n"));
 291                 status = AE_ERROR;
 292                 goto end;
 293         }
 294
 295         for (i = 0; i < hkey->package.count; i++) {
 296                 union acpi_object *element = &(hkey->package.elements[i]);
 297                 if (likely(element->type == ACPI_TYPE_INTEGER)) {
 298                         sinf[i] = element->integer.value;
 299                 } else
 300                         ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 301                                          "Invalid HKEY.SINF data\n"));
 302         }
 303         sinf[hkey->package.count] = -1;
 304
 305 end:
 306         kfree(buffer.pointer);
 307         return status == AE_OK;
 308 }
 309
 310 /* backlight API interface functions */
 311
 312 /* This driver currently treats AC and DC brightness identical,
 313  * since we don't need to invent an interface to the core ACPI
 314  * logic to receive events in case a power supply is plugged in
 315  * or removed */
 316
 317 static int bl_get(struct backlight_device *bd)
 318 {
 319         struct pcc_acpi *pcc = bl_get_data(bd);
 320
 321         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
 322                 return -EIO;
 323
 324         return pcc->sinf[SINF_AC_CUR_BRIGHT];
 325 }
 326
 327 static int bl_set_status(struct backlight_device *bd)
 328 {
 329         struct pcc_acpi *pcc = bl_get_data(bd);
 330         int bright = bd->props.brightness;
 331         int rc;
 332
 333         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
 334                 return -EIO;
 335
 336         if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT])
 337                 bright = pcc->sinf[SINF_AC_MIN_BRIGHT];
 338
 339         if (bright < pcc->sinf[SINF_DC_MIN_BRIGHT])
 340                 bright = pcc->sinf[SINF_DC_MIN_BRIGHT];
 341
 342         if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT] ||
 343             bright > pcc->sinf[SINF_AC_MAX_BRIGHT])
 344                 return -EINVAL;
 345
 346         rc = acpi_pcc_write_sset(pcc, SINF_AC_CUR_BRIGHT, bright);
 347         if (rc < 0)
 348                 return rc;
 349
 350         return acpi_pcc_write_sset(pcc, SINF_DC_CUR_BRIGHT, bright);
 351 }
 352
 353 static struct backlight_ops pcc_backlight_ops = {
 354         .get_brightness = bl_get,
 355         .update_status  = bl_set_status,
 356 };
 357
 358
 359 /* sysfs user interface functions */
 360
 361 static ssize_t show_numbatt(struct device *dev, struct device_attribute *attr,
 362                             char *buf)
 363 {
 364         struct acpi_device *acpi = to_acpi_device(dev);
 365         struct pcc_acpi *pcc = acpi_driver_data(acpi);
 366
 367         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
 368                 return -EIO;
 369
 370         return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_NUM_BATTERIES]);
 371 }
 372
 373 static ssize_t show_lcdtype(struct device *dev, struct device_attribute *attr,
 374                             char *buf)
 375 {
 376         struct acpi_device *acpi = to_acpi_device(dev);
 377         struct pcc_acpi *pcc = acpi_driver_data(acpi);
 378
 379         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
 380                 return -EIO;
 381
 382         return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_LCD_TYPE]);
 383 }
 384
 385 static ssize_t show_mute(struct device *dev, struct device_attribute *attr,
 386                          char *buf)
 387 {
 388         struct acpi_device *acpi = to_acpi_device(dev);
 389         struct pcc_acpi *pcc = acpi_driver_data(acpi);
 390
 391         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
 392                 return -EIO;
 393
 394         return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_MUTE]);
 395 }
 396
 397 static ssize_t show_sticky(struct device *dev, struct device_attribute *attr,
 398                            char *buf)
 399 {
 400         struct acpi_device *acpi = to_acpi_device(dev);
 401         struct pcc_acpi *pcc = acpi_driver_data(acpi);
 402
 403         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
 404                 return -EIO;
 405
 406         return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_STICKY_KEY]);
 407 }
 408
 409 static ssize_t set_sticky(struct device *dev, struct device_attribute *attr,
 410                           const char *buf, size_t count)
 411 {
 412         struct acpi_device *acpi = to_acpi_device(dev);
 413         struct pcc_acpi *pcc = acpi_driver_data(acpi);
 414         int val;
 415
 416         if (count && sscanf(buf, "%i", &val) == 1 &&
 417             (val == 0 || val == 1)) {
 418                 acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, val);
 419                 pcc->sticky_mode = val;
 420         }
 421
 422         return count;
 423 }
 424
 425 static DEVICE_ATTR(numbatt, S_IRUGO, show_numbatt, NULL);
 426 static DEVICE_ATTR(lcdtype, S_IRUGO, show_lcdtype, NULL);
 427 static DEVICE_ATTR(mute, S_IRUGO, show_mute, NULL);
 428 static DEVICE_ATTR(sticky_key, S_IRUGO | S_IWUSR, show_sticky, set_sticky);
 429
 430 static struct attribute *pcc_sysfs_entries[] = {
 431         &dev_attr_numbatt.attr,
 432         &dev_attr_lcdtype.attr,
 433         &dev_attr_mute.attr,
 434         &dev_attr_sticky_key.attr,
 435         NULL,
 436 };
 437
 438 static struct attribute_group pcc_attr_group = {
 439         .name   = NULL,         /* put in device directory */
 440         .attrs  = pcc_sysfs_entries,
 441 };
 442
 443
 444 /* hotkey input device driver */
 445
 446 static int pcc_getkeycode(struct input_dev *dev, int scancode, int *keycode)
 447 {
 448         struct pcc_acpi *pcc = input_get_drvdata(dev);
 449
 450         if (scancode >= ARRAY_SIZE(pcc->keymap))
 451                 return -EINVAL;
 452
 453         *keycode = pcc->keymap[scancode];
 454
 455         return 0;
 456 }
 457
 458 static int keymap_get_by_keycode(struct pcc_acpi *pcc, int keycode)
 459 {
 460         int i;
 461
 462         for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++) {
 463                 if (pcc->keymap[i] == keycode)
 464                         return i+1;
 465         }
 466
 467         return 0;
 468 }
 469
 470 static int pcc_setkeycode(struct input_dev *dev, int scancode, int keycode)
 471 {
 472         struct pcc_acpi *pcc = input_get_drvdata(dev);
 473         int oldkeycode;
 474
 475         if (scancode >= ARRAY_SIZE(pcc->keymap))
 476                 return -EINVAL;
 477
 478         if (keycode < 0 || keycode > KEY_MAX)
 479                 return -EINVAL;
 480
 481         oldkeycode = pcc->keymap[scancode];
 482         pcc->keymap[scancode] = keycode;
 483
 484         set_bit(keycode, dev->keybit);
 485
 486         if (!keymap_get_by_keycode(pcc, oldkeycode))
 487                 clear_bit(oldkeycode, dev->keybit);
 488
 489         return 0;
 490 }
 491
 492 static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc)
 493 {
 494         struct input_dev *hotk_input_dev = pcc->input_dev;
 495         int rc;
 496         int key_code, hkey_num;
 497         unsigned long long result;
 498
 499         rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
 500                                    NULL, &result);
 501         if (!ACPI_SUCCESS(rc)) {
 502                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 503                                  "error getting hotkey status\n"));
 504                 return;
 505         }
 506
 507         acpi_bus_generate_proc_event(pcc->device, HKEY_NOTIFY, result);
 508
 509         hkey_num = result & 0xf;
 510
 511         if (hkey_num < 0 || hkey_num >= ARRAY_SIZE(pcc->keymap)) {
 512                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 513                                   "hotkey number out of range: %d\n",
 514                                   hkey_num));
 515                 return;
 516         }
 517
 518         key_code = pcc->keymap[hkey_num];
 519
 520         if (key_code != KEY_RESERVED) {
 521                 int pushed = (result & 0x80) ? TRUE : FALSE;
 522
 523                 input_report_key(hotk_input_dev, key_code, pushed);
 524                 input_sync(hotk_input_dev);
 525         }
 526
 527         return;
 528 }
 529
 530 static void acpi_pcc_hotkey_notify(acpi_handle handle, u32 event, void *data)
 531 {
 532         struct pcc_acpi *pcc = (struct pcc_acpi *) data;
 533
 534         switch (event) {
 535         case HKEY_NOTIFY:
 536                 acpi_pcc_generate_keyinput(pcc);
 537                 break;
 538         default:
 539                 /* nothing to do */
 540                 break;
 541         }
 542 }
 543
 544 static int acpi_pcc_init_input(struct pcc_acpi *pcc)
 545 {
 546         int i, rc;
 547
 548         pcc->input_dev = input_allocate_device();
 549         if (!pcc->input_dev) {
 550                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 551                                   "Couldn't allocate input device for hotkey"));
 552                 return -ENOMEM;
 553         }
 554
 555         pcc->input_dev->evbit[0] = BIT(EV_KEY);
 556
 557         pcc->input_dev->name = ACPI_PCC_DRIVER_NAME;
 558         pcc->input_dev->phys = ACPI_PCC_INPUT_PHYS;
 559         pcc->input_dev->id.bustype = BUS_HOST;
 560         pcc->input_dev->id.vendor = 0x0001;
 561         pcc->input_dev->id.product = 0x0001;
 562         pcc->input_dev->id.version = 0x0100;
 563         pcc->input_dev->getkeycode = pcc_getkeycode;
 564         pcc->input_dev->setkeycode = pcc_setkeycode;
 565
 566         /* load initial keymap */
 567         memcpy(pcc->keymap, initial_keymap, sizeof(pcc->keymap));
 568
 569         for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++)
 570                 __set_bit(pcc->keymap[i], pcc->input_dev->keybit);
 571         __clear_bit(KEY_RESERVED, pcc->input_dev->keybit);
 572
 573         input_set_drvdata(pcc->input_dev, pcc);
 574
 575         rc = input_register_device(pcc->input_dev);
 576         if (rc < 0)
 577                 input_free_device(pcc->input_dev);
 578
 579         return rc;
 580 }
 581
 582 /* kernel module interface */
 583
 584 static int acpi_pcc_hotkey_resume(struct acpi_device *device)
 585 {
 586         struct pcc_acpi *pcc = acpi_driver_data(device);
 587         acpi_status status = AE_OK;
 588
 589         if (device == NULL || pcc == NULL)
 590                 return -EINVAL;
 591
 592         ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Sticky mode restore: %d\n",
 593                           pcc->sticky_mode));
 594
 595         status = acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, pcc->sticky_mode);
 596
 597         return status == AE_OK ? 0 : -EINVAL;
 598 }
 599
 600 static int acpi_pcc_hotkey_add(struct acpi_device *device)
 601 {
 602         acpi_status status;
 603         struct pcc_acpi *pcc;
 604         int num_sifr, result;
 605
 606         if (!device)
 607                 return -EINVAL;
 608
 609         num_sifr = acpi_pcc_get_sqty(device);
 610
 611         if (num_sifr > 255) {
 612                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "num_sifr too large"));
 613                 return -ENODEV;
 614         }
 615
 616         pcc = kzalloc(sizeof(struct pcc_acpi), GFP_KERNEL);
 617         if (!pcc) {
 618                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 619                                   "Couldn't allocate mem for pcc"));
 620                 return -ENOMEM;
 621         }
 622
 623         pcc->sinf = kzalloc(sizeof(u32) * (num_sifr + 1), GFP_KERNEL);
 624         if (!pcc->sinf) {
 625                 result = -ENOMEM;
 626                 goto out_hotkey;
 627         }
 628
 629         pcc->device = device;
 630         pcc->handle = device->handle;
 631         pcc->num_sifr = num_sifr;
 632         device->driver_data = pcc;
 633         strcpy(acpi_device_name(device), ACPI_PCC_DEVICE_NAME);
 634         strcpy(acpi_device_class(device), ACPI_PCC_CLASS);
 635
 636         result = acpi_pcc_init_input(pcc);
 637         if (result) {
 638                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 639                                   "Error installing keyinput handler\n"));
 640                 goto out_sinf;
 641         }
 642
 643         /* initialize hotkey input device */
 644         status = acpi_install_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
 645                                              acpi_pcc_hotkey_notify, pcc);
 646
 647         if (ACPI_FAILURE(status)) {
 648                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 649                                   "Error installing notify handler\n"));
 650                 result = -ENODEV;
 651                 goto out_input;
 652         }
 653
 654         /* initialize backlight */
 655         pcc->backlight = backlight_device_register("panasonic", NULL, pcc,
 656                                                    &pcc_backlight_ops);
 657         if (IS_ERR(pcc->backlight))
 658                 goto out_notify;
 659
 660         if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) {
 661                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 662                                  "Couldn't retrieve BIOS data\n"));
 663                 goto out_backlight;
 664         }
 665
 666         /* read the initial brightness setting from the hardware */
 667         pcc->backlight->props.max_brightness =
 668                                         pcc->sinf[SINF_AC_MAX_BRIGHT];
 669         pcc->backlight->props.brightness = pcc->sinf[SINF_AC_CUR_BRIGHT];
 670
 671         /* read the initial sticky key mode from the hardware */
 672         pcc->sticky_mode = pcc->sinf[SINF_STICKY_KEY];
 673
 674         /* add sysfs attributes */
 675         result = sysfs_create_group(&device->dev.kobj, &pcc_attr_group);
 676         if (result)
 677                 goto out_backlight;
 678
 679         return 0;
 680
 681 out_backlight:
 682         backlight_device_unregister(pcc->backlight);
 683 out_notify:
 684         acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
 685                                    acpi_pcc_hotkey_notify);
 686 out_input:
 687         input_unregister_device(pcc->input_dev);
 688         /* no need to input_free_device() since core input API refcount and
 689          * free()s the device */
 690 out_sinf:
 691         kfree(pcc->sinf);
 692 out_hotkey:
 693         kfree(pcc);
 694
 695         return result;
 696 }
 697
 698 static int __init acpi_pcc_init(void)
 699 {
 700         int result = 0;
 701
 702         if (acpi_disabled)
 703                 return -ENODEV;
 704
 705         result = acpi_bus_register_driver(&acpi_pcc_driver);
 706         if (result < 0) {
 707                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 708                                   "Error registering hotkey driver\n"));
 709                 return -ENODEV;
 710         }
 711
 712         return 0;
 713 }
 714
 715 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type)
 716 {
 717         struct pcc_acpi *pcc = acpi_driver_data(device);
 718
 719         if (!device || !pcc)
 720                 return -EINVAL;
 721
 722         sysfs_remove_group(&device->dev.kobj, &pcc_attr_group);
 723
 724         backlight_device_unregister(pcc->backlight);
 725
 726         acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
 727                                    acpi_pcc_hotkey_notify);
 728
 729         input_unregister_device(pcc->input_dev);
 730         /* no need to input_free_device() since core input API refcount and
 731          * free()s the device */
 732
 733         kfree(pcc->sinf);
 734         kfree(pcc);
 735
 736         return 0;
 737 }
 738
 739 static void __exit acpi_pcc_exit(void)
 740 {
 741         acpi_bus_unregister_driver(&acpi_pcc_driver);
 742 }
 743
 744 module_init(acpi_pcc_init);
 745 module_exit(acpi_pcc_exit);