drivers/platform/x86/sony-laptop.c

   1 /*
   2  * ACPI Sony Notebook Control Driver (SNC and SPIC)
   3  *
   4  * Copyright (C) 2004-2005 Stelian Pop <stelian@popies.net>
   5  * Copyright (C) 2007-2009 Mattia Dongili <malattia@linux.it>
   6  *
   7  * Parts of this driver inspired from asus_acpi.c and ibm_acpi.c
   8  * which are copyrighted by their respective authors.
   9  *
  10  * The SNY6001 driver part is based on the sonypi driver which includes
  11  * material from:
  12  *
  13  * Copyright (C) 2001-2005 Stelian Pop <stelian@popies.net>
  14  *
  15  * Copyright (C) 2005 Narayanan R S <nars@kadamba.org>
  16  *
  17  * Copyright (C) 2001-2002 Alcôve <www.alcove.com>
  18  *
  19  * Copyright (C) 2001 Michael Ashley <m.ashley@unsw.edu.au>
  20  *
  21  * Copyright (C) 2001 Junichi Morita <jun1m@mars.dti.ne.jp>
  22  *
  23  * Copyright (C) 2000 Takaya Kinjo <t-kinjo@tc4.so-net.ne.jp>
  24  *
  25  * Copyright (C) 2000 Andrew Tridgell <tridge@valinux.com>
  26  *
  27  * Earlier work by Werner Almesberger, Paul `Rusty' Russell and Paul Mackerras.
  28  *
  29  * This program is free software; you can redistribute it and/or modify
  30  * it under the terms of the GNU General Public License as published by
  31  * the Free Software Foundation; either version 2 of the License, or
  32  * (at your option) any later version.
  33  *
  34  * This program is distributed in the hope that it will be useful,
  35  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  36  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  37  * GNU General Public License for more details.
  38  *
  39  * You should have received a copy of the GNU General Public License
  40  * along with this program; if not, write to the Free Software
  41  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  42  *
  43  */
  44
  45 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  46
  47 #include <linux/kernel.h>
  48 #include <linux/module.h>
  49 #include <linux/moduleparam.h>
  50 #include <linux/init.h>
  51 #include <linux/types.h>
  52 #include <linux/backlight.h>
  53 #include <linux/platform_device.h>
  54 #include <linux/err.h>
  55 #include <linux/dmi.h>
  56 #include <linux/pci.h>
  57 #include <linux/interrupt.h>
  58 #include <linux/delay.h>
  59 #include <linux/input.h>
  60 #include <linux/kfifo.h>
  61 #include <linux/workqueue.h>
  62 #include <linux/acpi.h>
  63 #include <linux/slab.h>
  64 #include <acpi/acpi_drivers.h>
  65 #include <acpi/acpi_bus.h>
  66 #include <asm/uaccess.h>
  67 #include <linux/sonypi.h>
  68 #include <linux/sony-laptop.h>
  69 #include <linux/rfkill.h>
  70 #ifdef CONFIG_SONYPI_COMPAT
  71 #include <linux/poll.h>
  72 #include <linux/miscdevice.h>
  73 #endif
  74
  75 #define dprintk(fmt, ...)                       \
  76 do {                                            \
  77         if (debug)                              \
  78                 pr_warn(fmt, ##__VA_ARGS__);    \
  79 } while (0)
  80
  81 #define SONY_LAPTOP_DRIVER_VERSION      "0.6"
  82
  83 #define SONY_NC_CLASS           "sony-nc"
  84 #define SONY_NC_HID             "SNY5001"
  85 #define SONY_NC_DRIVER_NAME     "Sony Notebook Control Driver"
  86
  87 #define SONY_PIC_CLASS          "sony-pic"
  88 #define SONY_PIC_HID            "SNY6001"
  89 #define SONY_PIC_DRIVER_NAME    "Sony Programmable IO Control Driver"
  90
  91 MODULE_AUTHOR("Stelian Pop, Mattia Dongili");
  92 MODULE_DESCRIPTION("Sony laptop extras driver (SPIC and SNC ACPI device)");
  93 MODULE_LICENSE("GPL");
  94 MODULE_VERSION(SONY_LAPTOP_DRIVER_VERSION);
  95
  96 static int debug;
  97 module_param(debug, int, 0);
  98 MODULE_PARM_DESC(debug, "set this to 1 (and RTFM) if you want to help "
  99                  "the development of this driver");
 100
 101 static int no_spic;             /* = 0 */
 102 module_param(no_spic, int, 0444);
 103 MODULE_PARM_DESC(no_spic,
 104                  "set this if you don't want to enable the SPIC device");
 105
 106 static int compat;              /* = 0 */
 107 module_param(compat, int, 0444);
 108 MODULE_PARM_DESC(compat,
 109                  "set this if you want to enable backward compatibility mode");
 110
 111 static unsigned long mask = 0xffffffff;
 112 module_param(mask, ulong, 0644);
 113 MODULE_PARM_DESC(mask,
 114                  "set this to the mask of event you want to enable (see doc)");
 115
 116 static int camera;              /* = 0 */
 117 module_param(camera, int, 0444);
 118 MODULE_PARM_DESC(camera,
 119                  "set this to 1 to enable Motion Eye camera controls "
 120                  "(only use it if you have a C1VE or C1VN model)");
 121
 122 #ifdef CONFIG_SONYPI_COMPAT
 123 static int minor = -1;
 124 module_param(minor, int, 0);
 125 MODULE_PARM_DESC(minor,
 126                  "minor number of the misc device for the SPIC compatibility code, "
 127                  "default is -1 (automatic)");
 128 #endif
 129
 130 static int kbd_backlight;       /* = 1 */
 131 module_param(kbd_backlight, int, 0444);
 132 MODULE_PARM_DESC(kbd_backlight,
 133                  "set this to 0 to disable keyboard backlight, "
 134                  "1 to enable it (default: 0)");
 135
 136 static int kbd_backlight_timeout;       /* = 0 */
 137 module_param(kbd_backlight_timeout, int, 0444);
 138 MODULE_PARM_DESC(kbd_backlight_timeout,
 139                  "set this to 0 to set the default 10 seconds timeout, "
 140                  "1 for 30 seconds, 2 for 60 seconds and 3 to disable timeout "
 141                  "(default: 0)");
 142
 143 static void sony_nc_kbd_backlight_resume(void);
 144
 145 enum sony_nc_rfkill {
 146         SONY_WIFI,
 147         SONY_BLUETOOTH,
 148         SONY_WWAN,
 149         SONY_WIMAX,
 150         N_SONY_RFKILL,
 151 };
 152
 153 static int sony_rfkill_handle;
 154 static struct rfkill *sony_rfkill_devices[N_SONY_RFKILL];
 155 static int sony_rfkill_address[N_SONY_RFKILL] = {0x300, 0x500, 0x700, 0x900};
 156 static void sony_nc_rfkill_update(void);
 157
 158 /*********** Input Devices ***********/
 159
 160 #define SONY_LAPTOP_BUF_SIZE    128
 161 struct sony_laptop_input_s {
 162         atomic_t                users;
 163         struct input_dev        *jog_dev;
 164         struct input_dev        *key_dev;
 165         struct kfifo            fifo;
 166         spinlock_t              fifo_lock;
 167         struct timer_list       release_key_timer;
 168 };
 169
 170 static struct sony_laptop_input_s sony_laptop_input = {
 171         .users = ATOMIC_INIT(0),
 172 };
 173
 174 struct sony_laptop_keypress {
 175         struct input_dev *dev;
 176         int key;
 177 };
 178
 179 /* Correspondance table between sonypi events
 180  * and input layer indexes in the keymap
 181  */
 182 static int sony_laptop_input_index[] = {
 183         -1,     /*  0 no event */
 184         -1,     /*  1 SONYPI_EVENT_JOGDIAL_DOWN */
 185         -1,     /*  2 SONYPI_EVENT_JOGDIAL_UP */
 186         -1,     /*  3 SONYPI_EVENT_JOGDIAL_DOWN_PRESSED */
 187         -1,     /*  4 SONYPI_EVENT_JOGDIAL_UP_PRESSED */
 188         -1,     /*  5 SONYPI_EVENT_JOGDIAL_PRESSED */
 189         -1,     /*  6 SONYPI_EVENT_JOGDIAL_RELEASED */
 190          0,     /*  7 SONYPI_EVENT_CAPTURE_PRESSED */
 191          1,     /*  8 SONYPI_EVENT_CAPTURE_RELEASED */
 192          2,     /*  9 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */
 193          3,     /* 10 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */
 194          4,     /* 11 SONYPI_EVENT_FNKEY_ESC */
 195          5,     /* 12 SONYPI_EVENT_FNKEY_F1 */
 196          6,     /* 13 SONYPI_EVENT_FNKEY_F2 */
 197          7,     /* 14 SONYPI_EVENT_FNKEY_F3 */
 198          8,     /* 15 SONYPI_EVENT_FNKEY_F4 */
 199          9,     /* 16 SONYPI_EVENT_FNKEY_F5 */
 200         10,     /* 17 SONYPI_EVENT_FNKEY_F6 */
 201         11,     /* 18 SONYPI_EVENT_FNKEY_F7 */
 202         12,     /* 19 SONYPI_EVENT_FNKEY_F8 */
 203         13,     /* 20 SONYPI_EVENT_FNKEY_F9 */
 204         14,     /* 21 SONYPI_EVENT_FNKEY_F10 */
 205         15,     /* 22 SONYPI_EVENT_FNKEY_F11 */
 206         16,     /* 23 SONYPI_EVENT_FNKEY_F12 */
 207         17,     /* 24 SONYPI_EVENT_FNKEY_1 */
 208         18,     /* 25 SONYPI_EVENT_FNKEY_2 */
 209         19,     /* 26 SONYPI_EVENT_FNKEY_D */
 210         20,     /* 27 SONYPI_EVENT_FNKEY_E */
 211         21,     /* 28 SONYPI_EVENT_FNKEY_F */
 212         22,     /* 29 SONYPI_EVENT_FNKEY_S */
 213         23,     /* 30 SONYPI_EVENT_FNKEY_B */
 214         24,     /* 31 SONYPI_EVENT_BLUETOOTH_PRESSED */
 215         25,     /* 32 SONYPI_EVENT_PKEY_P1 */
 216         26,     /* 33 SONYPI_EVENT_PKEY_P2 */
 217         27,     /* 34 SONYPI_EVENT_PKEY_P3 */
 218         28,     /* 35 SONYPI_EVENT_BACK_PRESSED */
 219         -1,     /* 36 SONYPI_EVENT_LID_CLOSED */
 220         -1,     /* 37 SONYPI_EVENT_LID_OPENED */
 221         29,     /* 38 SONYPI_EVENT_BLUETOOTH_ON */
 222         30,     /* 39 SONYPI_EVENT_BLUETOOTH_OFF */
 223         31,     /* 40 SONYPI_EVENT_HELP_PRESSED */
 224         32,     /* 41 SONYPI_EVENT_FNKEY_ONLY */
 225         33,     /* 42 SONYPI_EVENT_JOGDIAL_FAST_DOWN */
 226         34,     /* 43 SONYPI_EVENT_JOGDIAL_FAST_UP */
 227         35,     /* 44 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */
 228         36,     /* 45 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */
 229         37,     /* 46 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */
 230         38,     /* 47 SONYPI_EVENT_JOGDIAL_VFAST_UP */
 231         39,     /* 48 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */
 232         40,     /* 49 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */
 233         41,     /* 50 SONYPI_EVENT_ZOOM_PRESSED */
 234         42,     /* 51 SONYPI_EVENT_THUMBPHRASE_PRESSED */
 235         43,     /* 52 SONYPI_EVENT_MEYE_FACE */
 236         44,     /* 53 SONYPI_EVENT_MEYE_OPPOSITE */
 237         45,     /* 54 SONYPI_EVENT_MEMORYSTICK_INSERT */
 238         46,     /* 55 SONYPI_EVENT_MEMORYSTICK_EJECT */
 239         -1,     /* 56 SONYPI_EVENT_ANYBUTTON_RELEASED */
 240         -1,     /* 57 SONYPI_EVENT_BATTERY_INSERT */
 241         -1,     /* 58 SONYPI_EVENT_BATTERY_REMOVE */
 242         -1,     /* 59 SONYPI_EVENT_FNKEY_RELEASED */
 243         47,     /* 60 SONYPI_EVENT_WIRELESS_ON */
 244         48,     /* 61 SONYPI_EVENT_WIRELESS_OFF */
 245         49,     /* 62 SONYPI_EVENT_ZOOM_IN_PRESSED */
 246         50,     /* 63 SONYPI_EVENT_ZOOM_OUT_PRESSED */
 247         51,     /* 64 SONYPI_EVENT_CD_EJECT_PRESSED */
 248         52,     /* 65 SONYPI_EVENT_MODEKEY_PRESSED */
 249         53,     /* 66 SONYPI_EVENT_PKEY_P4 */
 250         54,     /* 67 SONYPI_EVENT_PKEY_P5 */
 251         55,     /* 68 SONYPI_EVENT_SETTINGKEY_PRESSED */
 252         56,     /* 69 SONYPI_EVENT_VOLUME_INC_PRESSED */
 253         57,     /* 70 SONYPI_EVENT_VOLUME_DEC_PRESSED */
 254         -1,     /* 71 SONYPI_EVENT_BRIGHTNESS_PRESSED */
 255         58,     /* 72 SONYPI_EVENT_MEDIA_PRESSED */
 256         59,     /* 72 SONYPI_EVENT_VENDOR_PRESSED */
 257 };
 258
 259 static int sony_laptop_input_keycode_map[] = {
 260         KEY_CAMERA,     /*  0 SONYPI_EVENT_CAPTURE_PRESSED */
 261         KEY_RESERVED,   /*  1 SONYPI_EVENT_CAPTURE_RELEASED */
 262         KEY_RESERVED,   /*  2 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */
 263         KEY_RESERVED,   /*  3 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */
 264         KEY_FN_ESC,     /*  4 SONYPI_EVENT_FNKEY_ESC */
 265         KEY_FN_F1,      /*  5 SONYPI_EVENT_FNKEY_F1 */
 266         KEY_FN_F2,      /*  6 SONYPI_EVENT_FNKEY_F2 */
 267         KEY_FN_F3,      /*  7 SONYPI_EVENT_FNKEY_F3 */
 268         KEY_FN_F4,      /*  8 SONYPI_EVENT_FNKEY_F4 */
 269         KEY_FN_F5,      /*  9 SONYPI_EVENT_FNKEY_F5 */
 270         KEY_FN_F6,      /* 10 SONYPI_EVENT_FNKEY_F6 */
 271         KEY_FN_F7,      /* 11 SONYPI_EVENT_FNKEY_F7 */
 272         KEY_FN_F8,      /* 12 SONYPI_EVENT_FNKEY_F8 */
 273         KEY_FN_F9,      /* 13 SONYPI_EVENT_FNKEY_F9 */
 274         KEY_FN_F10,     /* 14 SONYPI_EVENT_FNKEY_F10 */
 275         KEY_FN_F11,     /* 15 SONYPI_EVENT_FNKEY_F11 */
 276         KEY_FN_F12,     /* 16 SONYPI_EVENT_FNKEY_F12 */
 277         KEY_FN_F1,      /* 17 SONYPI_EVENT_FNKEY_1 */
 278         KEY_FN_F2,      /* 18 SONYPI_EVENT_FNKEY_2 */
 279         KEY_FN_D,       /* 19 SONYPI_EVENT_FNKEY_D */
 280         KEY_FN_E,       /* 20 SONYPI_EVENT_FNKEY_E */
 281         KEY_FN_F,       /* 21 SONYPI_EVENT_FNKEY_F */
 282         KEY_FN_S,       /* 22 SONYPI_EVENT_FNKEY_S */
 283         KEY_FN_B,       /* 23 SONYPI_EVENT_FNKEY_B */
 284         KEY_BLUETOOTH,  /* 24 SONYPI_EVENT_BLUETOOTH_PRESSED */
 285         KEY_PROG1,      /* 25 SONYPI_EVENT_PKEY_P1 */
 286         KEY_PROG2,      /* 26 SONYPI_EVENT_PKEY_P2 */
 287         KEY_PROG3,      /* 27 SONYPI_EVENT_PKEY_P3 */
 288         KEY_BACK,       /* 28 SONYPI_EVENT_BACK_PRESSED */
 289         KEY_BLUETOOTH,  /* 29 SONYPI_EVENT_BLUETOOTH_ON */
 290         KEY_BLUETOOTH,  /* 30 SONYPI_EVENT_BLUETOOTH_OFF */
 291         KEY_HELP,       /* 31 SONYPI_EVENT_HELP_PRESSED */
 292         KEY_FN,         /* 32 SONYPI_EVENT_FNKEY_ONLY */
 293         KEY_RESERVED,   /* 33 SONYPI_EVENT_JOGDIAL_FAST_DOWN */
 294         KEY_RESERVED,   /* 34 SONYPI_EVENT_JOGDIAL_FAST_UP */
 295         KEY_RESERVED,   /* 35 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */
 296         KEY_RESERVED,   /* 36 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */
 297         KEY_RESERVED,   /* 37 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */
 298         KEY_RESERVED,   /* 38 SONYPI_EVENT_JOGDIAL_VFAST_UP */
 299         KEY_RESERVED,   /* 39 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */
 300         KEY_RESERVED,   /* 40 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */
 301         KEY_ZOOM,       /* 41 SONYPI_EVENT_ZOOM_PRESSED */
 302         BTN_THUMB,      /* 42 SONYPI_EVENT_THUMBPHRASE_PRESSED */
 303         KEY_RESERVED,   /* 43 SONYPI_EVENT_MEYE_FACE */
 304         KEY_RESERVED,   /* 44 SONYPI_EVENT_MEYE_OPPOSITE */
 305         KEY_RESERVED,   /* 45 SONYPI_EVENT_MEMORYSTICK_INSERT */
 306         KEY_RESERVED,   /* 46 SONYPI_EVENT_MEMORYSTICK_EJECT */
 307         KEY_WLAN,       /* 47 SONYPI_EVENT_WIRELESS_ON */
 308         KEY_WLAN,       /* 48 SONYPI_EVENT_WIRELESS_OFF */
 309         KEY_ZOOMIN,     /* 49 SONYPI_EVENT_ZOOM_IN_PRESSED */
 310         KEY_ZOOMOUT,    /* 50 SONYPI_EVENT_ZOOM_OUT_PRESSED */
 311         KEY_EJECTCD,    /* 51 SONYPI_EVENT_CD_EJECT_PRESSED */
 312         KEY_F13,        /* 52 SONYPI_EVENT_MODEKEY_PRESSED */
 313         KEY_PROG4,      /* 53 SONYPI_EVENT_PKEY_P4 */
 314         KEY_F14,        /* 54 SONYPI_EVENT_PKEY_P5 */
 315         KEY_F15,        /* 55 SONYPI_EVENT_SETTINGKEY_PRESSED */
 316         KEY_VOLUMEUP,   /* 56 SONYPI_EVENT_VOLUME_INC_PRESSED */
 317         KEY_VOLUMEDOWN, /* 57 SONYPI_EVENT_VOLUME_DEC_PRESSED */
 318         KEY_MEDIA,      /* 58 SONYPI_EVENT_MEDIA_PRESSED */
 319         KEY_VENDOR,     /* 59 SONYPI_EVENT_VENDOR_PRESSED */
 320 };
 321
 322 /* release buttons after a short delay if pressed */
 323 static void do_sony_laptop_release_key(unsigned long unused)
 324 {
 325         struct sony_laptop_keypress kp;
 326         unsigned long flags;
 327
 328         spin_lock_irqsave(&sony_laptop_input.fifo_lock, flags);
 329
 330         if (kfifo_out(&sony_laptop_input.fifo,
 331                       (unsigned char *)&kp, sizeof(kp)) == sizeof(kp)) {
 332                 input_report_key(kp.dev, kp.key, 0);
 333                 input_sync(kp.dev);
 334         }
 335
 336         /* If there is something in the fifo schedule next release. */
 337         if (kfifo_len(&sony_laptop_input.fifo) != 0)
 338                 mod_timer(&sony_laptop_input.release_key_timer,
 339                           jiffies + msecs_to_jiffies(10));
 340
 341         spin_unlock_irqrestore(&sony_laptop_input.fifo_lock, flags);
 342 }
 343
 344 /* forward event to the input subsystem */
 345 static void sony_laptop_report_input_event(u8 event)
 346 {
 347         struct input_dev *jog_dev = sony_laptop_input.jog_dev;
 348         struct input_dev *key_dev = sony_laptop_input.key_dev;
 349         struct sony_laptop_keypress kp = { NULL };
 350
 351         if (event == SONYPI_EVENT_FNKEY_RELEASED ||
 352                         event == SONYPI_EVENT_ANYBUTTON_RELEASED) {
 353                 /* Nothing, not all VAIOs generate this event */
 354                 return;
 355         }
 356
 357         /* report events */
 358         switch (event) {
 359         /* jog_dev events */
 360         case SONYPI_EVENT_JOGDIAL_UP:
 361         case SONYPI_EVENT_JOGDIAL_UP_PRESSED:
 362                 input_report_rel(jog_dev, REL_WHEEL, 1);
 363                 input_sync(jog_dev);
 364                 return;
 365
 366         case SONYPI_EVENT_JOGDIAL_DOWN:
 367         case SONYPI_EVENT_JOGDIAL_DOWN_PRESSED:
 368                 input_report_rel(jog_dev, REL_WHEEL, -1);
 369                 input_sync(jog_dev);
 370                 return;
 371
 372         /* key_dev events */
 373         case SONYPI_EVENT_JOGDIAL_PRESSED:
 374                 kp.key = BTN_MIDDLE;
 375                 kp.dev = jog_dev;
 376                 break;
 377
 378         default:
 379                 if (event >= ARRAY_SIZE(sony_laptop_input_index)) {
 380                         dprintk("sony_laptop_report_input_event, event not known: %d\n", event);
 381                         break;
 382                 }
 383                 if (sony_laptop_input_index[event] != -1) {
 384                         kp.key = sony_laptop_input_keycode_map[sony_laptop_input_index[event]];
 385                         if (kp.key != KEY_UNKNOWN)
 386                                 kp.dev = key_dev;
 387                 }
 388                 break;
 389         }
 390
 391         if (kp.dev) {
 392                 input_report_key(kp.dev, kp.key, 1);
 393                 /* we emit the scancode so we can always remap the key */
 394                 input_event(kp.dev, EV_MSC, MSC_SCAN, event);
 395                 input_sync(kp.dev);
 396
 397                 /* schedule key release */
 398                 kfifo_in_locked(&sony_laptop_input.fifo,
 399                                 (unsigned char *)&kp, sizeof(kp),
 400                                 &sony_laptop_input.fifo_lock);
 401                 mod_timer(&sony_laptop_input.release_key_timer,
 402                           jiffies + msecs_to_jiffies(10));
 403         } else
 404                 dprintk("unknown input event %.2x\n", event);
 405 }
 406
 407 static int sony_laptop_setup_input(struct acpi_device *acpi_device)
 408 {
 409         struct input_dev *jog_dev;
 410         struct input_dev *key_dev;
 411         int i;
 412         int error;
 413
 414         /* don't run again if already initialized */
 415         if (atomic_add_return(1, &sony_laptop_input.users) > 1)
 416                 return 0;
 417
 418         /* kfifo */
 419         spin_lock_init(&sony_laptop_input.fifo_lock);
 420         error = kfifo_alloc(&sony_laptop_input.fifo,
 421                             SONY_LAPTOP_BUF_SIZE, GFP_KERNEL);
 422         if (error) {
 423                 pr_err("kfifo_alloc failed\n");
 424                 goto err_dec_users;
 425         }
 426
 427         setup_timer(&sony_laptop_input.release_key_timer,
 428                     do_sony_laptop_release_key, 0);
 429
 430         /* input keys */
 431         key_dev = input_allocate_device();
 432         if (!key_dev) {
 433                 error = -ENOMEM;
 434                 goto err_free_kfifo;
 435         }
 436
 437         key_dev->name = "Sony Vaio Keys";
 438         key_dev->id.bustype = BUS_ISA;
 439         key_dev->id.vendor = PCI_VENDOR_ID_SONY;
 440         key_dev->dev.parent = &acpi_device->dev;
 441
 442         /* Initialize the Input Drivers: special keys */
 443         input_set_capability(key_dev, EV_MSC, MSC_SCAN);
 444
 445         __set_bit(EV_KEY, key_dev->evbit);
 446         key_dev->keycodesize = sizeof(sony_laptop_input_keycode_map[0]);
 447         key_dev->keycodemax = ARRAY_SIZE(sony_laptop_input_keycode_map);
 448         key_dev->keycode = &sony_laptop_input_keycode_map;
 449         for (i = 0; i < ARRAY_SIZE(sony_laptop_input_keycode_map); i++)
 450                 __set_bit(sony_laptop_input_keycode_map[i], key_dev->keybit);
 451         __clear_bit(KEY_RESERVED, key_dev->keybit);
 452
 453         error = input_register_device(key_dev);
 454         if (error)
 455                 goto err_free_keydev;
 456
 457         sony_laptop_input.key_dev = key_dev;
 458
 459         /* jogdial */
 460         jog_dev = input_allocate_device();
 461         if (!jog_dev) {
 462                 error = -ENOMEM;
 463                 goto err_unregister_keydev;
 464         }
 465
 466         jog_dev->name = "Sony Vaio Jogdial";
 467         jog_dev->id.bustype = BUS_ISA;
 468         jog_dev->id.vendor = PCI_VENDOR_ID_SONY;
 469         key_dev->dev.parent = &acpi_device->dev;
 470
 471         input_set_capability(jog_dev, EV_KEY, BTN_MIDDLE);
 472         input_set_capability(jog_dev, EV_REL, REL_WHEEL);
 473
 474         error = input_register_device(jog_dev);
 475         if (error)
 476                 goto err_free_jogdev;
 477
 478         sony_laptop_input.jog_dev = jog_dev;
 479
 480         return 0;
 481
 482 err_free_jogdev:
 483         input_free_device(jog_dev);
 484
 485 err_unregister_keydev:
 486         input_unregister_device(key_dev);
 487         /* to avoid kref underflow below at input_free_device */
 488         key_dev = NULL;
 489
 490 err_free_keydev:
 491         input_free_device(key_dev);
 492
 493 err_free_kfifo:
 494         kfifo_free(&sony_laptop_input.fifo);
 495
 496 err_dec_users:
 497         atomic_dec(&sony_laptop_input.users);
 498         return error;
 499 }
 500
 501 static void sony_laptop_remove_input(void)
 502 {
 503         struct sony_laptop_keypress kp = { NULL };
 504
 505         /* Cleanup only after the last user has gone */
 506         if (!atomic_dec_and_test(&sony_laptop_input.users))
 507                 return;
 508
 509         del_timer_sync(&sony_laptop_input.release_key_timer);
 510
 511         /*
 512          * Generate key-up events for remaining keys. Note that we don't
 513          * need locking since nobody is adding new events to the kfifo.
 514          */
 515         while (kfifo_out(&sony_laptop_input.fifo,
 516                          (unsigned char *)&kp, sizeof(kp)) == sizeof(kp)) {
 517                 input_report_key(kp.dev, kp.key, 0);
 518                 input_sync(kp.dev);
 519         }
 520
 521         /* destroy input devs */
 522         input_unregister_device(sony_laptop_input.key_dev);
 523         sony_laptop_input.key_dev = NULL;
 524
 525         if (sony_laptop_input.jog_dev) {
 526                 input_unregister_device(sony_laptop_input.jog_dev);
 527                 sony_laptop_input.jog_dev = NULL;
 528         }
 529
 530         kfifo_free(&sony_laptop_input.fifo);
 531 }
 532
 533 /*********** Platform Device ***********/
 534
 535 static atomic_t sony_pf_users = ATOMIC_INIT(0);
 536 static struct platform_driver sony_pf_driver = {
 537         .driver = {
 538                    .name = "sony-laptop",
 539                    .owner = THIS_MODULE,
 540                    }
 541 };
 542 static struct platform_device *sony_pf_device;
 543
 544 static int sony_pf_add(void)
 545 {
 546         int ret = 0;
 547
 548         /* don't run again if already initialized */
 549         if (atomic_add_return(1, &sony_pf_users) > 1)
 550                 return 0;
 551
 552         ret = platform_driver_register(&sony_pf_driver);
 553         if (ret)
 554                 goto out;
 555
 556         sony_pf_device = platform_device_alloc("sony-laptop", -1);
 557         if (!sony_pf_device) {
 558                 ret = -ENOMEM;
 559                 goto out_platform_registered;
 560         }
 561
 562         ret = platform_device_add(sony_pf_device);
 563         if (ret)
 564                 goto out_platform_alloced;
 565
 566         return 0;
 567
 568       out_platform_alloced:
 569         platform_device_put(sony_pf_device);
 570         sony_pf_device = NULL;
 571       out_platform_registered:
 572         platform_driver_unregister(&sony_pf_driver);
 573       out:
 574         atomic_dec(&sony_pf_users);
 575         return ret;
 576 }
 577
 578 static void sony_pf_remove(void)
 579 {
 580         /* deregister only after the last user has gone */
 581         if (!atomic_dec_and_test(&sony_pf_users))
 582                 return;
 583
 584         platform_device_unregister(sony_pf_device);
 585         platform_driver_unregister(&sony_pf_driver);
 586 }
 587
 588 /*********** SNC (SNY5001) Device ***********/
 589
 590 /* the device uses 1-based values, while the backlight subsystem uses
 591    0-based values */
 592 #define SONY_MAX_BRIGHTNESS     8
 593
 594 #define SNC_VALIDATE_IN         0
 595 #define SNC_VALIDATE_OUT        1
 596
 597 static ssize_t sony_nc_sysfs_show(struct device *, struct device_attribute *,
 598                               char *);
 599 static ssize_t sony_nc_sysfs_store(struct device *, struct device_attribute *,
 600                                const char *, size_t);
 601 static int boolean_validate(const int, const int);
 602 static int brightness_default_validate(const int, const int);
 603
 604 struct sony_nc_value {
 605         char *name;             /* name of the entry */
 606         char **acpiget;         /* names of the ACPI get function */
 607         char **acpiset;         /* names of the ACPI set function */
 608         int (*validate)(const int, const int);  /* input/output validation */
 609         int value;              /* current setting */
 610         int valid;              /* Has ever been set */
 611         int debug;              /* active only in debug mode ? */
 612         struct device_attribute devattr;        /* sysfs attribute */
 613 };
 614
 615 #define SNC_HANDLE_NAMES(_name, _values...) \
 616         static char *snc_##_name[] = { _values, NULL }
 617
 618 #define SNC_HANDLE(_name, _getters, _setters, _validate, _debug) \
 619         { \
 620                 .name           = __stringify(_name), \
 621                 .acpiget        = _getters, \
 622                 .acpiset        = _setters, \
 623                 .validate       = _validate, \
 624                 .debug          = _debug, \
 625                 .devattr        = __ATTR(_name, 0, sony_nc_sysfs_show, sony_nc_sysfs_store), \
 626         }
 627
 628 #define SNC_HANDLE_NULL { .name = NULL }
 629
 630 SNC_HANDLE_NAMES(fnkey_get, "GHKE");
 631
 632 SNC_HANDLE_NAMES(brightness_def_get, "GPBR");
 633 SNC_HANDLE_NAMES(brightness_def_set, "SPBR");
 634
 635 SNC_HANDLE_NAMES(cdpower_get, "GCDP");
 636 SNC_HANDLE_NAMES(cdpower_set, "SCDP", "CDPW");
 637
 638 SNC_HANDLE_NAMES(audiopower_get, "GAZP");
 639 SNC_HANDLE_NAMES(audiopower_set, "AZPW");
 640
 641 SNC_HANDLE_NAMES(lanpower_get, "GLNP");
 642 SNC_HANDLE_NAMES(lanpower_set, "LNPW");
 643
 644 SNC_HANDLE_NAMES(lidstate_get, "GLID");
 645
 646 SNC_HANDLE_NAMES(indicatorlamp_get, "GILS");
 647 SNC_HANDLE_NAMES(indicatorlamp_set, "SILS");
 648
 649 SNC_HANDLE_NAMES(gainbass_get, "GMGB");
 650 SNC_HANDLE_NAMES(gainbass_set, "CMGB");
 651
 652 SNC_HANDLE_NAMES(PID_get, "GPID");
 653
 654 SNC_HANDLE_NAMES(CTR_get, "GCTR");
 655 SNC_HANDLE_NAMES(CTR_set, "SCTR");
 656
 657 SNC_HANDLE_NAMES(PCR_get, "GPCR");
 658 SNC_HANDLE_NAMES(PCR_set, "SPCR");
 659
 660 SNC_HANDLE_NAMES(CMI_get, "GCMI");
 661 SNC_HANDLE_NAMES(CMI_set, "SCMI");
 662
 663 static struct sony_nc_value sony_nc_values[] = {
 664         SNC_HANDLE(brightness_default, snc_brightness_def_get,
 665                         snc_brightness_def_set, brightness_default_validate, 0),
 666         SNC_HANDLE(fnkey, snc_fnkey_get, NULL, NULL, 0),
 667         SNC_HANDLE(cdpower, snc_cdpower_get, snc_cdpower_set, boolean_validate, 0),
 668         SNC_HANDLE(audiopower, snc_audiopower_get, snc_audiopower_set,
 669                         boolean_validate, 0),
 670         SNC_HANDLE(lanpower, snc_lanpower_get, snc_lanpower_set,
 671                         boolean_validate, 1),
 672         SNC_HANDLE(lidstate, snc_lidstate_get, NULL,
 673                         boolean_validate, 0),
 674         SNC_HANDLE(indicatorlamp, snc_indicatorlamp_get, snc_indicatorlamp_set,
 675                         boolean_validate, 0),
 676         SNC_HANDLE(gainbass, snc_gainbass_get, snc_gainbass_set,
 677                         boolean_validate, 0),
 678         /* unknown methods */
 679         SNC_HANDLE(PID, snc_PID_get, NULL, NULL, 1),
 680         SNC_HANDLE(CTR, snc_CTR_get, snc_CTR_set, NULL, 1),
 681         SNC_HANDLE(PCR, snc_PCR_get, snc_PCR_set, NULL, 1),
 682         SNC_HANDLE(CMI, snc_CMI_get, snc_CMI_set, NULL, 1),
 683         SNC_HANDLE_NULL
 684 };
 685
 686 static acpi_handle sony_nc_acpi_handle;
 687 static struct acpi_device *sony_nc_acpi_device = NULL;
 688
 689 /*
 690  * acpi_evaluate_object wrappers
 691  */
 692 static int acpi_callgetfunc(acpi_handle handle, char *name, int *result)
 693 {
 694         struct acpi_buffer output;
 695         union acpi_object out_obj;
 696         acpi_status status;
 697
 698         output.length = sizeof(out_obj);
 699         output.pointer = &out_obj;
 700
 701         status = acpi_evaluate_object(handle, name, NULL, &output);
 702         if ((status == AE_OK) && (out_obj.type == ACPI_TYPE_INTEGER)) {
 703                 *result = out_obj.integer.value;
 704                 return 0;
 705         }
 706
 707         pr_warn("acpi_callreadfunc failed\n");
 708
 709         return -1;
 710 }
 711
 712 static int acpi_callsetfunc(acpi_handle handle, char *name, int value,
 713                             int *result)
 714 {
 715         struct acpi_object_list params;
 716         union acpi_object in_obj;
 717         struct acpi_buffer output;
 718         union acpi_object out_obj;
 719         acpi_status status;
 720
 721         params.count = 1;
 722         params.pointer = &in_obj;
 723         in_obj.type = ACPI_TYPE_INTEGER;
 724         in_obj.integer.value = value;
 725
 726         output.length = sizeof(out_obj);
 727         output.pointer = &out_obj;
 728
 729         status = acpi_evaluate_object(handle, name, &params, &output);
 730         if (status == AE_OK) {
 731                 if (result != NULL) {
 732                         if (out_obj.type != ACPI_TYPE_INTEGER) {
 733                                 pr_warn("acpi_evaluate_object bad return type\n");
 734                                 return -1;
 735                         }
 736                         *result = out_obj.integer.value;
 737                 }
 738                 return 0;
 739         }
 740
 741         pr_warn("acpi_evaluate_object failed\n");
 742
 743         return -1;
 744 }
 745
 746 struct sony_nc_handles {
 747         u16 cap[0x10];
 748         struct device_attribute devattr;
 749 };
 750
 751 static struct sony_nc_handles *handles;
 752
 753 static ssize_t sony_nc_handles_show(struct device *dev,
 754                 struct device_attribute *attr, char *buffer)
 755 {
 756         ssize_t len = 0;
 757         int i;
 758
 759         for (i = 0; i < ARRAY_SIZE(handles->cap); i++) {
 760                 len += snprintf(buffer + len, PAGE_SIZE - len, "0x%.4x ",
 761                                 handles->cap[i]);
 762         }
 763         len += snprintf(buffer + len, PAGE_SIZE - len, "\n");
 764
 765         return len;
 766 }
 767
 768 static int sony_nc_handles_setup(struct platform_device *pd)
 769 {
 770         int i;
 771         int result;
 772
 773         handles = kzalloc(sizeof(*handles), GFP_KERNEL);
 774         if (!handles)
 775                 return -ENOMEM;
 776
 777         for (i = 0; i < ARRAY_SIZE(handles->cap); i++) {
 778                 if (!acpi_callsetfunc(sony_nc_acpi_handle,
 779                                         "SN00", i + 0x20, &result)) {
 780                         dprintk("caching handle 0x%.4x (offset: 0x%.2x)\n",
 781                                         result, i);
 782                         handles->cap[i] = result;
 783                 }
 784         }
 785
 786         if (debug) {
 787                 sysfs_attr_init(&handles->devattr.attr);
 788                 handles->devattr.attr.name = "handles";
 789                 handles->devattr.attr.mode = S_IRUGO;
 790                 handles->devattr.show = sony_nc_handles_show;
 791
 792                 /* allow reading capabilities via sysfs */
 793                 if (device_create_file(&pd->dev, &handles->devattr)) {
 794                         kfree(handles);
 795                         handles = NULL;
 796                         return -1;
 797                 }
 798         }
 799
 800         return 0;
 801 }
 802
 803 static int sony_nc_handles_cleanup(struct platform_device *pd)
 804 {
 805         if (handles) {
 806                 if (debug)
 807                         device_remove_file(&pd->dev, &handles->devattr);
 808                 kfree(handles);
 809                 handles = NULL;
 810         }
 811         return 0;
 812 }
 813
 814 static int sony_find_snc_handle(int handle)
 815 {
 816         int i;
 817
 818         /* not initialized yet, return early */
 819         if (!handles)
 820                 return -1;
 821
 822         for (i = 0; i < 0x10; i++) {
 823                 if (handles->cap[i] == handle) {
 824                         dprintk("found handle 0x%.4x (offset: 0x%.2x)\n",
 825                                         handle, i);
 826                         return i;
 827                 }
 828         }
 829         dprintk("handle 0x%.4x not found\n", handle);
 830         return -1;
 831 }
 832
 833 static int sony_call_snc_handle(int handle, int argument, int *result)
 834 {
 835         int ret = 0;
 836         int offset = sony_find_snc_handle(handle);
 837
 838         if (offset < 0)
 839                 return -1;
 840
 841         ret = acpi_callsetfunc(sony_nc_acpi_handle, "SN07", offset | argument,
 842                         result);
 843         dprintk("called SN07 with 0x%.4x (result: 0x%.4x)\n", offset | argument,
 844                         *result);
 845         return ret;
 846 }
 847
 848 /*
 849  * sony_nc_values input/output validate functions
 850  */
 851
 852 /* brightness_default_validate:
 853  *
 854  * manipulate input output values to keep consistency with the
 855  * backlight framework for which brightness values are 0-based.
 856  */
 857 static int brightness_default_validate(const int direction, const int value)
 858 {
 859         switch (direction) {
 860                 case SNC_VALIDATE_OUT:
 861                         return value - 1;
 862                 case SNC_VALIDATE_IN:
 863                         if (value >= 0 && value < SONY_MAX_BRIGHTNESS)
 864                                 return value + 1;
 865         }
 866         return -EINVAL;
 867 }
 868
 869 /* boolean_validate:
 870  *
 871  * on input validate boolean values 0/1, on output just pass the
 872  * received value.
 873  */
 874 static int boolean_validate(const int direction, const int value)
 875 {
 876         if (direction == SNC_VALIDATE_IN) {
 877                 if (value != 0 && value != 1)
 878                         return -EINVAL;
 879         }
 880         return value;
 881 }
 882
 883 /*
 884  * Sysfs show/store common to all sony_nc_values
 885  */
 886 static ssize_t sony_nc_sysfs_show(struct device *dev, struct device_attribute *attr,
 887                               char *buffer)
 888 {
 889         int value;
 890         struct sony_nc_value *item =
 891             container_of(attr, struct sony_nc_value, devattr);
 892
 893         if (!*item->acpiget)
 894                 return -EIO;
 895
 896         if (acpi_callgetfunc(sony_nc_acpi_handle, *item->acpiget, &value) < 0)
 897                 return -EIO;
 898
 899         if (item->validate)
 900                 value = item->validate(SNC_VALIDATE_OUT, value);
 901
 902         return snprintf(buffer, PAGE_SIZE, "%d\n", value);
 903 }
 904
 905 static ssize_t sony_nc_sysfs_store(struct device *dev,
 906                                struct device_attribute *attr,
 907                                const char *buffer, size_t count)
 908 {
 909         int value;
 910         struct sony_nc_value *item =
 911             container_of(attr, struct sony_nc_value, devattr);
 912
 913         if (!item->acpiset)
 914                 return -EIO;
 915
 916         if (count > 31)
 917                 return -EINVAL;
 918
 919         value = simple_strtoul(buffer, NULL, 10);
 920
 921         if (item->validate)
 922                 value = item->validate(SNC_VALIDATE_IN, value);
 923
 924         if (value < 0)
 925                 return value;
 926
 927         if (acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset, value, NULL) < 0)
 928                 return -EIO;
 929         item->value = value;
 930         item->valid = 1;
 931         return count;
 932 }
 933
 934
 935 /*
 936  * Backlight device
 937  */
 938 struct sony_backlight_props {
 939         struct backlight_device *dev;
 940         int                     handle;
 941         u8                      offset;
 942         u8                      maxlvl;
 943 };
 944 struct sony_backlight_props sony_bl_props;
 945
 946 static int sony_backlight_update_status(struct backlight_device *bd)
 947 {
 948         return acpi_callsetfunc(sony_nc_acpi_handle, "SBRT",
 949                                 bd->props.brightness + 1, NULL);
 950 }
 951
 952 static int sony_backlight_get_brightness(struct backlight_device *bd)
 953 {
 954         int value;
 955
 956         if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value))
 957                 return 0;
 958         /* brightness levels are 1-based, while backlight ones are 0-based */
 959         return value - 1;
 960 }
 961
 962 static int sony_nc_get_brightness_ng(struct backlight_device *bd)
 963 {
 964         int result;
 965         int *handle = (int *)bl_get_data(bd);
 966         struct sony_backlight_props *sdev =
 967                 (struct sony_backlight_props *)bl_get_data(bd);
 968
 969         sony_call_snc_handle(sdev->handle, 0x0200, &result);
 970
 971         return (result & 0xff) - sdev->offset;
 972 }
 973
 974 static int sony_nc_update_status_ng(struct backlight_device *bd)
 975 {
 976         int value, result;
 977         int *handle = (int *)bl_get_data(bd);
 978         struct sony_backlight_props *sdev =
 979                 (struct sony_backlight_props *)bl_get_data(bd);
 980
 981         value = bd->props.brightness + sdev->offset;
 982         if (sony_call_snc_handle(sdev->handle, 0x0100 | (value << 16), &result))
 983                 return -EIO;
 984
 985         return value;
 986 }
 987
 988 static const struct backlight_ops sony_backlight_ops = {
 989         .options = BL_CORE_SUSPENDRESUME,
 990         .update_status = sony_backlight_update_status,
 991         .get_brightness = sony_backlight_get_brightness,
 992 };
 993 static const struct backlight_ops sony_backlight_ng_ops = {
 994         .options = BL_CORE_SUSPENDRESUME,
 995         .update_status = sony_nc_update_status_ng,
 996         .get_brightness = sony_nc_get_brightness_ng,
 997 };
 998
 999 /*
1000  * New SNC-only Vaios event mapping to driver known keys
1001  */
1002 struct sony_nc_event {
1003         u8      data;
1004         u8      event;
1005 };
1006
1007 static struct sony_nc_event sony_100_events[] = {
1008         { 0x90, SONYPI_EVENT_PKEY_P1 },
1009         { 0x10, SONYPI_EVENT_ANYBUTTON_RELEASED },
1010         { 0x91, SONYPI_EVENT_PKEY_P2 },
1011         { 0x11, SONYPI_EVENT_ANYBUTTON_RELEASED },
1012         { 0x81, SONYPI_EVENT_FNKEY_F1 },
1013         { 0x01, SONYPI_EVENT_FNKEY_RELEASED },
1014         { 0x82, SONYPI_EVENT_FNKEY_F2 },
1015         { 0x02, SONYPI_EVENT_FNKEY_RELEASED },
1016         { 0x83, SONYPI_EVENT_FNKEY_F3 },
1017         { 0x03, SONYPI_EVENT_FNKEY_RELEASED },
1018         { 0x84, SONYPI_EVENT_FNKEY_F4 },
1019         { 0x04, SONYPI_EVENT_FNKEY_RELEASED },
1020         { 0x85, SONYPI_EVENT_FNKEY_F5 },
1021         { 0x05, SONYPI_EVENT_FNKEY_RELEASED },
1022         { 0x86, SONYPI_EVENT_FNKEY_F6 },
1023         { 0x06, SONYPI_EVENT_FNKEY_RELEASED },
1024         { 0x87, SONYPI_EVENT_FNKEY_F7 },
1025         { 0x07, SONYPI_EVENT_FNKEY_RELEASED },
1026         { 0x89, SONYPI_EVENT_FNKEY_F9 },
1027         { 0x09, SONYPI_EVENT_FNKEY_RELEASED },
1028         { 0x8A, SONYPI_EVENT_FNKEY_F10 },
1029         { 0x0A, SONYPI_EVENT_FNKEY_RELEASED },
1030         { 0x8C, SONYPI_EVENT_FNKEY_F12 },
1031         { 0x0C, SONYPI_EVENT_FNKEY_RELEASED },
1032         { 0x9d, SONYPI_EVENT_ZOOM_PRESSED },
1033         { 0x1d, SONYPI_EVENT_ANYBUTTON_RELEASED },
1034         { 0x9f, SONYPI_EVENT_CD_EJECT_PRESSED },
1035         { 0x1f, SONYPI_EVENT_ANYBUTTON_RELEASED },
1036         { 0xa1, SONYPI_EVENT_MEDIA_PRESSED },
1037         { 0x21, SONYPI_EVENT_ANYBUTTON_RELEASED },
1038         { 0xa4, SONYPI_EVENT_CD_EJECT_PRESSED },
1039         { 0x24, SONYPI_EVENT_ANYBUTTON_RELEASED },
1040         { 0xa5, SONYPI_EVENT_VENDOR_PRESSED },
1041         { 0x25, SONYPI_EVENT_ANYBUTTON_RELEASED },
1042         { 0xa6, SONYPI_EVENT_HELP_PRESSED },
1043         { 0x26, SONYPI_EVENT_ANYBUTTON_RELEASED },
1044         { 0, 0 },
1045 };
1046
1047 static struct sony_nc_event sony_127_events[] = {
1048         { 0x81, SONYPI_EVENT_MODEKEY_PRESSED },
1049         { 0x01, SONYPI_EVENT_ANYBUTTON_RELEASED },
1050         { 0x82, SONYPI_EVENT_PKEY_P1 },
1051         { 0x02, SONYPI_EVENT_ANYBUTTON_RELEASED },
1052         { 0x83, SONYPI_EVENT_PKEY_P2 },
1053         { 0x03, SONYPI_EVENT_ANYBUTTON_RELEASED },
1054         { 0x84, SONYPI_EVENT_PKEY_P3 },
1055         { 0x04, SONYPI_EVENT_ANYBUTTON_RELEASED },
1056         { 0x85, SONYPI_EVENT_PKEY_P4 },
1057         { 0x05, SONYPI_EVENT_ANYBUTTON_RELEASED },
1058         { 0x86, SONYPI_EVENT_PKEY_P5 },
1059         { 0x06, SONYPI_EVENT_ANYBUTTON_RELEASED },
1060         { 0x87, SONYPI_EVENT_SETTINGKEY_PRESSED },
1061         { 0x07, SONYPI_EVENT_ANYBUTTON_RELEASED },
1062         { 0, 0 },
1063 };
1064
1065 /*
1066  * ACPI callbacks
1067  */
1068 static void sony_nc_notify(struct acpi_device *device, u32 event)
1069 {
1070         u32 ev = event;
1071
1072         if (ev >= 0x90) {
1073                 /* New-style event */
1074                 int result;
1075                 int key_handle = 0;
1076                 ev -= 0x90;
1077
1078                 if (sony_find_snc_handle(0x100) == ev)
1079                         key_handle = 0x100;
1080                 if (sony_find_snc_handle(0x127) == ev)
1081                         key_handle = 0x127;
1082
1083                 if (key_handle) {
1084                         struct sony_nc_event *key_event;
1085
1086                         if (sony_call_snc_handle(key_handle, 0x200, &result)) {
1087                                 dprintk("sony_nc_notify, unable to decode"
1088                                         " event 0x%.2x 0x%.2x\n", key_handle,
1089                                         ev);
1090                                 /* restore the original event */
1091                                 ev = event;
1092                         } else {
1093                                 ev = result & 0xFF;
1094
1095                                 if (key_handle == 0x100)
1096                                         key_event = sony_100_events;
1097                                 else
1098                                         key_event = sony_127_events;
1099
1100                                 for (; key_event->data; key_event++) {
1101                                         if (key_event->data == ev) {
1102                                                 ev = key_event->event;
1103                                                 break;
1104                                         }
1105                                 }
1106
1107                                 if (!key_event->data)
1108                                         pr_info("Unknown event: 0x%x 0x%x\n",
1109                                                 key_handle, ev);
1110                                 else
1111                                         sony_laptop_report_input_event(ev);
1112                         }
1113                 } else if (sony_find_snc_handle(sony_rfkill_handle) == ev) {
1114                         sony_nc_rfkill_update();
1115                         return;
1116                 }
1117         } else
1118                 sony_laptop_report_input_event(ev);
1119
1120         dprintk("sony_nc_notify, event: 0x%.2x\n", ev);
1121         acpi_bus_generate_proc_event(sony_nc_acpi_device, 1, ev);
1122 }
1123
1124 static acpi_status sony_walk_callback(acpi_handle handle, u32 level,
1125                                       void *context, void **return_value)
1126 {
1127         struct acpi_device_info *info;
1128
1129         if (ACPI_SUCCESS(acpi_get_object_info(handle, &info))) {
1130                 pr_warn("method: name: %4.4s, args %X\n",
1131                         (char *)&info->name, info->param_count);
1132
1133                 kfree(info);
1134         }
1135
1136         return AE_OK;
1137 }
1138
1139 /*
1140  * ACPI device
1141  */
1142 static int sony_nc_function_setup(struct acpi_device *device)
1143 {
1144         int result;
1145
1146         /* Enable all events */
1147         acpi_callsetfunc(sony_nc_acpi_handle, "SN02", 0xffff, &result);
1148
1149         /* Setup hotkeys */
1150         sony_call_snc_handle(0x0100, 0, &result);
1151         sony_call_snc_handle(0x0101, 0, &result);
1152         sony_call_snc_handle(0x0102, 0x100, &result);
1153         sony_call_snc_handle(0x0127, 0, &result);
1154
1155         return 0;
1156 }
1157
1158 static int sony_nc_resume(struct acpi_device *device)
1159 {
1160         struct sony_nc_value *item;
1161         acpi_handle handle;
1162
1163         for (item = sony_nc_values; item->name; item++) {
1164                 int ret;
1165
1166                 if (!item->valid)
1167                         continue;
1168                 ret = acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset,
1169                                        item->value, NULL);
1170                 if (ret < 0) {
1171                         pr_err("%s: %d\n", __func__, ret);
1172                         break;
1173                 }
1174         }
1175
1176         if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "ECON",
1177                                          &handle))) {
1178                 if (acpi_callsetfunc(sony_nc_acpi_handle, "ECON", 1, NULL))
1179                         dprintk("ECON Method failed\n");
1180         }
1181
1182         if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "SN00",
1183                                          &handle))) {
1184                 dprintk("Doing SNC setup\n");
1185                 sony_nc_function_setup(device);
1186         }
1187
1188         /* re-read rfkill state */
1189         sony_nc_rfkill_update();
1190
1191         /* restore kbd backlight states */
1192         sony_nc_kbd_backlight_resume();
1193
1194         return 0;
1195 }
1196
1197 static void sony_nc_rfkill_cleanup(void)
1198 {
1199         int i;
1200
1201         for (i = 0; i < N_SONY_RFKILL; i++) {
1202                 if (sony_rfkill_devices[i]) {
1203                         rfkill_unregister(sony_rfkill_devices[i]);
1204                         rfkill_destroy(sony_rfkill_devices[i]);
1205                 }
1206         }
1207 }
1208
1209 static int sony_nc_rfkill_set(void *data, bool blocked)
1210 {
1211         int result;
1212         int argument = sony_rfkill_address[(long) data] + 0x100;
1213
1214         if (!blocked)
1215                 argument |= 0xff0000;
1216
1217         return sony_call_snc_handle(sony_rfkill_handle, argument, &result);
1218 }
1219
1220 static const struct rfkill_ops sony_rfkill_ops = {
1221         .set_block = sony_nc_rfkill_set,
1222 };
1223
1224 static int sony_nc_setup_rfkill(struct acpi_device *device,
1225                                 enum sony_nc_rfkill nc_type)
1226 {
1227         int err = 0;
1228         struct rfkill *rfk;
1229         enum rfkill_type type;
1230         const char *name;
1231         int result;
1232         bool hwblock;
1233
1234         switch (nc_type) {
1235         case SONY_WIFI:
1236                 type = RFKILL_TYPE_WLAN;
1237                 name = "sony-wifi";
1238                 break;
1239         case SONY_BLUETOOTH:
1240                 type = RFKILL_TYPE_BLUETOOTH;
1241                 name = "sony-bluetooth";
1242                 break;
1243         case SONY_WWAN:
1244                 type = RFKILL_TYPE_WWAN;
1245                 name = "sony-wwan";
1246                 break;
1247         case SONY_WIMAX:
1248                 type = RFKILL_TYPE_WIMAX;
1249                 name = "sony-wimax";
1250                 break;
1251         default:
1252                 return -EINVAL;
1253         }
1254
1255         rfk = rfkill_alloc(name, &device->dev, type,
1256                            &sony_rfkill_ops, (void *)nc_type);
1257         if (!rfk)
1258                 return -ENOMEM;
1259
1260         sony_call_snc_handle(sony_rfkill_handle, 0x200, &result);
1261         hwblock = !(result & 0x1);
1262         rfkill_set_hw_state(rfk, hwblock);
1263
1264         err = rfkill_register(rfk);
1265         if (err) {
1266                 rfkill_destroy(rfk);
1267                 return err;
1268         }
1269         sony_rfkill_devices[nc_type] = rfk;
1270         return err;
1271 }
1272
1273 static void sony_nc_rfkill_update(void)
1274 {
1275         enum sony_nc_rfkill i;
1276         int result;
1277         bool hwblock;
1278
1279         sony_call_snc_handle(sony_rfkill_handle, 0x200, &result);
1280         hwblock = !(result & 0x1);
1281
1282         for (i = 0; i < N_SONY_RFKILL; i++) {
1283                 int argument = sony_rfkill_address[i];
1284
1285                 if (!sony_rfkill_devices[i])
1286                         continue;
1287
1288                 if (hwblock) {
1289                         if (rfkill_set_hw_state(sony_rfkill_devices[i], true)) {
1290                                 /* we already know we're blocked */
1291                         }
1292                         continue;
1293                 }
1294
1295                 sony_call_snc_handle(sony_rfkill_handle, argument, &result);
1296                 rfkill_set_states(sony_rfkill_devices[i],
1297                                   !(result & 0xf), false);
1298         }
1299 }
1300
1301 static void sony_nc_rfkill_setup(struct acpi_device *device)
1302 {
1303         int offset;
1304         u8 dev_code, i;
1305         acpi_status status;
1306         struct acpi_object_list params;
1307         union acpi_object in_obj;
1308         union acpi_object *device_enum;
1309         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1310
1311         offset = sony_find_snc_handle(0x124);
1312         if (offset == -1) {
1313                 offset = sony_find_snc_handle(0x135);
1314                 if (offset == -1)
1315                         return;
1316                 else
1317                         sony_rfkill_handle = 0x135;
1318         } else
1319                 sony_rfkill_handle = 0x124;
1320         dprintk("Found rkfill handle: 0x%.4x\n", sony_rfkill_handle);
1321
1322         /* need to read the whole buffer returned by the acpi call to SN06
1323          * here otherwise we may miss some features
1324          */
1325         params.count = 1;
1326         params.pointer = &in_obj;
1327         in_obj.type = ACPI_TYPE_INTEGER;
1328         in_obj.integer.value = offset;
1329         status = acpi_evaluate_object(sony_nc_acpi_handle, "SN06", &params,
1330                         &buffer);
1331         if (ACPI_FAILURE(status)) {
1332                 dprintk("Radio device enumeration failed\n");
1333                 return;
1334         }
1335
1336         device_enum = (union acpi_object *) buffer.pointer;
1337         if (!device_enum) {
1338                 pr_err("No SN06 return object\n");
1339                 goto out_no_enum;
1340         }
1341         if (device_enum->type != ACPI_TYPE_BUFFER) {
1342                 pr_err("Invalid SN06 return object 0x%.2x\n",
1343                        device_enum->type);
1344                 goto out_no_enum;
1345         }
1346
1347         /* the buffer is filled with magic numbers describing the devices
1348          * available, 0xff terminates the enumeration
1349          */
1350         for (i = 0; i < device_enum->buffer.length; i++) {
1351
1352                 dev_code = *(device_enum->buffer.pointer + i);
1353                 if (dev_code == 0xff)
1354                         break;
1355
1356                 dprintk("Radio devices, looking at 0x%.2x\n", dev_code);
1357
1358                 if (dev_code == 0 && !sony_rfkill_devices[SONY_WIFI])
1359                         sony_nc_setup_rfkill(device, SONY_WIFI);
1360
1361                 if (dev_code == 0x10 && !sony_rfkill_devices[SONY_BLUETOOTH])
1362                         sony_nc_setup_rfkill(device, SONY_BLUETOOTH);
1363
1364                 if ((0xf0 & dev_code) == 0x20 &&
1365                                 !sony_rfkill_devices[SONY_WWAN])
1366                         sony_nc_setup_rfkill(device, SONY_WWAN);
1367
1368                 if (dev_code == 0x30 && !sony_rfkill_devices[SONY_WIMAX])
1369                         sony_nc_setup_rfkill(device, SONY_WIMAX);
1370         }
1371
1372 out_no_enum:
1373         kfree(buffer.pointer);
1374         return;
1375 }
1376
1377 /* Keyboard backlight feature */
1378 #define KBDBL_HANDLER   0x137
1379 #define KBDBL_PRESENT   0xB00
1380 #define SET_MODE        0xC00
1381 #define SET_STATE       0xD00
1382 #define SET_TIMEOUT     0xE00
1383
1384 struct kbd_backlight {
1385         int mode;
1386         int timeout;
1387         struct device_attribute mode_attr;
1388         struct device_attribute timeout_attr;
1389 };
1390
1391 static struct kbd_backlight *kbdbl_handle;
1392
1393 static ssize_t __sony_nc_kbd_backlight_mode_set(u8 value)
1394 {
1395         int result;
1396
1397         if (value > 1)
1398                 return -EINVAL;
1399
1400         if (sony_call_snc_handle(KBDBL_HANDLER,
1401                                 (value << 0x10) | SET_MODE, &result))
1402                 return -EIO;
1403
1404         /* Try to turn the light on/off immediately */
1405         sony_call_snc_handle(KBDBL_HANDLER, (value << 0x10) | SET_STATE,
1406                         &result);
1407
1408         kbdbl_handle->mode = value;
1409
1410         return 0;
1411 }
1412
1413 static ssize_t sony_nc_kbd_backlight_mode_store(struct device *dev,
1414                 struct device_attribute *attr,
1415                 const char *buffer, size_t count)
1416 {
1417         int ret = 0;
1418         unsigned long value;
1419
1420         if (count > 31)
1421                 return -EINVAL;
1422
1423         if (strict_strtoul(buffer, 10, &value))
1424                 return -EINVAL;
1425
1426         ret = __sony_nc_kbd_backlight_mode_set(value);
1427         if (ret < 0)
1428                 return ret;
1429
1430         return count;
1431 }
1432
1433 static ssize_t sony_nc_kbd_backlight_mode_show(struct device *dev,
1434                 struct device_attribute *attr, char *buffer)
1435 {
1436         ssize_t count = 0;
1437         count = snprintf(buffer, PAGE_SIZE, "%d\n", kbdbl_handle->mode);
1438         return count;
1439 }
1440
1441 static int __sony_nc_kbd_backlight_timeout_set(u8 value)
1442 {
1443         int result;
1444
1445         if (value > 3)
1446                 return -EINVAL;
1447
1448         if (sony_call_snc_handle(KBDBL_HANDLER,
1449                                 (value << 0x10) | SET_TIMEOUT, &result))
1450                 return -EIO;
1451
1452         kbdbl_handle->timeout = value;
1453
1454         return 0;
1455 }
1456
1457 static ssize_t sony_nc_kbd_backlight_timeout_store(struct device *dev,
1458                 struct device_attribute *attr,
1459                 const char *buffer, size_t count)
1460 {
1461         int ret = 0;
1462         unsigned long value;
1463
1464         if (count > 31)
1465                 return -EINVAL;
1466
1467         if (strict_strtoul(buffer, 10, &value))
1468                 return -EINVAL;
1469
1470         ret = __sony_nc_kbd_backlight_timeout_set(value);
1471         if (ret < 0)
1472                 return ret;
1473
1474         return count;
1475 }
1476
1477 static ssize_t sony_nc_kbd_backlight_timeout_show(struct device *dev,
1478                 struct device_attribute *attr, char *buffer)
1479 {
1480         ssize_t count = 0;
1481         count = snprintf(buffer, PAGE_SIZE, "%d\n", kbdbl_handle->timeout);
1482         return count;
1483 }
1484
1485 static int sony_nc_kbd_backlight_setup(struct platform_device *pd)
1486 {
1487         int result;
1488
1489         if (sony_call_snc_handle(KBDBL_HANDLER, KBDBL_PRESENT, &result))
1490                 return 0;
1491         if (!(result & 0x02))
1492                 return 0;
1493
1494         kbdbl_handle = kzalloc(sizeof(*kbdbl_handle), GFP_KERNEL);
1495         if (!kbdbl_handle)
1496                 return -ENOMEM;
1497
1498         sysfs_attr_init(&kbdbl_handle->mode_attr.attr);
1499         kbdbl_handle->mode_attr.attr.name = "kbd_backlight";
1500         kbdbl_handle->mode_attr.attr.mode = S_IRUGO | S_IWUSR;
1501         kbdbl_handle->mode_attr.show = sony_nc_kbd_backlight_mode_show;
1502         kbdbl_handle->mode_attr.store = sony_nc_kbd_backlight_mode_store;
1503
1504         sysfs_attr_init(&kbdbl_handle->timeout_attr.attr);
1505         kbdbl_handle->timeout_attr.attr.name = "kbd_backlight_timeout";
1506         kbdbl_handle->timeout_attr.attr.mode = S_IRUGO | S_IWUSR;
1507         kbdbl_handle->timeout_attr.show = sony_nc_kbd_backlight_timeout_show;
1508         kbdbl_handle->timeout_attr.store = sony_nc_kbd_backlight_timeout_store;
1509
1510         if (device_create_file(&pd->dev, &kbdbl_handle->mode_attr))
1511                 goto outkzalloc;
1512
1513         if (device_create_file(&pd->dev, &kbdbl_handle->timeout_attr))
1514                 goto outmode;
1515
1516         __sony_nc_kbd_backlight_mode_set(kbd_backlight);
1517         __sony_nc_kbd_backlight_timeout_set(kbd_backlight_timeout);
1518
1519         return 0;
1520
1521 outmode:
1522         device_remove_file(&pd->dev, &kbdbl_handle->mode_attr);
1523 outkzalloc:
1524         kfree(kbdbl_handle);
1525         kbdbl_handle = NULL;
1526         return -1;
1527 }
1528
1529 static int sony_nc_kbd_backlight_cleanup(struct platform_device *pd)
1530 {
1531         if (kbdbl_handle) {
1532                 int result;
1533
1534                 device_remove_file(&pd->dev, &kbdbl_handle->mode_attr);
1535                 device_remove_file(&pd->dev, &kbdbl_handle->timeout_attr);
1536
1537                 /* restore the default hw behaviour */
1538                 sony_call_snc_handle(KBDBL_HANDLER, 0x1000 | SET_MODE, &result);
1539                 sony_call_snc_handle(KBDBL_HANDLER, SET_TIMEOUT, &result);
1540
1541                 kfree(kbdbl_handle);
1542         }
1543         return 0;
1544 }
1545
1546 static void sony_nc_kbd_backlight_resume(void)
1547 {
1548         int ignore = 0;
1549
1550         if (!kbdbl_handle)
1551                 return;
1552
1553         if (kbdbl_handle->mode == 0)
1554                 sony_call_snc_handle(KBDBL_HANDLER, SET_MODE, &ignore);
1555
1556         if (kbdbl_handle->timeout != 0)
1557                 sony_call_snc_handle(KBDBL_HANDLER,
1558                                 (kbdbl_handle->timeout << 0x10) | SET_TIMEOUT,
1559                                 &ignore);
1560 }
1561
1562 static void sony_nc_backlight_ng_read_limits(int handle,
1563                 struct sony_backlight_props *props)
1564 {
1565         int offset;
1566         acpi_status status;
1567         u8 brlvl, i;
1568         u8 min = 0xff, max = 0x00;
1569         struct acpi_object_list params;
1570         union acpi_object in_obj;
1571         union acpi_object *lvl_enum;
1572         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1573
1574         props->handle = handle;
1575         props->offset = 0;
1576         props->maxlvl = 0xff;
1577
1578         offset = sony_find_snc_handle(handle);
1579         if (offset < 0)
1580                 return;
1581
1582         /* try to read the boundaries from ACPI tables, if we fail the above
1583          * defaults should be reasonable
1584          */
1585         params.count = 1;
1586         params.pointer = &in_obj;
1587         in_obj.type = ACPI_TYPE_INTEGER;
1588         in_obj.integer.value = offset;
1589         status = acpi_evaluate_object(sony_nc_acpi_handle, "SN06", &params,
1590                         &buffer);
1591         if (ACPI_FAILURE(status))
1592                 return;
1593
1594         lvl_enum = (union acpi_object *) buffer.pointer;
1595         if (!lvl_enum) {
1596                 pr_err("No SN06 return object.");
1597                 return;
1598         }
1599         if (lvl_enum->type != ACPI_TYPE_BUFFER) {
1600                 pr_err("Invalid SN06 return object 0x%.2x\n",
1601                        lvl_enum->type);
1602                 goto out_invalid;
1603         }
1604
1605         /* the buffer lists brightness levels available, brightness levels are
1606          * from 0 to 8 in the array, other values are used by ALS control.
1607          */
1608         for (i = 0; i < 9 && i < lvl_enum->buffer.length; i++) {
1609
1610                 brlvl = *(lvl_enum->buffer.pointer + i);
1611                 dprintk("Brightness level: %d\n", brlvl);
1612
1613                 if (!brlvl)
1614                         break;
1615
1616                 if (brlvl > max)
1617                         max = brlvl;
1618                 if (brlvl < min)
1619                         min = brlvl;
1620         }
1621         props->offset = min;
1622         props->maxlvl = max;
1623         dprintk("Brightness levels: min=%d max=%d\n", props->offset,
1624                         props->maxlvl);
1625
1626 out_invalid:
1627         kfree(buffer.pointer);
1628         return;
1629 }
1630
1631 static void sony_nc_backlight_setup(void)
1632 {
1633         acpi_handle unused;
1634         int max_brightness = 0;
1635         const struct backlight_ops *ops = NULL;
1636         struct backlight_properties props;
1637
1638         if (sony_find_snc_handle(0x12f) != -1) {
1639                 ops = &sony_backlight_ng_ops;
1640                 sony_nc_backlight_ng_read_limits(0x12f, &sony_bl_props);
1641                 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset;
1642
1643         } else if (sony_find_snc_handle(0x137) != -1) {
1644                 ops = &sony_backlight_ng_ops;
1645                 sony_nc_backlight_ng_read_limits(0x137, &sony_bl_props);
1646                 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset;
1647
1648         } else if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "GBRT",
1649                                                 &unused))) {
1650                 ops = &sony_backlight_ops;
1651                 max_brightness = SONY_MAX_BRIGHTNESS - 1;
1652
1653         } else
1654                 return;
1655
1656         memset(&props, 0, sizeof(struct backlight_properties));
1657         props.type = BACKLIGHT_PLATFORM;
1658         props.max_brightness = max_brightness;
1659         sony_bl_props.dev = backlight_device_register("sony", NULL,
1660                                                       &sony_bl_props,
1661                                                       ops, &props);
1662
1663         if (IS_ERR(sony_bl_props.dev)) {
1664                 pr_warn("unable to register backlight device\n");
1665                 sony_bl_props.dev = NULL;
1666         } else
1667                 sony_bl_props.dev->props.brightness =
1668                         ops->get_brightness(sony_bl_props.dev);
1669 }
1670
1671 static void sony_nc_backlight_cleanup(void)
1672 {
1673         if (sony_bl_props.dev)
1674                 backlight_device_unregister(sony_bl_props.dev);
1675 }
1676
1677 static int sony_nc_add(struct acpi_device *device)
1678 {
1679         acpi_status status;
1680         int result = 0;
1681         acpi_handle handle;
1682         struct sony_nc_value *item;
1683
1684         pr_info("%s v%s\n", SONY_NC_DRIVER_NAME, SONY_LAPTOP_DRIVER_VERSION);
1685
1686         sony_nc_acpi_device = device;
1687         strcpy(acpi_device_class(device), "sony/hotkey");
1688
1689         sony_nc_acpi_handle = device->handle;
1690
1691         /* read device status */
1692         result = acpi_bus_get_status(device);
1693         /* bail IFF the above call was successful and the device is not present */
1694         if (!result && !device->status.present) {
1695                 dprintk("Device not present\n");
1696                 result = -ENODEV;
1697                 goto outwalk;
1698         }
1699
1700         result = sony_pf_add();
1701         if (result)
1702                 goto outpresent;
1703
1704         if (debug) {
1705                 status = acpi_walk_namespace(ACPI_TYPE_METHOD,
1706                                 sony_nc_acpi_handle, 1, sony_walk_callback,
1707                                 NULL, NULL, NULL);
1708                 if (ACPI_FAILURE(status)) {
1709                         pr_warn("unable to walk acpi resources\n");
1710                         result = -ENODEV;
1711                         goto outpresent;
1712                 }
1713         }
1714
1715         if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "ECON",
1716                                          &handle))) {
1717                 if (acpi_callsetfunc(sony_nc_acpi_handle, "ECON", 1, NULL))
1718                         dprintk("ECON Method failed\n");
1719         }
1720
1721         if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "SN00",
1722                                          &handle))) {
1723                 dprintk("Doing SNC setup\n");
1724                 result = sony_nc_handles_setup(sony_pf_device);
1725                 if (result)
1726                         goto outpresent;
1727                 result = sony_nc_kbd_backlight_setup(sony_pf_device);
1728                 if (result)
1729                         goto outsnc;
1730                 sony_nc_function_setup(device);
1731                 sony_nc_rfkill_setup(device);
1732         }
1733
1734         /* setup input devices and helper fifo */
1735         result = sony_laptop_setup_input(device);
1736         if (result) {
1737                 pr_err("Unable to create input devices\n");
1738                 goto outkbdbacklight;
1739         }
1740
1741         if (acpi_video_backlight_support()) {
1742                 pr_info("brightness ignored, must be controlled by ACPI video driver\n");
1743         } else {
1744                 sony_nc_backlight_setup();
1745         }
1746
1747         /* create sony_pf sysfs attributes related to the SNC device */
1748         for (item = sony_nc_values; item->name; ++item) {
1749
1750                 if (!debug && item->debug)
1751                         continue;
1752
1753                 /* find the available acpiget as described in the DSDT */
1754                 for (; item->acpiget && *item->acpiget; ++item->acpiget) {
1755                         if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle,
1756                                                          *item->acpiget,
1757                                                          &handle))) {
1758                                 dprintk("Found %s getter: %s\n",
1759                                                 item->name, *item->acpiget);
1760                                 item->devattr.attr.mode |= S_IRUGO;
1761                                 break;
1762                         }
1763                 }
1764
1765                 /* find the available acpiset as described in the DSDT */
1766                 for (; item->acpiset && *item->acpiset; ++item->acpiset) {
1767                         if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle,
1768                                                          *item->acpiset,
1769                                                          &handle))) {
1770                                 dprintk("Found %s setter: %s\n",
1771                                                 item->name, *item->acpiset);
1772                                 item->devattr.attr.mode |= S_IWUSR;
1773                                 break;
1774                         }
1775                 }
1776
1777                 if (item->devattr.attr.mode != 0) {
1778                         result =
1779                             device_create_file(&sony_pf_device->dev,
1780                                                &item->devattr);
1781                         if (result)
1782                                 goto out_sysfs;
1783                 }
1784         }
1785
1786         return 0;
1787
1788       out_sysfs:
1789         for (item = sony_nc_values; item->name; ++item) {
1790                 device_remove_file(&sony_pf_device->dev, &item->devattr);
1791         }
1792         sony_nc_backlight_cleanup();
1793
1794         sony_laptop_remove_input();
1795
1796       outkbdbacklight:
1797         sony_nc_kbd_backlight_cleanup(sony_pf_device);
1798
1799       outsnc:
1800         sony_nc_handles_cleanup(sony_pf_device);
1801
1802       outpresent:
1803         sony_pf_remove();
1804
1805       outwalk:
1806         sony_nc_rfkill_cleanup();
1807         return result;
1808 }
1809
1810 static int sony_nc_remove(struct acpi_device *device, int type)
1811 {
1812         struct sony_nc_value *item;
1813
1814         sony_nc_backlight_cleanup();
1815
1816         sony_nc_acpi_device = NULL;
1817
1818         for (item = sony_nc_values; item->name; ++item) {
1819                 device_remove_file(&sony_pf_device->dev, &item->devattr);
1820         }
1821
1822         sony_nc_kbd_backlight_cleanup(sony_pf_device);
1823         sony_nc_handles_cleanup(sony_pf_device);
1824         sony_pf_remove();
1825         sony_laptop_remove_input();
1826         sony_nc_rfkill_cleanup();
1827         dprintk(SONY_NC_DRIVER_NAME " removed.\n");
1828
1829         return 0;
1830 }
1831
1832 static const struct acpi_device_id sony_device_ids[] = {
1833         {SONY_NC_HID, 0},
1834         {SONY_PIC_HID, 0},
1835         {"", 0},
1836 };
1837 MODULE_DEVICE_TABLE(acpi, sony_device_ids);
1838
1839 static const struct acpi_device_id sony_nc_device_ids[] = {
1840         {SONY_NC_HID, 0},
1841         {"", 0},
1842 };
1843
1844 static struct acpi_driver sony_nc_driver = {
1845         .name = SONY_NC_DRIVER_NAME,
1846         .class = SONY_NC_CLASS,
1847         .ids = sony_nc_device_ids,
1848         .owner = THIS_MODULE,
1849         .ops = {
1850                 .add = sony_nc_add,
1851                 .remove = sony_nc_remove,
1852                 .resume = sony_nc_resume,
1853                 .notify = sony_nc_notify,
1854                 },
1855 };
1856
1857 /*********** SPIC (SNY6001) Device ***********/
1858
1859 #define SONYPI_DEVICE_TYPE1     0x00000001
1860 #define SONYPI_DEVICE_TYPE2     0x00000002
1861 #define SONYPI_DEVICE_TYPE3     0x00000004
1862
1863 #define SONYPI_TYPE1_OFFSET     0x04
1864 #define SONYPI_TYPE2_OFFSET     0x12
1865 #define SONYPI_TYPE3_OFFSET     0x12
1866
1867 struct sony_pic_ioport {
1868         struct acpi_resource_io io1;
1869         struct acpi_resource_io io2;
1870         struct list_head        list;
1871 };
1872
1873 struct sony_pic_irq {
1874         struct acpi_resource_irq        irq;
1875         struct list_head                list;
1876 };
1877
1878 struct sonypi_eventtypes {
1879         u8                      data;
1880         unsigned long           mask;
1881         struct sonypi_event     *events;
1882 };
1883
1884 struct sony_pic_dev {
1885         struct acpi_device              *acpi_dev;
1886         struct sony_pic_irq             *cur_irq;
1887         struct sony_pic_ioport          *cur_ioport;
1888         struct list_head                interrupts;
1889         struct list_head                ioports;
1890         struct mutex                    lock;
1891         struct sonypi_eventtypes        *event_types;
1892         int                             (*handle_irq)(const u8, const u8);
1893         int                             model;
1894         u16                             evport_offset;
1895         u8                              camera_power;
1896         u8                              bluetooth_power;
1897         u8                              wwan_power;
1898 };
1899
1900 static struct sony_pic_dev spic_dev = {
1901         .interrupts     = LIST_HEAD_INIT(spic_dev.interrupts),
1902         .ioports        = LIST_HEAD_INIT(spic_dev.ioports),
1903 };
1904
1905 static int spic_drv_registered;
1906
1907 /* Event masks */
1908 #define SONYPI_JOGGER_MASK                      0x00000001
1909 #define SONYPI_CAPTURE_MASK                     0x00000002
1910 #define SONYPI_FNKEY_MASK                       0x00000004
1911 #define SONYPI_BLUETOOTH_MASK                   0x00000008
1912 #define SONYPI_PKEY_MASK                        0x00000010
1913 #define SONYPI_BACK_MASK                        0x00000020
1914 #define SONYPI_HELP_MASK                        0x00000040
1915 #define SONYPI_LID_MASK                         0x00000080
1916 #define SONYPI_ZOOM_MASK                        0x00000100
1917 #define SONYPI_THUMBPHRASE_MASK                 0x00000200
1918 #define SONYPI_MEYE_MASK                        0x00000400
1919 #define SONYPI_MEMORYSTICK_MASK                 0x00000800
1920 #define SONYPI_BATTERY_MASK                     0x00001000
1921 #define SONYPI_WIRELESS_MASK                    0x00002000
1922
1923 struct sonypi_event {
1924         u8      data;
1925         u8      event;
1926 };
1927
1928 /* The set of possible button release events */
1929 static struct sonypi_event sonypi_releaseev[] = {
1930         { 0x00, SONYPI_EVENT_ANYBUTTON_RELEASED },
1931         { 0, 0 }
1932 };
1933
1934 /* The set of possible jogger events  */
1935 static struct sonypi_event sonypi_joggerev[] = {
1936         { 0x1f, SONYPI_EVENT_JOGDIAL_UP },
1937         { 0x01, SONYPI_EVENT_JOGDIAL_DOWN },
1938         { 0x5f, SONYPI_EVENT_JOGDIAL_UP_PRESSED },
1939         { 0x41, SONYPI_EVENT_JOGDIAL_DOWN_PRESSED },
1940         { 0x1e, SONYPI_EVENT_JOGDIAL_FAST_UP },
1941         { 0x02, SONYPI_EVENT_JOGDIAL_FAST_DOWN },
1942         { 0x5e, SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED },
1943         { 0x42, SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED },
1944         { 0x1d, SONYPI_EVENT_JOGDIAL_VFAST_UP },
1945         { 0x03, SONYPI_EVENT_JOGDIAL_VFAST_DOWN },
1946         { 0x5d, SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED },
1947         { 0x43, SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED },
1948         { 0x40, SONYPI_EVENT_JOGDIAL_PRESSED },
1949         { 0, 0 }
1950 };
1951
1952 /* The set of possible capture button events */
1953 static struct sonypi_event sonypi_captureev[] = {
1954         { 0x05, SONYPI_EVENT_CAPTURE_PARTIALPRESSED },
1955         { 0x07, SONYPI_EVENT_CAPTURE_PRESSED },
1956         { 0x40, SONYPI_EVENT_CAPTURE_PRESSED },
1957         { 0x01, SONYPI_EVENT_CAPTURE_PARTIALRELEASED },
1958         { 0, 0 }
1959 };
1960
1961 /* The set of possible fnkeys events */
1962 static struct sonypi_event sonypi_fnkeyev[] = {
1963         { 0x10, SONYPI_EVENT_FNKEY_ESC },
1964         { 0x11, SONYPI_EVENT_FNKEY_F1 },
1965         { 0x12, SONYPI_EVENT_FNKEY_F2 },
1966         { 0x13, SONYPI_EVENT_FNKEY_F3 },
1967         { 0x14, SONYPI_EVENT_FNKEY_F4 },
1968         { 0x15, SONYPI_EVENT_FNKEY_F5 },
1969         { 0x16, SONYPI_EVENT_FNKEY_F6 },
1970         { 0x17, SONYPI_EVENT_FNKEY_F7 },
1971         { 0x18, SONYPI_EVENT_FNKEY_F8 },
1972         { 0x19, SONYPI_EVENT_FNKEY_F9 },
1973         { 0x1a, SONYPI_EVENT_FNKEY_F10 },
1974         { 0x1b, SONYPI_EVENT_FNKEY_F11 },
1975         { 0x1c, SONYPI_EVENT_FNKEY_F12 },
1976         { 0x1f, SONYPI_EVENT_FNKEY_RELEASED },
1977         { 0x21, SONYPI_EVENT_FNKEY_1 },
1978         { 0x22, SONYPI_EVENT_FNKEY_2 },
1979         { 0x31, SONYPI_EVENT_FNKEY_D },
1980         { 0x32, SONYPI_EVENT_FNKEY_E },
1981         { 0x33, SONYPI_EVENT_FNKEY_F },
1982         { 0x34, SONYPI_EVENT_FNKEY_S },
1983         { 0x35, SONYPI_EVENT_FNKEY_B },
1984         { 0x36, SONYPI_EVENT_FNKEY_ONLY },
1985         { 0, 0 }
1986 };
1987
1988 /* The set of possible program key events */
1989 static struct sonypi_event sonypi_pkeyev[] = {
1990         { 0x01, SONYPI_EVENT_PKEY_P1 },
1991         { 0x02, SONYPI_EVENT_PKEY_P2 },
1992         { 0x04, SONYPI_EVENT_PKEY_P3 },
1993         { 0x20, SONYPI_EVENT_PKEY_P1 },
1994         { 0, 0 }
1995 };
1996
1997 /* The set of possible bluetooth events */
1998 static struct sonypi_event sonypi_blueev[] = {
1999         { 0x55, SONYPI_EVENT_BLUETOOTH_PRESSED },
2000         { 0x59, SONYPI_EVENT_BLUETOOTH_ON },
2001         { 0x5a, SONYPI_EVENT_BLUETOOTH_OFF },
2002         { 0, 0 }
2003 };
2004
2005 /* The set of possible wireless events */
2006 static struct sonypi_event sonypi_wlessev[] = {
2007         { 0x59, SONYPI_EVENT_IGNORE },
2008         { 0x5a, SONYPI_EVENT_IGNORE },
2009         { 0, 0 }
2010 };
2011
2012 /* The set of possible back button events */
2013 static struct sonypi_event sonypi_backev[] = {
2014         { 0x20, SONYPI_EVENT_BACK_PRESSED },
2015         { 0, 0 }
2016 };
2017
2018 /* The set of possible help button events */
2019 static struct sonypi_event sonypi_helpev[] = {
2020         { 0x3b, SONYPI_EVENT_HELP_PRESSED },
2021         { 0, 0 }
2022 };
2023
2024
2025 /* The set of possible lid events */
2026 static struct sonypi_event sonypi_lidev[] = {
2027         { 0x51, SONYPI_EVENT_LID_CLOSED },
2028         { 0x50, SONYPI_EVENT_LID_OPENED },
2029         { 0, 0 }
2030 };
2031
2032 /* The set of possible zoom events */
2033 static struct sonypi_event sonypi_zoomev[] = {
2034         { 0x39, SONYPI_EVENT_ZOOM_PRESSED },
2035         { 0x10, SONYPI_EVENT_ZOOM_IN_PRESSED },
2036         { 0x20, SONYPI_EVENT_ZOOM_OUT_PRESSED },
2037         { 0x04, SONYPI_EVENT_ZOOM_PRESSED },
2038         { 0, 0 }
2039 };
2040
2041 /* The set of possible thumbphrase events */
2042 static struct sonypi_event sonypi_thumbphraseev[] = {
2043         { 0x3a, SONYPI_EVENT_THUMBPHRASE_PRESSED },
2044         { 0, 0 }
2045 };
2046
2047 /* The set of possible motioneye camera events */
2048 static struct sonypi_event sonypi_meyeev[] = {
2049         { 0x00, SONYPI_EVENT_MEYE_FACE },
2050         { 0x01, SONYPI_EVENT_MEYE_OPPOSITE },
2051         { 0, 0 }
2052 };
2053
2054 /* The set of possible memorystick events */
2055 static struct sonypi_event sonypi_memorystickev[] = {
2056         { 0x53, SONYPI_EVENT_MEMORYSTICK_INSERT },
2057         { 0x54, SONYPI_EVENT_MEMORYSTICK_EJECT },
2058         { 0, 0 }
2059 };
2060
2061 /* The set of possible battery events */
2062 static struct sonypi_event sonypi_batteryev[] = {
2063         { 0x20, SONYPI_EVENT_BATTERY_INSERT },
2064         { 0x30, SONYPI_EVENT_BATTERY_REMOVE },
2065         { 0, 0 }
2066 };
2067
2068 /* The set of possible volume events */
2069 static struct sonypi_event sonypi_volumeev[] = {
2070         { 0x01, SONYPI_EVENT_VOLUME_INC_PRESSED },
2071         { 0x02, SONYPI_EVENT_VOLUME_DEC_PRESSED },
2072         { 0, 0 }
2073 };
2074
2075 /* The set of possible brightness events */
2076 static struct sonypi_event sonypi_brightnessev[] = {
2077         { 0x80, SONYPI_EVENT_BRIGHTNESS_PRESSED },
2078         { 0, 0 }
2079 };
2080
2081 static struct sonypi_eventtypes type1_events[] = {
2082         { 0, 0xffffffff, sonypi_releaseev },
2083         { 0x70, SONYPI_MEYE_MASK, sonypi_meyeev },
2084         { 0x30, SONYPI_LID_MASK, sonypi_lidev },
2085         { 0x60, SONYPI_CAPTURE_MASK, sonypi_captureev },
2086         { 0x10, SONYPI_JOGGER_MASK, sonypi_joggerev },
2087         { 0x20, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
2088         { 0x30, SONYPI_BLUETOOTH_MASK, sonypi_blueev },
2089         { 0x40, SONYPI_PKEY_MASK, sonypi_pkeyev },
2090         { 0x30, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
2091         { 0x40, SONYPI_BATTERY_MASK, sonypi_batteryev },
2092         { 0 },
2093 };
2094 static struct sonypi_eventtypes type2_events[] = {
2095         { 0, 0xffffffff, sonypi_releaseev },
2096         { 0x38, SONYPI_LID_MASK, sonypi_lidev },
2097         { 0x11, SONYPI_JOGGER_MASK, sonypi_joggerev },
2098         { 0x61, SONYPI_CAPTURE_MASK, sonypi_captureev },
2099         { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
2100         { 0x31, SONYPI_BLUETOOTH_MASK, sonypi_blueev },
2101         { 0x08, SONYPI_PKEY_MASK, sonypi_pkeyev },
2102         { 0x11, SONYPI_BACK_MASK, sonypi_backev },
2103         { 0x21, SONYPI_HELP_MASK, sonypi_helpev },
2104         { 0x21, SONYPI_ZOOM_MASK, sonypi_zoomev },
2105         { 0x20, SONYPI_THUMBPHRASE_MASK, sonypi_thumbphraseev },
2106         { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
2107         { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
2108         { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev },
2109         { 0 },
2110 };
2111 static struct sonypi_eventtypes type3_events[] = {
2112         { 0, 0xffffffff, sonypi_releaseev },
2113         { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
2114         { 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev },
2115         { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
2116         { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
2117         { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev },
2118         { 0x05, SONYPI_PKEY_MASK, sonypi_pkeyev },
2119         { 0x05, SONYPI_ZOOM_MASK, sonypi_zoomev },
2120         { 0x05, SONYPI_CAPTURE_MASK, sonypi_captureev },
2121         { 0x05, SONYPI_PKEY_MASK, sonypi_volumeev },
2122         { 0x05, SONYPI_PKEY_MASK, sonypi_brightnessev },
2123         { 0 },
2124 };
2125
2126 /* low level spic calls */
2127 #define ITERATIONS_LONG         10000
2128 #define ITERATIONS_SHORT        10
2129 #define wait_on_command(command, iterations) {                          \
2130         unsigned int n = iterations;                                    \
2131         while (--n && (command))                                        \
2132                 udelay(1);                                              \
2133         if (!n)                                                         \
2134                 dprintk("command failed at %s : %s (line %d)\n",        \
2135                                 __FILE__, __func__, __LINE__);  \
2136 }
2137
2138 static u8 sony_pic_call1(u8 dev)
2139 {
2140         u8 v1, v2;
2141
2142         wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
2143                         ITERATIONS_LONG);
2144         outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
2145         v1 = inb_p(spic_dev.cur_ioport->io1.minimum + 4);
2146         v2 = inb_p(spic_dev.cur_ioport->io1.minimum);
2147         dprintk("sony_pic_call1(0x%.2x): 0x%.4x\n", dev, (v2 << 8) | v1);
2148         return v2;
2149 }
2150
2151 static u8 sony_pic_call2(u8 dev, u8 fn)
2152 {
2153         u8 v1;
2154
2155         wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
2156                         ITERATIONS_LONG);
2157         outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
2158         wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
2159                         ITERATIONS_LONG);
2160         outb(fn, spic_dev.cur_ioport->io1.minimum);
2161         v1 = inb_p(spic_dev.cur_ioport->io1.minimum);
2162         dprintk("sony_pic_call2(0x%.2x - 0x%.2x): 0x%.4x\n", dev, fn, v1);
2163         return v1;
2164 }
2165
2166 static u8 sony_pic_call3(u8 dev, u8 fn, u8 v)
2167 {
2168         u8 v1;
2169
2170         wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
2171         outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
2172         wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
2173         outb(fn, spic_dev.cur_ioport->io1.minimum);
2174         wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
2175         outb(v, spic_dev.cur_ioport->io1.minimum);
2176         v1 = inb_p(spic_dev.cur_ioport->io1.minimum);
2177         dprintk("sony_pic_call3(0x%.2x - 0x%.2x - 0x%.2x): 0x%.4x\n",
2178                         dev, fn, v, v1);
2179         return v1;
2180 }
2181
2182 /*
2183  * minidrivers for SPIC models
2184  */
2185 static int type3_handle_irq(const u8 data_mask, const u8 ev)
2186 {
2187         /*
2188          * 0x31 could mean we have to take some extra action and wait for
2189          * the next irq for some Type3 models, it will generate a new
2190          * irq and we can read new data from the device:
2191          *  - 0x5c and 0x5f requires 0xA0
2192          *  - 0x61 requires 0xB3
2193          */
2194         if (data_mask == 0x31) {
2195                 if (ev == 0x5c || ev == 0x5f)
2196                         sony_pic_call1(0xA0);
2197                 else if (ev == 0x61)
2198                         sony_pic_call1(0xB3);
2199                 return 0;
2200         }
2201         return 1;
2202 }
2203
2204 static void sony_pic_detect_device_type(struct sony_pic_dev *dev)
2205 {
2206         struct pci_dev *pcidev;
2207
2208         pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
2209                         PCI_DEVICE_ID_INTEL_82371AB_3, NULL);
2210         if (pcidev) {
2211                 dev->model = SONYPI_DEVICE_TYPE1;
2212                 dev->evport_offset = SONYPI_TYPE1_OFFSET;
2213                 dev->event_types = type1_events;
2214                 goto out;
2215         }
2216
2217         pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
2218                         PCI_DEVICE_ID_INTEL_ICH6_1, NULL);
2219         if (pcidev) {
2220                 dev->model = SONYPI_DEVICE_TYPE2;
2221                 dev->evport_offset = SONYPI_TYPE2_OFFSET;
2222                 dev->event_types = type2_events;
2223                 goto out;
2224         }
2225
2226         pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
2227                         PCI_DEVICE_ID_INTEL_ICH7_1, NULL);
2228         if (pcidev) {
2229                 dev->model = SONYPI_DEVICE_TYPE3;
2230                 dev->handle_irq = type3_handle_irq;
2231                 dev->evport_offset = SONYPI_TYPE3_OFFSET;
2232                 dev->event_types = type3_events;
2233                 goto out;
2234         }
2235
2236         pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
2237                         PCI_DEVICE_ID_INTEL_ICH8_4, NULL);
2238         if (pcidev) {
2239                 dev->model = SONYPI_DEVICE_TYPE3;
2240                 dev->handle_irq = type3_handle_irq;
2241                 dev->evport_offset = SONYPI_TYPE3_OFFSET;
2242                 dev->event_types = type3_events;
2243                 goto out;
2244         }
2245
2246         pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
2247                         PCI_DEVICE_ID_INTEL_ICH9_1, NULL);
2248         if (pcidev) {
2249                 dev->model = SONYPI_DEVICE_TYPE3;
2250                 dev->handle_irq = type3_handle_irq;
2251                 dev->evport_offset = SONYPI_TYPE3_OFFSET;
2252                 dev->event_types = type3_events;
2253                 goto out;
2254         }
2255
2256         /* default */
2257         dev->model = SONYPI_DEVICE_TYPE2;
2258         dev->evport_offset = SONYPI_TYPE2_OFFSET;
2259         dev->event_types = type2_events;
2260
2261 out:
2262         if (pcidev)
2263                 pci_dev_put(pcidev);
2264
2265         pr_info("detected Type%d model\n",
2266                 dev->model == SONYPI_DEVICE_TYPE1 ? 1 :
2267                 dev->model == SONYPI_DEVICE_TYPE2 ? 2 : 3);
2268 }
2269
2270 /* camera tests and poweron/poweroff */
2271 #define SONYPI_CAMERA_PICTURE           5
2272 #define SONYPI_CAMERA_CONTROL           0x10
2273
2274 #define SONYPI_CAMERA_BRIGHTNESS                0
2275 #define SONYPI_CAMERA_CONTRAST                  1
2276 #define SONYPI_CAMERA_HUE                       2
2277 #define SONYPI_CAMERA_COLOR                     3
2278 #define SONYPI_CAMERA_SHARPNESS                 4
2279
2280 #define SONYPI_CAMERA_EXPOSURE_MASK             0xC
2281 #define SONYPI_CAMERA_WHITE_BALANCE_MASK        0x3
2282 #define SONYPI_CAMERA_PICTURE_MODE_MASK         0x30
2283 #define SONYPI_CAMERA_MUTE_MASK                 0x40
2284
2285 /* the rest don't need a loop until not 0xff */
2286 #define SONYPI_CAMERA_AGC                       6
2287 #define SONYPI_CAMERA_AGC_MASK                  0x30
2288 #define SONYPI_CAMERA_SHUTTER_MASK              0x7
2289
2290 #define SONYPI_CAMERA_SHUTDOWN_REQUEST          7
2291 #define SONYPI_CAMERA_CONTROL                   0x10
2292
2293 #define SONYPI_CAMERA_STATUS                    7
2294 #define SONYPI_CAMERA_STATUS_READY              0x2
2295 #define SONYPI_CAMERA_STATUS_POSITION           0x4
2296
2297 #define SONYPI_DIRECTION_BACKWARDS              0x4
2298
2299 #define SONYPI_CAMERA_REVISION                  8
2300 #define SONYPI_CAMERA_ROMVERSION                9
2301
2302 static int __sony_pic_camera_ready(void)
2303 {
2304         u8 v;
2305
2306         v = sony_pic_call2(0x8f, SONYPI_CAMERA_STATUS);
2307         return (v != 0xff && (v & SONYPI_CAMERA_STATUS_READY));
2308 }
2309
2310 static int __sony_pic_camera_off(void)
2311 {
2312         if (!camera) {
2313                 pr_warn("camera control not enabled\n");
2314                 return -ENODEV;
2315         }
2316
2317         wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE,
2318                                 SONYPI_CAMERA_MUTE_MASK),
2319                         ITERATIONS_SHORT);
2320
2321         if (spic_dev.camera_power) {
2322                 sony_pic_call2(0x91, 0);
2323                 spic_dev.camera_power = 0;
2324         }
2325         return 0;
2326 }
2327
2328 static int __sony_pic_camera_on(void)
2329 {
2330         int i, j, x;
2331
2332         if (!camera) {
2333                 pr_warn("camera control not enabled\n");
2334                 return -ENODEV;
2335         }
2336
2337         if (spic_dev.camera_power)
2338                 return 0;
2339
2340         for (j = 5; j > 0; j--) {
2341
2342                 for (x = 0; x < 100 && sony_pic_call2(0x91, 0x1); x++)
2343                         msleep(10);
2344                 sony_pic_call1(0x93);
2345
2346                 for (i = 400; i > 0; i--) {
2347                         if (__sony_pic_camera_ready())
2348                                 break;
2349                         msleep(10);
2350                 }
2351                 if (i)
2352                         break;
2353         }
2354
2355         if (j == 0) {
2356                 pr_warn("failed to power on camera\n");
2357                 return -ENODEV;
2358         }
2359
2360         wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTROL,
2361                                 0x5a),
2362                         ITERATIONS_SHORT);
2363
2364         spic_dev.camera_power = 1;
2365         return 0;
2366 }
2367
2368 /* External camera command (exported to the motion eye v4l driver) */
2369 int sony_pic_camera_command(int command, u8 value)
2370 {
2371         if (!camera)
2372                 return -EIO;
2373
2374         mutex_lock(&spic_dev.lock);
2375
2376         switch (command) {
2377         case SONY_PIC_COMMAND_SETCAMERA:
2378                 if (value)
2379                         __sony_pic_camera_on();
2380                 else
2381                         __sony_pic_camera_off();
2382                 break;
2383         case SONY_PIC_COMMAND_SETCAMERABRIGHTNESS:
2384                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_BRIGHTNESS, value),
2385                                 ITERATIONS_SHORT);
2386                 break;
2387         case SONY_PIC_COMMAND_SETCAMERACONTRAST:
2388                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTRAST, value),
2389                                 ITERATIONS_SHORT);
2390                 break;
2391         case SONY_PIC_COMMAND_SETCAMERAHUE:
2392                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_HUE, value),
2393                                 ITERATIONS_SHORT);
2394                 break;
2395         case SONY_PIC_COMMAND_SETCAMERACOLOR:
2396                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_COLOR, value),
2397                                 ITERATIONS_SHORT);
2398                 break;
2399         case SONY_PIC_COMMAND_SETCAMERASHARPNESS:
2400                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_SHARPNESS, value),
2401                                 ITERATIONS_SHORT);
2402                 break;
2403         case SONY_PIC_COMMAND_SETCAMERAPICTURE:
2404                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, value),
2405                                 ITERATIONS_SHORT);
2406                 break;
2407         case SONY_PIC_COMMAND_SETCAMERAAGC:
2408                 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_AGC, value),
2409                                 ITERATIONS_SHORT);
2410                 break;
2411         default:
2412                 pr_err("sony_pic_camera_command invalid: %d\n", command);
2413                 break;
2414         }
2415         mutex_unlock(&spic_dev.lock);
2416         return 0;
2417 }
2418 EXPORT_SYMBOL(sony_pic_camera_command);
2419
2420 /* gprs/edge modem (SZ460N and SZ210P), thanks to Joshua Wise */
2421 static void __sony_pic_set_wwanpower(u8 state)
2422 {
2423         state = !!state;
2424         if (spic_dev.wwan_power == state)
2425                 return;
2426         sony_pic_call2(0xB0, state);
2427         sony_pic_call1(0x82);
2428         spic_dev.wwan_power = state;
2429 }
2430
2431 static ssize_t sony_pic_wwanpower_store(struct device *dev,
2432                 struct device_attribute *attr,
2433                 const char *buffer, size_t count)
2434 {
2435         unsigned long value;
2436         if (count > 31)
2437                 return -EINVAL;
2438
2439         value = simple_strtoul(buffer, NULL, 10);
2440         mutex_lock(&spic_dev.lock);
2441         __sony_pic_set_wwanpower(value);
2442         mutex_unlock(&spic_dev.lock);
2443
2444         return count;
2445 }
2446
2447 static ssize_t sony_pic_wwanpower_show(struct device *dev,
2448                 struct device_attribute *attr, char *buffer)
2449 {
2450         ssize_t count;
2451         mutex_lock(&spic_dev.lock);
2452         count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.wwan_power);
2453         mutex_unlock(&spic_dev.lock);
2454         return count;
2455 }
2456
2457 /* bluetooth subsystem power state */
2458 static void __sony_pic_set_bluetoothpower(u8 state)
2459 {
2460         state = !!state;
2461         if (spic_dev.bluetooth_power == state)
2462                 return;
2463         sony_pic_call2(0x96, state);
2464         sony_pic_call1(0x82);
2465         spic_dev.bluetooth_power = state;
2466 }
2467
2468 static ssize_t sony_pic_bluetoothpower_store(struct device *dev,
2469                 struct device_attribute *attr,
2470                 const char *buffer, size_t count)
2471 {
2472         unsigned long value;
2473         if (count > 31)
2474                 return -EINVAL;
2475
2476         value = simple_strtoul(buffer, NULL, 10);
2477         mutex_lock(&spic_dev.lock);
2478         __sony_pic_set_bluetoothpower(value);
2479         mutex_unlock(&spic_dev.lock);
2480
2481         return count;
2482 }
2483
2484 static ssize_t sony_pic_bluetoothpower_show(struct device *dev,
2485                 struct device_attribute *attr, char *buffer)
2486 {
2487         ssize_t count = 0;
2488         mutex_lock(&spic_dev.lock);
2489         count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.bluetooth_power);
2490         mutex_unlock(&spic_dev.lock);
2491         return count;
2492 }
2493
2494 /* fan speed */
2495 /* FAN0 information (reverse engineered from ACPI tables) */
2496 #define SONY_PIC_FAN0_STATUS    0x93
2497 static int sony_pic_set_fanspeed(unsigned long value)
2498 {
2499         return ec_write(SONY_PIC_FAN0_STATUS, value);
2500 }
2501
2502 static int sony_pic_get_fanspeed(u8 *value)
2503 {
2504         return ec_read(SONY_PIC_FAN0_STATUS, value);
2505 }
2506
2507 static ssize_t sony_pic_fanspeed_store(struct device *dev,
2508                 struct device_attribute *attr,
2509                 const char *buffer, size_t count)
2510 {
2511         unsigned long value;
2512         if (count > 31)
2513                 return -EINVAL;
2514
2515         value = simple_strtoul(buffer, NULL, 10);
2516         if (sony_pic_set_fanspeed(value))
2517                 return -EIO;
2518
2519         return count;
2520 }
2521
2522 static ssize_t sony_pic_fanspeed_show(struct device *dev,
2523                 struct device_attribute *attr, char *buffer)
2524 {
2525         u8 value = 0;
2526         if (sony_pic_get_fanspeed(&value))
2527                 return -EIO;
2528
2529         return snprintf(buffer, PAGE_SIZE, "%d\n", value);
2530 }
2531
2532 #define SPIC_ATTR(_name, _mode)                                 \
2533 struct device_attribute spic_attr_##_name = __ATTR(_name,       \
2534                 _mode, sony_pic_## _name ##_show,               \
2535                 sony_pic_## _name ##_store)
2536
2537 static SPIC_ATTR(bluetoothpower, 0644);
2538 static SPIC_ATTR(wwanpower, 0644);
2539 static SPIC_ATTR(fanspeed, 0644);
2540
2541 static struct attribute *spic_attributes[] = {
2542         &spic_attr_bluetoothpower.attr,
2543         &spic_attr_wwanpower.attr,
2544         &spic_attr_fanspeed.attr,
2545         NULL
2546 };
2547
2548 static struct attribute_group spic_attribute_group = {
2549         .attrs = spic_attributes
2550 };
2551
2552 /******** SONYPI compatibility **********/
2553 #ifdef CONFIG_SONYPI_COMPAT
2554
2555 /* battery / brightness / temperature  addresses */
2556 #define SONYPI_BAT_FLAGS        0x81
2557 #define SONYPI_LCD_LIGHT        0x96
2558 #define SONYPI_BAT1_PCTRM       0xa0
2559 #define SONYPI_BAT1_LEFT        0xa2
2560 #define SONYPI_BAT1_MAXRT       0xa4
2561 #define SONYPI_BAT2_PCTRM       0xa8
2562 #define SONYPI_BAT2_LEFT        0xaa
2563 #define SONYPI_BAT2_MAXRT       0xac
2564 #define SONYPI_BAT1_MAXTK       0xb0
2565 #define SONYPI_BAT1_FULL        0xb2
2566 #define SONYPI_BAT2_MAXTK       0xb8
2567 #define SONYPI_BAT2_FULL        0xba
2568 #define SONYPI_TEMP_STATUS      0xC1
2569
2570 struct sonypi_compat_s {
2571         struct fasync_struct    *fifo_async;
2572         struct kfifo            fifo;
2573         spinlock_t              fifo_lock;
2574         wait_queue_head_t       fifo_proc_list;
2575         atomic_t                open_count;
2576 };
2577 static struct sonypi_compat_s sonypi_compat = {
2578         .open_count = ATOMIC_INIT(0),
2579 };
2580
2581 static int sonypi_misc_fasync(int fd, struct file *filp, int on)
2582 {
2583         return fasync_helper(fd, filp, on, &sonypi_compat.fifo_async);
2584 }
2585
2586 static int sonypi_misc_release(struct inode *inode, struct file *file)
2587 {
2588         atomic_dec(&sonypi_compat.open_count);
2589         return 0;
2590 }
2591
2592 static int sonypi_misc_open(struct inode *inode, struct file *file)
2593 {
2594         /* Flush input queue on first open */
2595         unsigned long flags;
2596
2597         spin_lock_irqsave(&sonypi_compat.fifo_lock, flags);
2598
2599         if (atomic_inc_return(&sonypi_compat.open_count) == 1)
2600                 kfifo_reset(&sonypi_compat.fifo);
2601
2602         spin_unlock_irqrestore(&sonypi_compat.fifo_lock, flags);
2603
2604         return 0;
2605 }
2606
2607 static ssize_t sonypi_misc_read(struct file *file, char __user *buf,
2608                                 size_t count, loff_t *pos)
2609 {
2610         ssize_t ret;
2611         unsigned char c;
2612
2613         if ((kfifo_len(&sonypi_compat.fifo) == 0) &&
2614             (file->f_flags & O_NONBLOCK))
2615                 return -EAGAIN;
2616
2617         ret = wait_event_interruptible(sonypi_compat.fifo_proc_list,
2618                                        kfifo_len(&sonypi_compat.fifo) != 0);
2619         if (ret)
2620                 return ret;
2621
2622         while (ret < count &&
2623                (kfifo_out_locked(&sonypi_compat.fifo, &c, sizeof(c),
2624                           &sonypi_compat.fifo_lock) == sizeof(c))) {
2625                 if (put_user(c, buf++))
2626                         return -EFAULT;
2627                 ret++;
2628         }
2629
2630         if (ret > 0) {
2631                 struct inode *inode = file->f_path.dentry->d_inode;
2632                 inode->i_atime = current_fs_time(inode->i_sb);
2633         }
2634
2635         return ret;
2636 }
2637
2638 static unsigned int sonypi_misc_poll(struct file *file, poll_table *wait)
2639 {
2640         poll_wait(file, &sonypi_compat.fifo_proc_list, wait);
2641         if (kfifo_len(&sonypi_compat.fifo))
2642                 return POLLIN | POLLRDNORM;
2643         return 0;
2644 }
2645
2646 static int ec_read16(u8 addr, u16 *value)
2647 {
2648         u8 val_lb, val_hb;
2649         if (ec_read(addr, &val_lb))
2650                 return -1;
2651         if (ec_read(addr + 1, &val_hb))
2652                 return -1;
2653         *value = val_lb | (val_hb << 8);
2654         return 0;
2655 }
2656
2657 static long sonypi_misc_ioctl(struct file *fp, unsigned int cmd,
2658                                                         unsigned long arg)
2659 {
2660         int ret = 0;
2661         void __user *argp = (void __user *)arg;
2662         u8 val8;
2663         u16 val16;
2664         int value;
2665
2666         mutex_lock(&spic_dev.lock);
2667         switch (cmd) {
2668         case SONYPI_IOCGBRT:
2669                 if (sony_bl_props.dev == NULL) {
2670                         ret = -EIO;
2671                         break;
2672                 }
2673                 if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value)) {
2674                         ret = -EIO;
2675                         break;
2676                 }
2677                 val8 = ((value & 0xff) - 1) << 5;
2678                 if (copy_to_user(argp, &val8, sizeof(val8)))
2679                                 ret = -EFAULT;
2680                 break;
2681         case SONYPI_IOCSBRT:
2682                 if (sony_bl_props.dev == NULL) {
2683                         ret = -EIO;
2684                         break;
2685                 }
2686                 if (copy_from_user(&val8, argp, sizeof(val8))) {
2687                         ret = -EFAULT;
2688                         break;
2689                 }
2690                 if (acpi_callsetfunc(sony_nc_acpi_handle, "SBRT",
2691                                 (val8 >> 5) + 1, NULL)) {
2692                         ret = -EIO;
2693                         break;
2694                 }
2695                 /* sync the backlight device status */
2696                 sony_bl_props.dev->props.brightness =
2697                     sony_backlight_get_brightness(sony_bl_props.dev);
2698                 break;
2699         case SONYPI_IOCGBAT1CAP:
2700                 if (ec_read16(SONYPI_BAT1_FULL, &val16)) {
2701                         ret = -EIO;
2702                         break;
2703                 }
2704                 if (copy_to_user(argp, &val16, sizeof(val16)))
2705                         ret = -EFAULT;
2706                 break;
2707         case SONYPI_IOCGBAT1REM:
2708                 if (ec_read16(SONYPI_BAT1_LEFT, &val16)) {
2709                         ret = -EIO;
2710                         break;
2711                 }
2712                 if (copy_to_user(argp, &val16, sizeof(val16)))
2713                         ret = -EFAULT;
2714                 break;
2715         case SONYPI_IOCGBAT2CAP:
2716                 if (ec_read16(SONYPI_BAT2_FULL, &val16)) {
2717                         ret = -EIO;
2718                         break;
2719                 }
2720                 if (copy_to_user(argp, &val16, sizeof(val16)))
2721                         ret = -EFAULT;
2722                 break;
2723         case SONYPI_IOCGBAT2REM:
2724                 if (ec_read16(SONYPI_BAT2_LEFT, &val16)) {
2725                         ret = -EIO;
2726                         break;
2727                 }
2728                 if (copy_to_user(argp, &val16, sizeof(val16)))
2729                         ret = -EFAULT;
2730                 break;
2731         case SONYPI_IOCGBATFLAGS:
2732                 if (ec_read(SONYPI_BAT_FLAGS, &val8)) {
2733                         ret = -EIO;
2734                         break;
2735                 }
2736                 val8 &= 0x07;
2737                 if (copy_to_user(argp, &val8, sizeof(val8)))
2738                         ret = -EFAULT;
2739                 break;
2740         case SONYPI_IOCGBLUE:
2741                 val8 = spic_dev.bluetooth_power;
2742                 if (copy_to_user(argp, &val8, sizeof(val8)))
2743                         ret = -EFAULT;
2744                 break;
2745         case SONYPI_IOCSBLUE:
2746                 if (copy_from_user(&val8, argp, sizeof(val8))) {
2747                         ret = -EFAULT;
2748                         break;
2749                 }
2750                 __sony_pic_set_bluetoothpower(val8);
2751                 break;
2752         /* FAN Controls */
2753         case SONYPI_IOCGFAN:
2754                 if (sony_pic_get_fanspeed(&val8)) {
2755                         ret = -EIO;
2756                         break;
2757                 }
2758                 if (copy_to_user(argp, &val8, sizeof(val8)))
2759                         ret = -EFAULT;
2760                 break;
2761         case SONYPI_IOCSFAN:
2762                 if (copy_from_user(&val8, argp, sizeof(val8))) {
2763                         ret = -EFAULT;
2764                         break;
2765                 }
2766                 if (sony_pic_set_fanspeed(val8))
2767                         ret = -EIO;
2768                 break;
2769         /* GET Temperature (useful under APM) */
2770         case SONYPI_IOCGTEMP:
2771                 if (ec_read(SONYPI_TEMP_STATUS, &val8)) {
2772                         ret = -EIO;
2773                         break;
2774                 }
2775                 if (copy_to_user(argp, &val8, sizeof(val8)))
2776                         ret = -EFAULT;
2777                 break;
2778         default:
2779                 ret = -EINVAL;
2780         }
2781         mutex_unlock(&spic_dev.lock);
2782         return ret;
2783 }
2784
2785 static const struct file_operations sonypi_misc_fops = {
2786         .owner          = THIS_MODULE,
2787         .read           = sonypi_misc_read,
2788         .poll           = sonypi_misc_poll,
2789         .open           = sonypi_misc_open,
2790         .release        = sonypi_misc_release,
2791         .fasync         = sonypi_misc_fasync,
2792         .unlocked_ioctl = sonypi_misc_ioctl,
2793         .llseek         = noop_llseek,
2794 };
2795
2796 static struct miscdevice sonypi_misc_device = {
2797         .minor          = MISC_DYNAMIC_MINOR,
2798         .name           = "sonypi",
2799         .fops           = &sonypi_misc_fops,
2800 };
2801
2802 static void sonypi_compat_report_event(u8 event)
2803 {
2804         kfifo_in_locked(&sonypi_compat.fifo, (unsigned char *)&event,
2805                         sizeof(event), &sonypi_compat.fifo_lock);
2806         kill_fasync(&sonypi_compat.fifo_async, SIGIO, POLL_IN);
2807         wake_up_interruptible(&sonypi_compat.fifo_proc_list);
2808 }
2809
2810 static int sonypi_compat_init(void)
2811 {
2812         int error;
2813
2814         spin_lock_init(&sonypi_compat.fifo_lock);
2815         error =
2816          kfifo_alloc(&sonypi_compat.fifo, SONY_LAPTOP_BUF_SIZE, GFP_KERNEL);
2817         if (error) {
2818                 pr_err("kfifo_alloc failed\n");
2819                 return error;
2820         }
2821
2822         init_waitqueue_head(&sonypi_compat.fifo_proc_list);
2823
2824         if (minor != -1)
2825                 sonypi_misc_device.minor = minor;
2826         error = misc_register(&sonypi_misc_device);
2827         if (error) {
2828                 pr_err("misc_register failed\n");
2829                 goto err_free_kfifo;
2830         }
2831         if (minor == -1)
2832                 pr_info("device allocated minor is %d\n",
2833                         sonypi_misc_device.minor);
2834
2835         return 0;
2836
2837 err_free_kfifo:
2838         kfifo_free(&sonypi_compat.fifo);
2839         return error;
2840 }
2841
2842 static void sonypi_compat_exit(void)
2843 {
2844         misc_deregister(&sonypi_misc_device);
2845         kfifo_free(&sonypi_compat.fifo);
2846 }
2847 #else
2848 static int sonypi_compat_init(void) { return 0; }
2849 static void sonypi_compat_exit(void) { }
2850 static void sonypi_compat_report_event(u8 event) { }
2851 #endif /* CONFIG_SONYPI_COMPAT */
2852
2853 /*
2854  * ACPI callbacks
2855  */
2856 static acpi_status
2857 sony_pic_read_possible_resource(struct acpi_resource *resource, void *context)
2858 {
2859         u32 i;
2860         struct sony_pic_dev *dev = (struct sony_pic_dev *)context;
2861
2862         switch (resource->type) {
2863         case ACPI_RESOURCE_TYPE_START_DEPENDENT:
2864                 {
2865                         /* start IO enumeration */
2866                         struct sony_pic_ioport *ioport = kzalloc(sizeof(*ioport), GFP_KERNEL);
2867                         if (!ioport)
2868                                 return AE_ERROR;
2869
2870                         list_add(&ioport->list, &dev->ioports);
2871                         return AE_OK;
2872                 }
2873
2874         case ACPI_RESOURCE_TYPE_END_DEPENDENT:
2875                 /* end IO enumeration */
2876                 return AE_OK;
2877
2878         case ACPI_RESOURCE_TYPE_IRQ:
2879                 {
2880                         struct acpi_resource_irq *p = &resource->data.irq;
2881                         struct sony_pic_irq *interrupt = NULL;
2882                         if (!p || !p->interrupt_count) {
2883                                 /*
2884                                  * IRQ descriptors may have no IRQ# bits set,
2885                                  * particularly those those w/ _STA disabled
2886                                  */
2887                                 dprintk("Blank IRQ resource\n");
2888                                 return AE_OK;
2889                         }
2890                         for (i = 0; i < p->interrupt_count; i++) {
2891                                 if (!p->interrupts[i]) {
2892                                         pr_warn("Invalid IRQ %d\n",
2893                                                 p->interrupts[i]);
2894                                         continue;
2895                                 }
2896                                 interrupt = kzalloc(sizeof(*interrupt),
2897                                                 GFP_KERNEL);
2898                                 if (!interrupt)
2899                                         return AE_ERROR;
2900
2901                                 list_add(&interrupt->list, &dev->interrupts);
2902                                 interrupt->irq.triggering = p->triggering;
2903                                 interrupt->irq.polarity = p->polarity;
2904                                 interrupt->irq.sharable = p->sharable;
2905                                 interrupt->irq.interrupt_count = 1;
2906                                 interrupt->irq.interrupts[0] = p->interrupts[i];
2907                         }
2908                         return AE_OK;
2909                 }
2910         case ACPI_RESOURCE_TYPE_IO:
2911                 {
2912                         struct acpi_resource_io *io = &resource->data.io;
2913                         struct sony_pic_ioport *ioport =
2914                                 list_first_entry(&dev->ioports, struct sony_pic_ioport, list);
2915                         if (!io) {
2916                                 dprintk("Blank IO resource\n");
2917                                 return AE_OK;
2918                         }
2919
2920                         if (!ioport->io1.minimum) {
2921                                 memcpy(&ioport->io1, io, sizeof(*io));
2922                                 dprintk("IO1 at 0x%.4x (0x%.2x)\n", ioport->io1.minimum,
2923                                                 ioport->io1.address_length);
2924                         }
2925                         else if (!ioport->io2.minimum) {
2926                                 memcpy(&ioport->io2, io, sizeof(*io));
2927                                 dprintk("IO2 at 0x%.4x (0x%.2x)\n", ioport->io2.minimum,
2928                                                 ioport->io2.address_length);
2929                         }
2930                         else {
2931                                 pr_err("Unknown SPIC Type, more than 2 IO Ports\n");
2932                                 return AE_ERROR;
2933                         }
2934                         return AE_OK;
2935                 }
2936         default:
2937                 dprintk("Resource %d isn't an IRQ nor an IO port\n",
2938                         resource->type);
2939
2940         case ACPI_RESOURCE_TYPE_END_TAG:
2941                 return AE_OK;
2942         }
2943         return AE_CTRL_TERMINATE;
2944 }
2945
2946 static int sony_pic_possible_resources(struct acpi_device *device)
2947 {
2948         int result = 0;
2949         acpi_status status = AE_OK;
2950
2951         if (!device)
2952                 return -EINVAL;
2953
2954         /* get device status */
2955         /* see acpi_pci_link_get_current acpi_pci_link_get_possible */
2956         dprintk("Evaluating _STA\n");
2957         result = acpi_bus_get_status(device);
2958         if (result) {
2959                 pr_warn("Unable to read status\n");
2960                 goto end;
2961         }
2962
2963         if (!device->status.enabled)
2964                 dprintk("Device disabled\n");
2965         else
2966                 dprintk("Device enabled\n");
2967
2968         /*
2969          * Query and parse 'method'
2970          */
2971         dprintk("Evaluating %s\n", METHOD_NAME__PRS);
2972         status = acpi_walk_resources(device->handle, METHOD_NAME__PRS,
2973                         sony_pic_read_possible_resource, &spic_dev);
2974         if (ACPI_FAILURE(status)) {
2975                 pr_warn("Failure evaluating %s\n", METHOD_NAME__PRS);
2976                 result = -ENODEV;
2977         }
2978 end:
2979         return result;
2980 }
2981
2982 /*
2983  *  Disable the spic device by calling its _DIS method
2984  */
2985 static int sony_pic_disable(struct acpi_device *device)
2986 {
2987         acpi_status ret = acpi_evaluate_object(device->handle, "_DIS", NULL,
2988                                                NULL);
2989
2990         if (ACPI_FAILURE(ret) && ret != AE_NOT_FOUND)
2991                 return -ENXIO;
2992
2993         dprintk("Device disabled\n");
2994         return 0;
2995 }
2996
2997
2998 /*
2999  *  Based on drivers/acpi/pci_link.c:acpi_pci_link_set
3000  *
3001  *  Call _SRS to set current resources
3002  */
3003 static int sony_pic_enable(struct acpi_device *device,
3004                 struct sony_pic_ioport *ioport, struct sony_pic_irq *irq)
3005 {
3006         acpi_status status;
3007         int result = 0;
3008         /* Type 1 resource layout is:
3009          *    IO
3010          *    IO
3011          *    IRQNoFlags
3012          *    End
3013          *
3014          * Type 2 and 3 resource layout is:
3015          *    IO
3016          *    IRQNoFlags
3017          *    End
3018          */
3019         struct {
3020                 struct acpi_resource res1;
3021                 struct acpi_resource res2;
3022                 struct acpi_resource res3;
3023                 struct acpi_resource res4;
3024         } *resource;
3025         struct acpi_buffer buffer = { 0, NULL };
3026
3027         if (!ioport || !irq)
3028                 return -EINVAL;
3029
3030         /* init acpi_buffer */
3031         resource = kzalloc(sizeof(*resource) + 1, GFP_KERNEL);
3032         if (!resource)
3033                 return -ENOMEM;
3034
3035         buffer.length = sizeof(*resource) + 1;
3036         buffer.pointer = resource;
3037
3038         /* setup Type 1 resources */
3039         if (spic_dev.model == SONYPI_DEVICE_TYPE1) {
3040
3041                 /* setup io resources */
3042                 resource->res1.type = ACPI_RESOURCE_TYPE_IO;
3043                 resource->res1.length = sizeof(struct acpi_resource);
3044                 memcpy(&resource->res1.data.io, &ioport->io1,
3045                                 sizeof(struct acpi_resource_io));
3046
3047                 resource->res2.type = ACPI_RESOURCE_TYPE_IO;
3048                 resource->res2.length = sizeof(struct acpi_resource);
3049                 memcpy(&resource->res2.data.io, &ioport->io2,
3050                                 sizeof(struct acpi_resource_io));
3051
3052                 /* setup irq resource */
3053                 resource->res3.type = ACPI_RESOURCE_TYPE_IRQ;
3054                 resource->res3.length = sizeof(struct acpi_resource);
3055                 memcpy(&resource->res3.data.irq, &irq->irq,
3056                                 sizeof(struct acpi_resource_irq));
3057                 /* we requested a shared irq */
3058                 resource->res3.data.irq.sharable = ACPI_SHARED;
3059
3060                 resource->res4.type = ACPI_RESOURCE_TYPE_END_TAG;
3061
3062         }
3063         /* setup Type 2/3 resources */
3064         else {
3065                 /* setup io resource */
3066                 resource->res1.type = ACPI_RESOURCE_TYPE_IO;
3067                 resource->res1.length = sizeof(struct acpi_resource);
3068                 memcpy(&resource->res1.data.io, &ioport->io1,
3069                                 sizeof(struct acpi_resource_io));
3070
3071                 /* setup irq resource */
3072                 resource->res2.type = ACPI_RESOURCE_TYPE_IRQ;
3073                 resource->res2.length = sizeof(struct acpi_resource);
3074                 memcpy(&resource->res2.data.irq, &irq->irq,
3075                                 sizeof(struct acpi_resource_irq));
3076                 /* we requested a shared irq */
3077                 resource->res2.data.irq.sharable = ACPI_SHARED;
3078
3079                 resource->res3.type = ACPI_RESOURCE_TYPE_END_TAG;
3080         }
3081
3082         /* Attempt to set the resource */
3083         dprintk("Evaluating _SRS\n");
3084         status = acpi_set_current_resources(device->handle, &buffer);
3085
3086         /* check for total failure */
3087         if (ACPI_FAILURE(status)) {
3088                 pr_err("Error evaluating _SRS\n");
3089                 result = -ENODEV;
3090                 goto end;
3091         }
3092
3093         /* Necessary device initializations calls (from sonypi) */
3094         sony_pic_call1(0x82);
3095         sony_pic_call2(0x81, 0xff);
3096         sony_pic_call1(compat ? 0x92 : 0x82);
3097
3098 end:
3099         kfree(resource);
3100         return result;
3101 }
3102
3103 /*****************
3104  *
3105  * ISR: some event is available
3106  *
3107  *****************/
3108 static irqreturn_t sony_pic_irq(int irq, void *dev_id)
3109 {
3110         int i, j;
3111         u8 ev = 0;
3112         u8 data_mask = 0;
3113         u8 device_event = 0;
3114
3115         struct sony_pic_dev *dev = (struct sony_pic_dev *) dev_id;
3116
3117         ev = inb_p(dev->cur_ioport->io1.minimum);
3118         if (dev->cur_ioport->io2.minimum)
3119                 data_mask = inb_p(dev->cur_ioport->io2.minimum);
3120         else
3121                 data_mask = inb_p(dev->cur_ioport->io1.minimum +
3122                                 dev->evport_offset);
3123
3124         dprintk("event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n",
3125                         ev, data_mask, dev->cur_ioport->io1.minimum,
3126                         dev->evport_offset);
3127
3128         if (ev == 0x00 || ev == 0xff)
3129                 return IRQ_HANDLED;
3130
3131         for (i = 0; dev->event_types[i].mask; i++) {
3132
3133                 if ((data_mask & dev->event_types[i].data) !=
3134                     dev->event_types[i].data)
3135                         continue;
3136
3137                 if (!(mask & dev->event_types[i].mask))
3138                         continue;
3139
3140                 for (j = 0; dev->event_types[i].events[j].event; j++) {
3141                         if (ev == dev->event_types[i].events[j].data) {
3142                                 device_event =
3143                                         dev->event_types[i].events[j].event;
3144                                 /* some events may require ignoring */
3145                                 if (!device_event)
3146                                         return IRQ_HANDLED;
3147                                 goto found;
3148                         }
3149                 }
3150         }
3151         /* Still not able to decode the event try to pass
3152          * it over to the minidriver
3153          */
3154         if (dev->handle_irq && dev->handle_irq(data_mask, ev) == 0)
3155                 return IRQ_HANDLED;
3156
3157         dprintk("unknown event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n",
3158                         ev, data_mask, dev->cur_ioport->io1.minimum,
3159                         dev->evport_offset);
3160         return IRQ_HANDLED;
3161
3162 found:
3163         sony_laptop_report_input_event(device_event);
3164         acpi_bus_generate_proc_event(dev->acpi_dev, 1, device_event);
3165         sonypi_compat_report_event(device_event);
3166         return IRQ_HANDLED;
3167 }
3168
3169 /*****************
3170  *
3171  *  ACPI driver
3172  *
3173  *****************/
3174 static int sony_pic_remove(struct acpi_device *device, int type)
3175 {
3176         struct sony_pic_ioport *io, *tmp_io;
3177         struct sony_pic_irq *irq, *tmp_irq;
3178
3179         if (sony_pic_disable(device)) {
3180                 pr_err("Couldn't disable device\n");
3181                 return -ENXIO;
3182         }
3183
3184         free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev);
3185         release_region(spic_dev.cur_ioport->io1.minimum,
3186                         spic_dev.cur_ioport->io1.address_length);
3187         if (spic_dev.cur_ioport->io2.minimum)
3188                 release_region(spic_dev.cur_ioport->io2.minimum,
3189                                 spic_dev.cur_ioport->io2.address_length);
3190
3191         sonypi_compat_exit();
3192
3193         sony_laptop_remove_input();
3194
3195         /* pf attrs */
3196         sysfs_remove_group(&sony_pf_device->dev.kobj, &spic_attribute_group);
3197         sony_pf_remove();
3198
3199         list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) {
3200                 list_del(&io->list);
3201                 kfree(io);
3202         }
3203         list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) {
3204                 list_del(&irq->list);
3205                 kfree(irq);
3206         }
3207         spic_dev.cur_ioport = NULL;
3208         spic_dev.cur_irq = NULL;
3209
3210         dprintk(SONY_PIC_DRIVER_NAME " removed.\n");
3211         return 0;
3212 }
3213
3214 static int sony_pic_add(struct acpi_device *device)
3215 {
3216         int result;
3217         struct sony_pic_ioport *io, *tmp_io;
3218         struct sony_pic_irq *irq, *tmp_irq;
3219
3220         pr_info("%s v%s\n", SONY_PIC_DRIVER_NAME, SONY_LAPTOP_DRIVER_VERSION);
3221
3222         spic_dev.acpi_dev = device;
3223         strcpy(acpi_device_class(device), "sony/hotkey");
3224         sony_pic_detect_device_type(&spic_dev);
3225         mutex_init(&spic_dev.lock);
3226
3227         /* read _PRS resources */
3228         result = sony_pic_possible_resources(device);
3229         if (result) {
3230                 pr_err("Unable to read possible resources\n");
3231                 goto err_free_resources;
3232         }
3233
3234         /* setup input devices and helper fifo */
3235         result = sony_laptop_setup_input(device);
3236         if (result) {
3237                 pr_err("Unable to create input devices\n");
3238                 goto err_free_resources;
3239         }
3240
3241         if (sonypi_compat_init())
3242                 goto err_remove_input;
3243
3244         /* request io port */
3245         list_for_each_entry_reverse(io, &spic_dev.ioports, list) {
3246                 if (request_region(io->io1.minimum, io->io1.address_length,
3247                                         "Sony Programmable I/O Device")) {
3248                         dprintk("I/O port1: 0x%.4x (0x%.4x) + 0x%.2x\n",
3249                                         io->io1.minimum, io->io1.maximum,
3250                                         io->io1.address_length);
3251                         /* Type 1 have 2 ioports */
3252                         if (io->io2.minimum) {
3253                                 if (request_region(io->io2.minimum,
3254                                                 io->io2.address_length,
3255                                                 "Sony Programmable I/O Device")) {
3256                                         dprintk("I/O port2: 0x%.4x (0x%.4x) + 0x%.2x\n",
3257                                                         io->io2.minimum, io->io2.maximum,
3258                                                         io->io2.address_length);
3259                                         spic_dev.cur_ioport = io;
3260                                         break;
3261                                 }
3262                                 else {
3263                                         dprintk("Unable to get I/O port2: "
3264                                                         "0x%.4x (0x%.4x) + 0x%.2x\n",
3265                                                         io->io2.minimum, io->io2.maximum,
3266                                                         io->io2.address_length);
3267                                         release_region(io->io1.minimum,
3268                                                         io->io1.address_length);
3269                                 }
3270                         }
3271                         else {
3272                                 spic_dev.cur_ioport = io;
3273                                 break;
3274                         }
3275                 }
3276         }
3277         if (!spic_dev.cur_ioport) {
3278                 pr_err("Failed to request_region\n");
3279                 result = -ENODEV;
3280                 goto err_remove_compat;
3281         }
3282
3283         /* request IRQ */
3284         list_for_each_entry_reverse(irq, &spic_dev.interrupts, list) {
3285                 if (!request_irq(irq->irq.interrupts[0], sony_pic_irq,
3286                                         IRQF_DISABLED, "sony-laptop", &spic_dev)) {
3287                         dprintk("IRQ: %d - triggering: %d - "
3288                                         "polarity: %d - shr: %d\n",
3289                                         irq->irq.interrupts[0],
3290                                         irq->irq.triggering,
3291                                         irq->irq.polarity,
3292                                         irq->irq.sharable);
3293                         spic_dev.cur_irq = irq;
3294                         break;
3295                 }
3296         }
3297         if (!spic_dev.cur_irq) {
3298                 pr_err("Failed to request_irq\n");
3299                 result = -ENODEV;
3300                 goto err_release_region;
3301         }
3302
3303         /* set resource status _SRS */
3304         result = sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq);
3305         if (result) {
3306                 pr_err("Couldn't enable device\n");
3307                 goto err_free_irq;
3308         }
3309
3310         spic_dev.bluetooth_power = -1;
3311         /* create device attributes */
3312         result = sony_pf_add();
3313         if (result)
3314                 goto err_disable_device;
3315
3316         result = sysfs_create_group(&sony_pf_device->dev.kobj, &spic_attribute_group);
3317         if (result)
3318                 goto err_remove_pf;
3319
3320         return 0;
3321
3322 err_remove_pf:
3323         sony_pf_remove();
3324
3325 err_disable_device:
3326         sony_pic_disable(device);
3327
3328 err_free_irq:
3329         free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev);
3330
3331 err_release_region:
3332         release_region(spic_dev.cur_ioport->io1.minimum,
3333                         spic_dev.cur_ioport->io1.address_length);
3334         if (spic_dev.cur_ioport->io2.minimum)
3335                 release_region(spic_dev.cur_ioport->io2.minimum,
3336                                 spic_dev.cur_ioport->io2.address_length);
3337
3338 err_remove_compat:
3339         sonypi_compat_exit();
3340
3341 err_remove_input:
3342         sony_laptop_remove_input();
3343
3344 err_free_resources:
3345         list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) {
3346                 list_del(&io->list);
3347                 kfree(io);
3348         }
3349         list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) {
3350                 list_del(&irq->list);
3351                 kfree(irq);
3352         }
3353         spic_dev.cur_ioport = NULL;
3354         spic_dev.cur_irq = NULL;
3355
3356         return result;
3357 }
3358
3359 static int sony_pic_suspend(struct acpi_device *device, pm_message_t state)
3360 {
3361         if (sony_pic_disable(device))
3362                 return -ENXIO;
3363         return 0;
3364 }
3365
3366 static int sony_pic_resume(struct acpi_device *device)
3367 {
3368         sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq);
3369         return 0;
3370 }
3371
3372 static const struct acpi_device_id sony_pic_device_ids[] = {
3373         {SONY_PIC_HID, 0},
3374         {"", 0},
3375 };
3376
3377 static struct acpi_driver sony_pic_driver = {
3378         .name = SONY_PIC_DRIVER_NAME,
3379         .class = SONY_PIC_CLASS,
3380         .ids = sony_pic_device_ids,
3381         .owner = THIS_MODULE,
3382         .ops = {
3383                 .add = sony_pic_add,
3384                 .remove = sony_pic_remove,
3385                 .suspend = sony_pic_suspend,
3386                 .resume = sony_pic_resume,
3387                 },
3388 };
3389
3390 static struct dmi_system_id __initdata sonypi_dmi_table[] = {
3391         {
3392                 .ident = "Sony Vaio",
3393                 .matches = {
3394                         DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
3395                         DMI_MATCH(DMI_PRODUCT_NAME, "PCG-"),
3396                 },
3397         },
3398         {
3399                 .ident = "Sony Vaio",
3400                 .matches = {
3401                         DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
3402                         DMI_MATCH(DMI_PRODUCT_NAME, "VGN-"),
3403                 },
3404         },
3405         { }
3406 };
3407
3408 static int __init sony_laptop_init(void)
3409 {
3410         int result;
3411
3412         if (!no_spic && dmi_check_system(sonypi_dmi_table)) {
3413                 result = acpi_bus_register_driver(&sony_pic_driver);
3414                 if (result) {
3415                         pr_err("Unable to register SPIC driver\n");
3416                         goto out;
3417                 }
3418                 spic_drv_registered = 1;
3419         }
3420
3421         result = acpi_bus_register_driver(&sony_nc_driver);
3422         if (result) {
3423                 pr_err("Unable to register SNC driver\n");
3424                 goto out_unregister_pic;
3425         }
3426
3427         return 0;
3428
3429 out_unregister_pic:
3430         if (spic_drv_registered)
3431                 acpi_bus_unregister_driver(&sony_pic_driver);
3432 out:
3433         return result;
3434 }
3435
3436 static void __exit sony_laptop_exit(void)
3437 {
3438         acpi_bus_unregister_driver(&sony_nc_driver);
3439         if (spic_drv_registered)
3440                 acpi_bus_unregister_driver(&sony_pic_driver);
3441 }
3442
3443 module_init(sony_laptop_init);
3444 module_exit(sony_laptop_exit);