Showing error 819

User: Jiri Slaby
Error type: Resource Leak
Error type description: The code omits to put the resource to the system for reuse
File location: drivers/misc/sony-laptop.c
Line in file: 1563
Project: Linux Kernel
Project version: 2.6.28
Tools: Stanse (1.2)
Entered: 2011-11-07 22:40:13 UTC


Source:

   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 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#include <linux/kernel.h>
  46#include <linux/module.h>
  47#include <linux/moduleparam.h>
  48#include <linux/init.h>
  49#include <linux/smp_lock.h>
  50#include <linux/types.h>
  51#include <linux/backlight.h>
  52#include <linux/platform_device.h>
  53#include <linux/err.h>
  54#include <linux/dmi.h>
  55#include <linux/pci.h>
  56#include <linux/interrupt.h>
  57#include <linux/delay.h>
  58#include <linux/input.h>
  59#include <linux/kfifo.h>
  60#include <linux/workqueue.h>
  61#include <linux/acpi.h>
  62#include <acpi/acpi_drivers.h>
  63#include <acpi/acpi_bus.h>
  64#include <asm/uaccess.h>
  65#include <linux/sonypi.h>
  66#include <linux/sony-laptop.h>
  67#ifdef CONFIG_SONYPI_COMPAT
  68#include <linux/poll.h>
  69#include <linux/miscdevice.h>
  70#endif
  71
  72#define DRV_PFX                        "sony-laptop: "
  73#define dprintk(msg...)                do {                        \
  74        if (debug) printk(KERN_WARNING DRV_PFX  msg);        \
  75} while (0)
  76
  77#define SONY_LAPTOP_DRIVER_VERSION        "0.6"
  78
  79#define SONY_NC_CLASS                "sony-nc"
  80#define SONY_NC_HID                "SNY5001"
  81#define SONY_NC_DRIVER_NAME        "Sony Notebook Control Driver"
  82
  83#define SONY_PIC_CLASS                "sony-pic"
  84#define SONY_PIC_HID                "SNY6001"
  85#define SONY_PIC_DRIVER_NAME        "Sony Programmable IO Control Driver"
  86
  87MODULE_AUTHOR("Stelian Pop, Mattia Dongili");
  88MODULE_DESCRIPTION("Sony laptop extras driver (SPIC and SNC ACPI device)");
  89MODULE_LICENSE("GPL");
  90MODULE_VERSION(SONY_LAPTOP_DRIVER_VERSION);
  91
  92static int debug;
  93module_param(debug, int, 0);
  94MODULE_PARM_DESC(debug, "set this to 1 (and RTFM) if you want to help "
  95                 "the development of this driver");
  96
  97static int no_spic;                /* = 0 */
  98module_param(no_spic, int, 0444);
  99MODULE_PARM_DESC(no_spic,
 100                 "set this if you don't want to enable the SPIC device");
 101
 102static int compat;                /* = 0 */
 103module_param(compat, int, 0444);
 104MODULE_PARM_DESC(compat,
 105                 "set this if you want to enable backward compatibility mode");
 106
 107static unsigned long mask = 0xffffffff;
 108module_param(mask, ulong, 0644);
 109MODULE_PARM_DESC(mask,
 110                 "set this to the mask of event you want to enable (see doc)");
 111
 112static int camera;                /* = 0 */
 113module_param(camera, int, 0444);
 114MODULE_PARM_DESC(camera,
 115                 "set this to 1 to enable Motion Eye camera controls "
 116                 "(only use it if you have a C1VE or C1VN model)");
 117
 118#ifdef CONFIG_SONYPI_COMPAT
 119static int minor = -1;
 120module_param(minor, int, 0);
 121MODULE_PARM_DESC(minor,
 122                 "minor number of the misc device for the SPIC compatibility code, "
 123                 "default is -1 (automatic)");
 124#endif
 125
 126/*********** Input Devices ***********/
 127
 128#define SONY_LAPTOP_BUF_SIZE        128
 129struct sony_laptop_input_s {
 130        atomic_t                users;
 131        struct input_dev        *jog_dev;
 132        struct input_dev        *key_dev;
 133        struct kfifo                *fifo;
 134        spinlock_t                fifo_lock;
 135        struct workqueue_struct        *wq;
 136};
 137static struct sony_laptop_input_s sony_laptop_input = {
 138        .users = ATOMIC_INIT(0),
 139};
 140
 141struct sony_laptop_keypress {
 142        struct input_dev *dev;
 143        int key;
 144};
 145
 146/* Correspondance table between sonypi events
 147 * and input layer indexes in the keymap
 148 */
 149static int sony_laptop_input_index[] = {
 150        -1,        /*  0 no event */
 151        -1,        /*  1 SONYPI_EVENT_JOGDIAL_DOWN */
 152        -1,        /*  2 SONYPI_EVENT_JOGDIAL_UP */
 153        -1,        /*  3 SONYPI_EVENT_JOGDIAL_DOWN_PRESSED */
 154        -1,        /*  4 SONYPI_EVENT_JOGDIAL_UP_PRESSED */
 155        -1,        /*  5 SONYPI_EVENT_JOGDIAL_PRESSED */
 156        -1,        /*  6 SONYPI_EVENT_JOGDIAL_RELEASED */
 157         0,        /*  7 SONYPI_EVENT_CAPTURE_PRESSED */
 158         1,        /*  8 SONYPI_EVENT_CAPTURE_RELEASED */
 159         2,        /*  9 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */
 160         3,        /* 10 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */
 161         4,        /* 11 SONYPI_EVENT_FNKEY_ESC */
 162         5,        /* 12 SONYPI_EVENT_FNKEY_F1 */
 163         6,        /* 13 SONYPI_EVENT_FNKEY_F2 */
 164         7,        /* 14 SONYPI_EVENT_FNKEY_F3 */
 165         8,        /* 15 SONYPI_EVENT_FNKEY_F4 */
 166         9,        /* 16 SONYPI_EVENT_FNKEY_F5 */
 167        10,        /* 17 SONYPI_EVENT_FNKEY_F6 */
 168        11,        /* 18 SONYPI_EVENT_FNKEY_F7 */
 169        12,        /* 19 SONYPI_EVENT_FNKEY_F8 */
 170        13,        /* 20 SONYPI_EVENT_FNKEY_F9 */
 171        14,        /* 21 SONYPI_EVENT_FNKEY_F10 */
 172        15,        /* 22 SONYPI_EVENT_FNKEY_F11 */
 173        16,        /* 23 SONYPI_EVENT_FNKEY_F12 */
 174        17,        /* 24 SONYPI_EVENT_FNKEY_1 */
 175        18,        /* 25 SONYPI_EVENT_FNKEY_2 */
 176        19,        /* 26 SONYPI_EVENT_FNKEY_D */
 177        20,        /* 27 SONYPI_EVENT_FNKEY_E */
 178        21,        /* 28 SONYPI_EVENT_FNKEY_F */
 179        22,        /* 29 SONYPI_EVENT_FNKEY_S */
 180        23,        /* 30 SONYPI_EVENT_FNKEY_B */
 181        24,        /* 31 SONYPI_EVENT_BLUETOOTH_PRESSED */
 182        25,        /* 32 SONYPI_EVENT_PKEY_P1 */
 183        26,        /* 33 SONYPI_EVENT_PKEY_P2 */
 184        27,        /* 34 SONYPI_EVENT_PKEY_P3 */
 185        28,        /* 35 SONYPI_EVENT_BACK_PRESSED */
 186        -1,        /* 36 SONYPI_EVENT_LID_CLOSED */
 187        -1,        /* 37 SONYPI_EVENT_LID_OPENED */
 188        29,        /* 38 SONYPI_EVENT_BLUETOOTH_ON */
 189        30,        /* 39 SONYPI_EVENT_BLUETOOTH_OFF */
 190        31,        /* 40 SONYPI_EVENT_HELP_PRESSED */
 191        32,        /* 41 SONYPI_EVENT_FNKEY_ONLY */
 192        33,        /* 42 SONYPI_EVENT_JOGDIAL_FAST_DOWN */
 193        34,        /* 43 SONYPI_EVENT_JOGDIAL_FAST_UP */
 194        35,        /* 44 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */
 195        36,        /* 45 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */
 196        37,        /* 46 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */
 197        38,        /* 47 SONYPI_EVENT_JOGDIAL_VFAST_UP */
 198        39,        /* 48 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */
 199        40,        /* 49 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */
 200        41,        /* 50 SONYPI_EVENT_ZOOM_PRESSED */
 201        42,        /* 51 SONYPI_EVENT_THUMBPHRASE_PRESSED */
 202        43,        /* 52 SONYPI_EVENT_MEYE_FACE */
 203        44,        /* 53 SONYPI_EVENT_MEYE_OPPOSITE */
 204        45,        /* 54 SONYPI_EVENT_MEMORYSTICK_INSERT */
 205        46,        /* 55 SONYPI_EVENT_MEMORYSTICK_EJECT */
 206        -1,        /* 56 SONYPI_EVENT_ANYBUTTON_RELEASED */
 207        -1,        /* 57 SONYPI_EVENT_BATTERY_INSERT */
 208        -1,        /* 58 SONYPI_EVENT_BATTERY_REMOVE */
 209        -1,        /* 59 SONYPI_EVENT_FNKEY_RELEASED */
 210        47,        /* 60 SONYPI_EVENT_WIRELESS_ON */
 211        48,        /* 61 SONYPI_EVENT_WIRELESS_OFF */
 212        49,        /* 62 SONYPI_EVENT_ZOOM_IN_PRESSED */
 213        50,        /* 63 SONYPI_EVENT_ZOOM_OUT_PRESSED */
 214};
 215
 216static int sony_laptop_input_keycode_map[] = {
 217        KEY_CAMERA,        /*  0 SONYPI_EVENT_CAPTURE_PRESSED */
 218        KEY_RESERVED,        /*  1 SONYPI_EVENT_CAPTURE_RELEASED */
 219        KEY_RESERVED,        /*  2 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */
 220        KEY_RESERVED,        /*  3 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */
 221        KEY_FN_ESC,        /*  4 SONYPI_EVENT_FNKEY_ESC */
 222        KEY_FN_F1,        /*  5 SONYPI_EVENT_FNKEY_F1 */
 223        KEY_FN_F2,        /*  6 SONYPI_EVENT_FNKEY_F2 */
 224        KEY_FN_F3,        /*  7 SONYPI_EVENT_FNKEY_F3 */
 225        KEY_FN_F4,        /*  8 SONYPI_EVENT_FNKEY_F4 */
 226        KEY_FN_F5,        /*  9 SONYPI_EVENT_FNKEY_F5 */
 227        KEY_FN_F6,        /* 10 SONYPI_EVENT_FNKEY_F6 */
 228        KEY_FN_F7,        /* 11 SONYPI_EVENT_FNKEY_F7 */
 229        KEY_FN_F8,        /* 12 SONYPI_EVENT_FNKEY_F8 */
 230        KEY_FN_F9,        /* 13 SONYPI_EVENT_FNKEY_F9 */
 231        KEY_FN_F10,        /* 14 SONYPI_EVENT_FNKEY_F10 */
 232        KEY_FN_F11,        /* 15 SONYPI_EVENT_FNKEY_F11 */
 233        KEY_FN_F12,        /* 16 SONYPI_EVENT_FNKEY_F12 */
 234        KEY_FN_F1,        /* 17 SONYPI_EVENT_FNKEY_1 */
 235        KEY_FN_F2,        /* 18 SONYPI_EVENT_FNKEY_2 */
 236        KEY_FN_D,        /* 19 SONYPI_EVENT_FNKEY_D */
 237        KEY_FN_E,        /* 20 SONYPI_EVENT_FNKEY_E */
 238        KEY_FN_F,        /* 21 SONYPI_EVENT_FNKEY_F */
 239        KEY_FN_S,        /* 22 SONYPI_EVENT_FNKEY_S */
 240        KEY_FN_B,        /* 23 SONYPI_EVENT_FNKEY_B */
 241        KEY_BLUETOOTH,        /* 24 SONYPI_EVENT_BLUETOOTH_PRESSED */
 242        KEY_PROG1,        /* 25 SONYPI_EVENT_PKEY_P1 */
 243        KEY_PROG2,        /* 26 SONYPI_EVENT_PKEY_P2 */
 244        KEY_PROG3,        /* 27 SONYPI_EVENT_PKEY_P3 */
 245        KEY_BACK,        /* 28 SONYPI_EVENT_BACK_PRESSED */
 246        KEY_BLUETOOTH,        /* 29 SONYPI_EVENT_BLUETOOTH_ON */
 247        KEY_BLUETOOTH,        /* 30 SONYPI_EVENT_BLUETOOTH_OFF */
 248        KEY_HELP,        /* 31 SONYPI_EVENT_HELP_PRESSED */
 249        KEY_FN,                /* 32 SONYPI_EVENT_FNKEY_ONLY */
 250        KEY_RESERVED,        /* 33 SONYPI_EVENT_JOGDIAL_FAST_DOWN */
 251        KEY_RESERVED,        /* 34 SONYPI_EVENT_JOGDIAL_FAST_UP */
 252        KEY_RESERVED,        /* 35 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */
 253        KEY_RESERVED,        /* 36 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */
 254        KEY_RESERVED,        /* 37 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */
 255        KEY_RESERVED,        /* 38 SONYPI_EVENT_JOGDIAL_VFAST_UP */
 256        KEY_RESERVED,        /* 39 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */
 257        KEY_RESERVED,        /* 40 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */
 258        KEY_ZOOM,        /* 41 SONYPI_EVENT_ZOOM_PRESSED */
 259        BTN_THUMB,        /* 42 SONYPI_EVENT_THUMBPHRASE_PRESSED */
 260        KEY_RESERVED,        /* 43 SONYPI_EVENT_MEYE_FACE */
 261        KEY_RESERVED,        /* 44 SONYPI_EVENT_MEYE_OPPOSITE */
 262        KEY_RESERVED,        /* 45 SONYPI_EVENT_MEMORYSTICK_INSERT */
 263        KEY_RESERVED,        /* 46 SONYPI_EVENT_MEMORYSTICK_EJECT */
 264        KEY_WLAN,        /* 47 SONYPI_EVENT_WIRELESS_ON */
 265        KEY_WLAN,        /* 48 SONYPI_EVENT_WIRELESS_OFF */
 266        KEY_ZOOMIN,        /* 49 SONYPI_EVENT_ZOOM_IN_PRESSED */
 267        KEY_ZOOMOUT        /* 50 SONYPI_EVENT_ZOOM_OUT_PRESSED */
 268};
 269
 270/* release buttons after a short delay if pressed */
 271static void do_sony_laptop_release_key(struct work_struct *work)
 272{
 273        struct sony_laptop_keypress kp;
 274
 275        while (kfifo_get(sony_laptop_input.fifo, (unsigned char *)&kp,
 276                         sizeof(kp)) == sizeof(kp)) {
 277                msleep(10);
 278                input_report_key(kp.dev, kp.key, 0);
 279                input_sync(kp.dev);
 280        }
 281}
 282static DECLARE_WORK(sony_laptop_release_key_work,
 283                do_sony_laptop_release_key);
 284
 285/* forward event to the input subsystem */
 286static void sony_laptop_report_input_event(u8 event)
 287{
 288        struct input_dev *jog_dev = sony_laptop_input.jog_dev;
 289        struct input_dev *key_dev = sony_laptop_input.key_dev;
 290        struct sony_laptop_keypress kp = { NULL };
 291
 292        if (event == SONYPI_EVENT_FNKEY_RELEASED) {
 293                /* Nothing, not all VAIOs generate this event */
 294                return;
 295        }
 296
 297        /* report events */
 298        switch (event) {
 299        /* jog_dev events */
 300        case SONYPI_EVENT_JOGDIAL_UP:
 301        case SONYPI_EVENT_JOGDIAL_UP_PRESSED:
 302                input_report_rel(jog_dev, REL_WHEEL, 1);
 303                input_sync(jog_dev);
 304                return;
 305
 306        case SONYPI_EVENT_JOGDIAL_DOWN:
 307        case SONYPI_EVENT_JOGDIAL_DOWN_PRESSED:
 308                input_report_rel(jog_dev, REL_WHEEL, -1);
 309                input_sync(jog_dev);
 310                return;
 311
 312        /* key_dev events */
 313        case SONYPI_EVENT_JOGDIAL_PRESSED:
 314                kp.key = BTN_MIDDLE;
 315                kp.dev = jog_dev;
 316                break;
 317
 318        default:
 319                if (event >= ARRAY_SIZE(sony_laptop_input_index)) {
 320                        dprintk("sony_laptop_report_input_event, event not known: %d\n", event);
 321                        break;
 322                }
 323                if (sony_laptop_input_index[event] != -1) {
 324                        kp.key = sony_laptop_input_keycode_map[sony_laptop_input_index[event]];
 325                        if (kp.key != KEY_UNKNOWN)
 326                                kp.dev = key_dev;
 327                }
 328                break;
 329        }
 330
 331        if (kp.dev) {
 332                input_report_key(kp.dev, kp.key, 1);
 333                /* we emit the scancode so we can always remap the key */
 334                input_event(kp.dev, EV_MSC, MSC_SCAN, event);
 335                input_sync(kp.dev);
 336                kfifo_put(sony_laptop_input.fifo,
 337                          (unsigned char *)&kp, sizeof(kp));
 338
 339                if (!work_pending(&sony_laptop_release_key_work))
 340                        queue_work(sony_laptop_input.wq,
 341                                        &sony_laptop_release_key_work);
 342        } else
 343                dprintk("unknown input event %.2x\n", event);
 344}
 345
 346static int sony_laptop_setup_input(struct acpi_device *acpi_device)
 347{
 348        struct input_dev *jog_dev;
 349        struct input_dev *key_dev;
 350        int i;
 351        int error;
 352
 353        /* don't run again if already initialized */
 354        if (atomic_add_return(1, &sony_laptop_input.users) > 1)
 355                return 0;
 356
 357        /* kfifo */
 358        spin_lock_init(&sony_laptop_input.fifo_lock);
 359        sony_laptop_input.fifo =
 360                kfifo_alloc(SONY_LAPTOP_BUF_SIZE, GFP_KERNEL,
 361                            &sony_laptop_input.fifo_lock);
 362        if (IS_ERR(sony_laptop_input.fifo)) {
 363                printk(KERN_ERR DRV_PFX "kfifo_alloc failed\n");
 364                error = PTR_ERR(sony_laptop_input.fifo);
 365                goto err_dec_users;
 366        }
 367
 368        /* init workqueue */
 369        sony_laptop_input.wq = create_singlethread_workqueue("sony-laptop");
 370        if (!sony_laptop_input.wq) {
 371                printk(KERN_ERR DRV_PFX
 372                                "Unabe to create workqueue.\n");
 373                error = -ENXIO;
 374                goto err_free_kfifo;
 375        }
 376
 377        /* input keys */
 378        key_dev = input_allocate_device();
 379        if (!key_dev) {
 380                error = -ENOMEM;
 381                goto err_destroy_wq;
 382        }
 383
 384        key_dev->name = "Sony Vaio Keys";
 385        key_dev->id.bustype = BUS_ISA;
 386        key_dev->id.vendor = PCI_VENDOR_ID_SONY;
 387        key_dev->dev.parent = &acpi_device->dev;
 388
 389        /* Initialize the Input Drivers: special keys */
 390        set_bit(EV_KEY, key_dev->evbit);
 391        set_bit(EV_MSC, key_dev->evbit);
 392        set_bit(MSC_SCAN, key_dev->mscbit);
 393        key_dev->keycodesize = sizeof(sony_laptop_input_keycode_map[0]);
 394        key_dev->keycodemax = ARRAY_SIZE(sony_laptop_input_keycode_map);
 395        key_dev->keycode = &sony_laptop_input_keycode_map;
 396        for (i = 0; i < ARRAY_SIZE(sony_laptop_input_keycode_map); i++) {
 397                if (sony_laptop_input_keycode_map[i] != KEY_RESERVED) {
 398                        set_bit(sony_laptop_input_keycode_map[i],
 399                                key_dev->keybit);
 400                }
 401        }
 402
 403        error = input_register_device(key_dev);
 404        if (error)
 405                goto err_free_keydev;
 406
 407        sony_laptop_input.key_dev = key_dev;
 408
 409        /* jogdial */
 410        jog_dev = input_allocate_device();
 411        if (!jog_dev) {
 412                error = -ENOMEM;
 413                goto err_unregister_keydev;
 414        }
 415
 416        jog_dev->name = "Sony Vaio Jogdial";
 417        jog_dev->id.bustype = BUS_ISA;
 418        jog_dev->id.vendor = PCI_VENDOR_ID_SONY;
 419        key_dev->dev.parent = &acpi_device->dev;
 420
 421        jog_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
 422        jog_dev->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_MIDDLE);
 423        jog_dev->relbit[0] = BIT_MASK(REL_WHEEL);
 424
 425        error = input_register_device(jog_dev);
 426        if (error)
 427                goto err_free_jogdev;
 428
 429        sony_laptop_input.jog_dev = jog_dev;
 430
 431        return 0;
 432
 433err_free_jogdev:
 434        input_free_device(jog_dev);
 435
 436err_unregister_keydev:
 437        input_unregister_device(key_dev);
 438        /* to avoid kref underflow below at input_free_device */
 439        key_dev = NULL;
 440
 441err_free_keydev:
 442        input_free_device(key_dev);
 443
 444err_destroy_wq:
 445        destroy_workqueue(sony_laptop_input.wq);
 446
 447err_free_kfifo:
 448        kfifo_free(sony_laptop_input.fifo);
 449
 450err_dec_users:
 451        atomic_dec(&sony_laptop_input.users);
 452        return error;
 453}
 454
 455static void sony_laptop_remove_input(void)
 456{
 457        /* cleanup only after the last user has gone */
 458        if (!atomic_dec_and_test(&sony_laptop_input.users))
 459                return;
 460
 461        /* flush workqueue first */
 462        flush_workqueue(sony_laptop_input.wq);
 463
 464        /* destroy input devs */
 465        input_unregister_device(sony_laptop_input.key_dev);
 466        sony_laptop_input.key_dev = NULL;
 467
 468        if (sony_laptop_input.jog_dev) {
 469                input_unregister_device(sony_laptop_input.jog_dev);
 470                sony_laptop_input.jog_dev = NULL;
 471        }
 472
 473        destroy_workqueue(sony_laptop_input.wq);
 474        kfifo_free(sony_laptop_input.fifo);
 475}
 476
 477/*********** Platform Device ***********/
 478
 479static atomic_t sony_pf_users = ATOMIC_INIT(0);
 480static struct platform_driver sony_pf_driver = {
 481        .driver = {
 482                   .name = "sony-laptop",
 483                   .owner = THIS_MODULE,
 484                   }
 485};
 486static struct platform_device *sony_pf_device;
 487
 488static int sony_pf_add(void)
 489{
 490        int ret = 0;
 491
 492        /* don't run again if already initialized */
 493        if (atomic_add_return(1, &sony_pf_users) > 1)
 494                return 0;
 495
 496        ret = platform_driver_register(&sony_pf_driver);
 497        if (ret)
 498                goto out;
 499
 500        sony_pf_device = platform_device_alloc("sony-laptop", -1);
 501        if (!sony_pf_device) {
 502                ret = -ENOMEM;
 503                goto out_platform_registered;
 504        }
 505
 506        ret = platform_device_add(sony_pf_device);
 507        if (ret)
 508                goto out_platform_alloced;
 509
 510        return 0;
 511
 512      out_platform_alloced:
 513        platform_device_put(sony_pf_device);
 514        sony_pf_device = NULL;
 515      out_platform_registered:
 516        platform_driver_unregister(&sony_pf_driver);
 517      out:
 518        atomic_dec(&sony_pf_users);
 519        return ret;
 520}
 521
 522static void sony_pf_remove(void)
 523{
 524        /* deregister only after the last user has gone */
 525        if (!atomic_dec_and_test(&sony_pf_users))
 526                return;
 527
 528        platform_device_del(sony_pf_device);
 529        platform_device_put(sony_pf_device);
 530        platform_driver_unregister(&sony_pf_driver);
 531}
 532
 533/*********** SNC (SNY5001) Device ***********/
 534
 535/* the device uses 1-based values, while the backlight subsystem uses
 536   0-based values */
 537#define SONY_MAX_BRIGHTNESS        8
 538
 539#define SNC_VALIDATE_IN                0
 540#define SNC_VALIDATE_OUT        1
 541
 542static ssize_t sony_nc_sysfs_show(struct device *, struct device_attribute *,
 543                              char *);
 544static ssize_t sony_nc_sysfs_store(struct device *, struct device_attribute *,
 545                               const char *, size_t);
 546static int boolean_validate(const int, const int);
 547static int brightness_default_validate(const int, const int);
 548
 549struct sony_nc_value {
 550        char *name;                /* name of the entry */
 551        char **acpiget;                /* names of the ACPI get function */
 552        char **acpiset;                /* names of the ACPI set function */
 553        int (*validate)(const int, const int);        /* input/output validation */
 554        int value;                /* current setting */
 555        int valid;                /* Has ever been set */
 556        int debug;                /* active only in debug mode ? */
 557        struct device_attribute devattr;        /* sysfs atribute */
 558};
 559
 560#define SNC_HANDLE_NAMES(_name, _values...) \
 561        static char *snc_##_name[] = { _values, NULL }
 562
 563#define SNC_HANDLE(_name, _getters, _setters, _validate, _debug) \
 564        { \
 565                .name                = __stringify(_name), \
 566                .acpiget        = _getters, \
 567                .acpiset        = _setters, \
 568                .validate        = _validate, \
 569                .debug                = _debug, \
 570                .devattr        = __ATTR(_name, 0, sony_nc_sysfs_show, sony_nc_sysfs_store), \
 571        }
 572
 573#define SNC_HANDLE_NULL        { .name = NULL }
 574
 575SNC_HANDLE_NAMES(fnkey_get, "GHKE");
 576
 577SNC_HANDLE_NAMES(brightness_def_get, "GPBR");
 578SNC_HANDLE_NAMES(brightness_def_set, "SPBR");
 579
 580SNC_HANDLE_NAMES(cdpower_get, "GCDP");
 581SNC_HANDLE_NAMES(cdpower_set, "SCDP", "CDPW");
 582
 583SNC_HANDLE_NAMES(audiopower_get, "GAZP");
 584SNC_HANDLE_NAMES(audiopower_set, "AZPW");
 585
 586SNC_HANDLE_NAMES(lanpower_get, "GLNP");
 587SNC_HANDLE_NAMES(lanpower_set, "LNPW");
 588
 589SNC_HANDLE_NAMES(lidstate_get, "GLID");
 590
 591SNC_HANDLE_NAMES(indicatorlamp_get, "GILS");
 592SNC_HANDLE_NAMES(indicatorlamp_set, "SILS");
 593
 594SNC_HANDLE_NAMES(gainbass_get, "GMGB");
 595SNC_HANDLE_NAMES(gainbass_set, "CMGB");
 596
 597SNC_HANDLE_NAMES(PID_get, "GPID");
 598
 599SNC_HANDLE_NAMES(CTR_get, "GCTR");
 600SNC_HANDLE_NAMES(CTR_set, "SCTR");
 601
 602SNC_HANDLE_NAMES(PCR_get, "GPCR");
 603SNC_HANDLE_NAMES(PCR_set, "SPCR");
 604
 605SNC_HANDLE_NAMES(CMI_get, "GCMI");
 606SNC_HANDLE_NAMES(CMI_set, "SCMI");
 607
 608static struct sony_nc_value sony_nc_values[] = {
 609        SNC_HANDLE(brightness_default, snc_brightness_def_get,
 610                        snc_brightness_def_set, brightness_default_validate, 0),
 611        SNC_HANDLE(fnkey, snc_fnkey_get, NULL, NULL, 0),
 612        SNC_HANDLE(cdpower, snc_cdpower_get, snc_cdpower_set, boolean_validate, 0),
 613        SNC_HANDLE(audiopower, snc_audiopower_get, snc_audiopower_set,
 614                        boolean_validate, 0),
 615        SNC_HANDLE(lanpower, snc_lanpower_get, snc_lanpower_set,
 616                        boolean_validate, 1),
 617        SNC_HANDLE(lidstate, snc_lidstate_get, NULL,
 618                        boolean_validate, 0),
 619        SNC_HANDLE(indicatorlamp, snc_indicatorlamp_get, snc_indicatorlamp_set,
 620                        boolean_validate, 0),
 621        SNC_HANDLE(gainbass, snc_gainbass_get, snc_gainbass_set,
 622                        boolean_validate, 0),
 623        /* unknown methods */
 624        SNC_HANDLE(PID, snc_PID_get, NULL, NULL, 1),
 625        SNC_HANDLE(CTR, snc_CTR_get, snc_CTR_set, NULL, 1),
 626        SNC_HANDLE(PCR, snc_PCR_get, snc_PCR_set, NULL, 1),
 627        SNC_HANDLE(CMI, snc_CMI_get, snc_CMI_set, NULL, 1),
 628        SNC_HANDLE_NULL
 629};
 630
 631static acpi_handle sony_nc_acpi_handle;
 632static struct acpi_device *sony_nc_acpi_device = NULL;
 633
 634/*
 635 * acpi_evaluate_object wrappers
 636 */
 637static int acpi_callgetfunc(acpi_handle handle, char *name, int *result)
 638{
 639        struct acpi_buffer output;
 640        union acpi_object out_obj;
 641        acpi_status status;
 642
 643        output.length = sizeof(out_obj);
 644        output.pointer = &out_obj;
 645
 646        status = acpi_evaluate_object(handle, name, NULL, &output);
 647        if ((status == AE_OK) && (out_obj.type == ACPI_TYPE_INTEGER)) {
 648                *result = out_obj.integer.value;
 649                return 0;
 650        }
 651
 652        printk(KERN_WARNING DRV_PFX "acpi_callreadfunc failed\n");
 653
 654        return -1;
 655}
 656
 657static int acpi_callsetfunc(acpi_handle handle, char *name, int value,
 658                            int *result)
 659{
 660        struct acpi_object_list params;
 661        union acpi_object in_obj;
 662        struct acpi_buffer output;
 663        union acpi_object out_obj;
 664        acpi_status status;
 665
 666        params.count = 1;
 667        params.pointer = &in_obj;
 668        in_obj.type = ACPI_TYPE_INTEGER;
 669        in_obj.integer.value = value;
 670
 671        output.length = sizeof(out_obj);
 672        output.pointer = &out_obj;
 673
 674        status = acpi_evaluate_object(handle, name, &params, &output);
 675        if (status == AE_OK) {
 676                if (result != NULL) {
 677                        if (out_obj.type != ACPI_TYPE_INTEGER) {
 678                                printk(KERN_WARNING DRV_PFX "acpi_evaluate_object bad "
 679                                       "return type\n");
 680                                return -1;
 681                        }
 682                        *result = out_obj.integer.value;
 683                }
 684                return 0;
 685        }
 686
 687        printk(KERN_WARNING DRV_PFX "acpi_evaluate_object failed\n");
 688
 689        return -1;
 690}
 691
 692/*
 693 * sony_nc_values input/output validate functions
 694 */
 695
 696/* brightness_default_validate:
 697 *
 698 * manipulate input output values to keep consistency with the
 699 * backlight framework for which brightness values are 0-based.
 700 */
 701static int brightness_default_validate(const int direction, const int value)
 702{
 703        switch (direction) {
 704                case SNC_VALIDATE_OUT:
 705                        return value - 1;
 706                case SNC_VALIDATE_IN:
 707                        if (value >= 0 && value < SONY_MAX_BRIGHTNESS)
 708                                return value + 1;
 709        }
 710        return -EINVAL;
 711}
 712
 713/* boolean_validate:
 714 *
 715 * on input validate boolean values 0/1, on output just pass the
 716 * received value.
 717 */
 718static int boolean_validate(const int direction, const int value)
 719{
 720        if (direction == SNC_VALIDATE_IN) {
 721                if (value != 0 && value != 1)
 722                        return -EINVAL;
 723        }
 724        return value;
 725}
 726
 727/*
 728 * Sysfs show/store common to all sony_nc_values
 729 */
 730static ssize_t sony_nc_sysfs_show(struct device *dev, struct device_attribute *attr,
 731                              char *buffer)
 732{
 733        int value;
 734        struct sony_nc_value *item =
 735            container_of(attr, struct sony_nc_value, devattr);
 736
 737        if (!*item->acpiget)
 738                return -EIO;
 739
 740        if (acpi_callgetfunc(sony_nc_acpi_handle, *item->acpiget, &value) < 0)
 741                return -EIO;
 742
 743        if (item->validate)
 744                value = item->validate(SNC_VALIDATE_OUT, value);
 745
 746        return snprintf(buffer, PAGE_SIZE, "%d\n", value);
 747}
 748
 749static ssize_t sony_nc_sysfs_store(struct device *dev,
 750                               struct device_attribute *attr,
 751                               const char *buffer, size_t count)
 752{
 753        int value;
 754        struct sony_nc_value *item =
 755            container_of(attr, struct sony_nc_value, devattr);
 756
 757        if (!item->acpiset)
 758                return -EIO;
 759
 760        if (count > 31)
 761                return -EINVAL;
 762
 763        value = simple_strtoul(buffer, NULL, 10);
 764
 765        if (item->validate)
 766                value = item->validate(SNC_VALIDATE_IN, value);
 767
 768        if (value < 0)
 769                return value;
 770
 771        if (acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset, value, NULL) < 0)
 772                return -EIO;
 773        item->value = value;
 774        item->valid = 1;
 775        return count;
 776}
 777
 778
 779/*
 780 * Backlight device
 781 */
 782static int sony_backlight_update_status(struct backlight_device *bd)
 783{
 784        return acpi_callsetfunc(sony_nc_acpi_handle, "SBRT",
 785                                bd->props.brightness + 1, NULL);
 786}
 787
 788static int sony_backlight_get_brightness(struct backlight_device *bd)
 789{
 790        int value;
 791
 792        if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value))
 793                return 0;
 794        /* brightness levels are 1-based, while backlight ones are 0-based */
 795        return value - 1;
 796}
 797
 798static struct backlight_device *sony_backlight_device;
 799static struct backlight_ops sony_backlight_ops = {
 800        .update_status = sony_backlight_update_status,
 801        .get_brightness = sony_backlight_get_brightness,
 802};
 803
 804/*
 805 * New SNC-only Vaios event mapping to driver known keys
 806 */
 807struct sony_nc_event {
 808        u8        data;
 809        u8        event;
 810};
 811
 812static struct sony_nc_event *sony_nc_events;
 813
 814/* Vaio C* --maybe also FE*, N* and AR* ?-- special init sequence
 815 * for Fn keys
 816 */
 817static int sony_nc_C_enable(const struct dmi_system_id *id)
 818{
 819        int result = 0;
 820
 821        printk(KERN_NOTICE DRV_PFX "detected %s\n", id->ident);
 822
 823        sony_nc_events = id->driver_data;
 824
 825        if (acpi_callsetfunc(sony_nc_acpi_handle, "SN02", 0x4, &result) < 0
 826                        || acpi_callsetfunc(sony_nc_acpi_handle, "SN07", 0x2, &result) < 0
 827                        || acpi_callsetfunc(sony_nc_acpi_handle, "SN02", 0x10, &result) < 0
 828                        || acpi_callsetfunc(sony_nc_acpi_handle, "SN07", 0x0, &result) < 0
 829                        || acpi_callsetfunc(sony_nc_acpi_handle, "SN03", 0x2, &result) < 0
 830                        || acpi_callsetfunc(sony_nc_acpi_handle, "SN07", 0x101, &result) < 0) {
 831                printk(KERN_WARNING DRV_PFX "failed to initialize SNC, some "
 832                                "functionalities may be missing\n");
 833                return 1;
 834        }
 835        return 0;
 836}
 837
 838static struct sony_nc_event sony_C_events[] = {
 839        { 0x81, SONYPI_EVENT_FNKEY_F1 },
 840        { 0x01, SONYPI_EVENT_FNKEY_RELEASED },
 841        { 0x85, SONYPI_EVENT_FNKEY_F5 },
 842        { 0x05, SONYPI_EVENT_FNKEY_RELEASED },
 843        { 0x86, SONYPI_EVENT_FNKEY_F6 },
 844        { 0x06, SONYPI_EVENT_FNKEY_RELEASED },
 845        { 0x87, SONYPI_EVENT_FNKEY_F7 },
 846        { 0x07, SONYPI_EVENT_FNKEY_RELEASED },
 847        { 0x8A, SONYPI_EVENT_FNKEY_F10 },
 848        { 0x0A, SONYPI_EVENT_FNKEY_RELEASED },
 849        { 0x8C, SONYPI_EVENT_FNKEY_F12 },
 850        { 0x0C, SONYPI_EVENT_FNKEY_RELEASED },
 851        { 0, 0 },
 852};
 853
 854/* SNC-only model map */
 855static const struct dmi_system_id sony_nc_ids[] = {
 856                {
 857                        .ident = "Sony Vaio FE Series",
 858                        .callback = sony_nc_C_enable,
 859                        .driver_data = sony_C_events,
 860                        .matches = {
 861                                DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
 862                                DMI_MATCH(DMI_PRODUCT_NAME, "VGN-FE"),
 863                        },
 864                },
 865                {
 866                        .ident = "Sony Vaio FZ Series",
 867                        .callback = sony_nc_C_enable,
 868                        .driver_data = sony_C_events,
 869                        .matches = {
 870                                DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
 871                                DMI_MATCH(DMI_PRODUCT_NAME, "VGN-FZ"),
 872                        },
 873                },
 874                {
 875                        .ident = "Sony Vaio C Series",
 876                        .callback = sony_nc_C_enable,
 877                        .driver_data = sony_C_events,
 878                        .matches = {
 879                                DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
 880                                DMI_MATCH(DMI_PRODUCT_NAME, "VGN-C"),
 881                        },
 882                },
 883                {
 884                        .ident = "Sony Vaio N Series",
 885                        .callback = sony_nc_C_enable,
 886                        .driver_data = sony_C_events,
 887                        .matches = {
 888                                DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
 889                                DMI_MATCH(DMI_PRODUCT_NAME, "VGN-N"),
 890                        },
 891                },
 892                { }
 893};
 894
 895/*
 896 * ACPI callbacks
 897 */
 898static void sony_acpi_notify(acpi_handle handle, u32 event, void *data)
 899{
 900        struct sony_nc_event *evmap;
 901        u32 ev = event;
 902        int result;
 903
 904        if (ev == 0x92) {
 905                /* read the key pressed from EC.GECR
 906                 * A call to SN07 with 0x0202 will do it as well respecting
 907                 * the current protocol on different OSes
 908                 *
 909                 * Note: the path for GECR may be
 910                 *   \_SB.PCI0.LPCB.EC (C, FE, AR, N and friends)
 911                 *   \_SB.PCI0.PIB.EC0 (VGN-FR notifications are sent directly, no GECR)
 912                 *
 913                 * TODO: we may want to do the same for the older GHKE -need
 914                 *       dmi list- so this snippet may become one more callback.
 915                 */
 916                if (acpi_callsetfunc(handle, "SN07", 0x0202, &result) < 0)
 917                        dprintk("sony_acpi_notify, unable to decode event 0x%.2x\n", ev);
 918                else
 919                        ev = result & 0xFF;
 920        }
 921
 922        if (sony_nc_events)
 923                for (evmap = sony_nc_events; evmap->event; evmap++) {
 924                        if (evmap->data == ev) {
 925                                ev = evmap->event;
 926                                break;
 927                        }
 928                }
 929
 930        dprintk("sony_acpi_notify, event: 0x%.2x\n", ev);
 931        sony_laptop_report_input_event(ev);
 932        acpi_bus_generate_proc_event(sony_nc_acpi_device, 1, ev);
 933}
 934
 935static acpi_status sony_walk_callback(acpi_handle handle, u32 level,
 936                                      void *context, void **return_value)
 937{
 938        struct acpi_namespace_node *node;
 939        union acpi_operand_object *operand;
 940
 941        node = (struct acpi_namespace_node *)handle;
 942        operand = (union acpi_operand_object *)node->object;
 943
 944        printk(KERN_WARNING DRV_PFX "method: name: %4.4s, args %X\n", node->name.ascii,
 945               (u32) operand->method.param_count);
 946
 947        return AE_OK;
 948}
 949
 950/*
 951 * ACPI device
 952 */
 953static int sony_nc_resume(struct acpi_device *device)
 954{
 955        struct sony_nc_value *item;
 956
 957        for (item = sony_nc_values; item->name; item++) {
 958                int ret;
 959
 960                if (!item->valid)
 961                        continue;
 962                ret = acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset,
 963                                       item->value, NULL);
 964                if (ret < 0) {
 965                        printk("%s: %d\n", __func__, ret);
 966                        break;
 967                }
 968        }
 969
 970        /* set the last requested brightness level */
 971        if (sony_backlight_device &&
 972                        !sony_backlight_update_status(sony_backlight_device))
 973                printk(KERN_WARNING DRV_PFX "unable to restore brightness level\n");
 974
 975        /* re-initialize models with specific requirements */
 976        dmi_check_system(sony_nc_ids);
 977
 978        return 0;
 979}
 980
 981static int sony_nc_add(struct acpi_device *device)
 982{
 983        acpi_status status;
 984        int result = 0;
 985        acpi_handle handle;
 986        struct sony_nc_value *item;
 987
 988        printk(KERN_INFO DRV_PFX "%s v%s.\n",
 989                SONY_NC_DRIVER_NAME, SONY_LAPTOP_DRIVER_VERSION);
 990
 991        sony_nc_acpi_device = device;
 992        strcpy(acpi_device_class(device), "sony/hotkey");
 993
 994        sony_nc_acpi_handle = device->handle;
 995
 996        /* read device status */
 997        result = acpi_bus_get_status(device);
 998        /* bail IFF the above call was successful and the device is not present */
 999        if (!result && !device->status.present) {
1000                dprintk("Device not present\n");
1001                result = -ENODEV;
1002                goto outwalk;
1003        }
1004
1005        if (debug) {
1006                status = acpi_walk_namespace(ACPI_TYPE_METHOD, sony_nc_acpi_handle,
1007                                             1, sony_walk_callback, NULL, NULL);
1008                if (ACPI_FAILURE(status)) {
1009                        printk(KERN_WARNING DRV_PFX "unable to walk acpi resources\n");
1010                        result = -ENODEV;
1011                        goto outwalk;
1012                }
1013        }
1014
1015        /* try to _INI the device if such method exists (ACPI spec 3.0-6.5.1
1016         * should be respected as we already checked for the device presence above */
1017        if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, METHOD_NAME__INI, &handle))) {
1018                dprintk("Invoking _INI\n");
1019                if (ACPI_FAILURE(acpi_evaluate_object(sony_nc_acpi_handle, METHOD_NAME__INI,
1020                                                NULL, NULL)))
1021                        dprintk("_INI Method failed\n");
1022        }
1023
1024        /* setup input devices and helper fifo */
1025        result = sony_laptop_setup_input(device);
1026        if (result) {
1027                printk(KERN_ERR DRV_PFX
1028                                "Unabe to create input devices.\n");
1029                goto outwalk;
1030        }
1031
1032        status = acpi_install_notify_handler(sony_nc_acpi_handle,
1033                                             ACPI_DEVICE_NOTIFY,
1034                                             sony_acpi_notify, NULL);
1035        if (ACPI_FAILURE(status)) {
1036                printk(KERN_WARNING DRV_PFX "unable to install notify handler (%u)\n", status);
1037                result = -ENODEV;
1038                goto outinput;
1039        }
1040
1041        if (acpi_video_backlight_support()) {
1042                printk(KERN_INFO DRV_PFX "brightness ignored, must be "
1043                       "controlled by ACPI video driver\n");
1044        } else if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "GBRT",
1045                                                &handle))) {
1046                sony_backlight_device = backlight_device_register("sony", NULL,
1047                                                                  NULL,
1048                                                                  &sony_backlight_ops);
1049
1050                if (IS_ERR(sony_backlight_device)) {
1051                        printk(KERN_WARNING DRV_PFX "unable to register backlight device\n");
1052                        sony_backlight_device = NULL;
1053                } else {
1054                        sony_backlight_device->props.brightness =
1055                            sony_backlight_get_brightness
1056                            (sony_backlight_device);
1057                        sony_backlight_device->props.max_brightness =
1058                            SONY_MAX_BRIGHTNESS - 1;
1059                }
1060
1061        }
1062
1063        /* initialize models with specific requirements */
1064        dmi_check_system(sony_nc_ids);
1065
1066        result = sony_pf_add();
1067        if (result)
1068                goto outbacklight;
1069
1070        /* create sony_pf sysfs attributes related to the SNC device */
1071        for (item = sony_nc_values; item->name; ++item) {
1072
1073                if (!debug && item->debug)
1074                        continue;
1075
1076                /* find the available acpiget as described in the DSDT */
1077                for (; item->acpiget && *item->acpiget; ++item->acpiget) {
1078                        if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle,
1079                                                         *item->acpiget,
1080                                                         &handle))) {
1081                                dprintk("Found %s getter: %s\n",
1082                                                item->name, *item->acpiget);
1083                                item->devattr.attr.mode |= S_IRUGO;
1084                                break;
1085                        }
1086                }
1087
1088                /* find the available acpiset as described in the DSDT */
1089                for (; item->acpiset && *item->acpiset; ++item->acpiset) {
1090                        if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle,
1091                                                         *item->acpiset,
1092                                                         &handle))) {
1093                                dprintk("Found %s setter: %s\n",
1094                                                item->name, *item->acpiset);
1095                                item->devattr.attr.mode |= S_IWUSR;
1096                                break;
1097                        }
1098                }
1099
1100                if (item->devattr.attr.mode != 0) {
1101                        result =
1102                            device_create_file(&sony_pf_device->dev,
1103                                               &item->devattr);
1104                        if (result)
1105                                goto out_sysfs;
1106                }
1107        }
1108
1109        return 0;
1110
1111      out_sysfs:
1112        for (item = sony_nc_values; item->name; ++item) {
1113                device_remove_file(&sony_pf_device->dev, &item->devattr);
1114        }
1115        sony_pf_remove();
1116
1117      outbacklight:
1118        if (sony_backlight_device)
1119                backlight_device_unregister(sony_backlight_device);
1120
1121        status = acpi_remove_notify_handler(sony_nc_acpi_handle,
1122                                            ACPI_DEVICE_NOTIFY,
1123                                            sony_acpi_notify);
1124        if (ACPI_FAILURE(status))
1125                printk(KERN_WARNING DRV_PFX "unable to remove notify handler\n");
1126
1127      outinput:
1128        sony_laptop_remove_input();
1129
1130      outwalk:
1131        return result;
1132}
1133
1134static int sony_nc_remove(struct acpi_device *device, int type)
1135{
1136        acpi_status status;
1137        struct sony_nc_value *item;
1138
1139        if (sony_backlight_device)
1140                backlight_device_unregister(sony_backlight_device);
1141
1142        sony_nc_acpi_device = NULL;
1143
1144        status = acpi_remove_notify_handler(sony_nc_acpi_handle,
1145                                            ACPI_DEVICE_NOTIFY,
1146                                            sony_acpi_notify);
1147        if (ACPI_FAILURE(status))
1148                printk(KERN_WARNING DRV_PFX "unable to remove notify handler\n");
1149
1150        for (item = sony_nc_values; item->name; ++item) {
1151                device_remove_file(&sony_pf_device->dev, &item->devattr);
1152        }
1153
1154        sony_pf_remove();
1155        sony_laptop_remove_input();
1156        dprintk(SONY_NC_DRIVER_NAME " removed.\n");
1157
1158        return 0;
1159}
1160
1161static const struct acpi_device_id sony_device_ids[] = {
1162        {SONY_NC_HID, 0},
1163        {SONY_PIC_HID, 0},
1164        {"", 0},
1165};
1166MODULE_DEVICE_TABLE(acpi, sony_device_ids);
1167
1168static const struct acpi_device_id sony_nc_device_ids[] = {
1169        {SONY_NC_HID, 0},
1170        {"", 0},
1171};
1172
1173static struct acpi_driver sony_nc_driver = {
1174        .name = SONY_NC_DRIVER_NAME,
1175        .class = SONY_NC_CLASS,
1176        .ids = sony_nc_device_ids,
1177        .owner = THIS_MODULE,
1178        .ops = {
1179                .add = sony_nc_add,
1180                .remove = sony_nc_remove,
1181                .resume = sony_nc_resume,
1182                },
1183};
1184
1185/*********** SPIC (SNY6001) Device ***********/
1186
1187#define SONYPI_DEVICE_TYPE1        0x00000001
1188#define SONYPI_DEVICE_TYPE2        0x00000002
1189#define SONYPI_DEVICE_TYPE3        0x00000004
1190#define SONYPI_DEVICE_TYPE4        0x00000008
1191
1192#define SONYPI_TYPE1_OFFSET        0x04
1193#define SONYPI_TYPE2_OFFSET        0x12
1194#define SONYPI_TYPE3_OFFSET        0x12
1195#define SONYPI_TYPE4_OFFSET        0x12
1196
1197struct sony_pic_ioport {
1198        struct acpi_resource_io        io1;
1199        struct acpi_resource_io        io2;
1200        struct list_head        list;
1201};
1202
1203struct sony_pic_irq {
1204        struct acpi_resource_irq        irq;
1205        struct list_head                list;
1206};
1207
1208struct sonypi_eventtypes {
1209        u8                        data;
1210        unsigned long                mask;
1211        struct sonypi_event        *events;
1212};
1213
1214struct device_ctrl {
1215        int                                model;
1216        int                                (*handle_irq)(const u8, const u8);
1217        u16                                evport_offset;
1218        u8                                has_camera;
1219        u8                                has_bluetooth;
1220        u8                                has_wwan;
1221        struct sonypi_eventtypes        *event_types;
1222};
1223
1224struct sony_pic_dev {
1225        struct device_ctrl        *control;
1226        struct acpi_device        *acpi_dev;
1227        struct sony_pic_irq        *cur_irq;
1228        struct sony_pic_ioport        *cur_ioport;
1229        struct list_head        interrupts;
1230        struct list_head        ioports;
1231        struct mutex                lock;
1232        u8                        camera_power;
1233        u8                        bluetooth_power;
1234        u8                        wwan_power;
1235};
1236
1237static struct sony_pic_dev spic_dev = {
1238        .interrupts        = LIST_HEAD_INIT(spic_dev.interrupts),
1239        .ioports        = LIST_HEAD_INIT(spic_dev.ioports),
1240};
1241
1242/* Event masks */
1243#define SONYPI_JOGGER_MASK                        0x00000001
1244#define SONYPI_CAPTURE_MASK                        0x00000002
1245#define SONYPI_FNKEY_MASK                        0x00000004
1246#define SONYPI_BLUETOOTH_MASK                        0x00000008
1247#define SONYPI_PKEY_MASK                        0x00000010
1248#define SONYPI_BACK_MASK                        0x00000020
1249#define SONYPI_HELP_MASK                        0x00000040
1250#define SONYPI_LID_MASK                                0x00000080
1251#define SONYPI_ZOOM_MASK                        0x00000100
1252#define SONYPI_THUMBPHRASE_MASK                        0x00000200
1253#define SONYPI_MEYE_MASK                        0x00000400
1254#define SONYPI_MEMORYSTICK_MASK                        0x00000800
1255#define SONYPI_BATTERY_MASK                        0x00001000
1256#define SONYPI_WIRELESS_MASK                        0x00002000
1257
1258struct sonypi_event {
1259        u8        data;
1260        u8        event;
1261};
1262
1263/* The set of possible button release events */
1264static struct sonypi_event sonypi_releaseev[] = {
1265        { 0x00, SONYPI_EVENT_ANYBUTTON_RELEASED },
1266        { 0, 0 }
1267};
1268
1269/* The set of possible jogger events  */
1270static struct sonypi_event sonypi_joggerev[] = {
1271        { 0x1f, SONYPI_EVENT_JOGDIAL_UP },
1272        { 0x01, SONYPI_EVENT_JOGDIAL_DOWN },
1273        { 0x5f, SONYPI_EVENT_JOGDIAL_UP_PRESSED },
1274        { 0x41, SONYPI_EVENT_JOGDIAL_DOWN_PRESSED },
1275        { 0x1e, SONYPI_EVENT_JOGDIAL_FAST_UP },
1276        { 0x02, SONYPI_EVENT_JOGDIAL_FAST_DOWN },
1277        { 0x5e, SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED },
1278        { 0x42, SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED },
1279        { 0x1d, SONYPI_EVENT_JOGDIAL_VFAST_UP },
1280        { 0x03, SONYPI_EVENT_JOGDIAL_VFAST_DOWN },
1281        { 0x5d, SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED },
1282        { 0x43, SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED },
1283        { 0x40, SONYPI_EVENT_JOGDIAL_PRESSED },
1284        { 0, 0 }
1285};
1286
1287/* The set of possible capture button events */
1288static struct sonypi_event sonypi_captureev[] = {
1289        { 0x05, SONYPI_EVENT_CAPTURE_PARTIALPRESSED },
1290        { 0x07, SONYPI_EVENT_CAPTURE_PRESSED },
1291        { 0x40, SONYPI_EVENT_CAPTURE_PRESSED },
1292        { 0x01, SONYPI_EVENT_CAPTURE_PARTIALRELEASED },
1293        { 0, 0 }
1294};
1295
1296/* The set of possible fnkeys events */
1297static struct sonypi_event sonypi_fnkeyev[] = {
1298        { 0x10, SONYPI_EVENT_FNKEY_ESC },
1299        { 0x11, SONYPI_EVENT_FNKEY_F1 },
1300        { 0x12, SONYPI_EVENT_FNKEY_F2 },
1301        { 0x13, SONYPI_EVENT_FNKEY_F3 },
1302        { 0x14, SONYPI_EVENT_FNKEY_F4 },
1303        { 0x15, SONYPI_EVENT_FNKEY_F5 },
1304        { 0x16, SONYPI_EVENT_FNKEY_F6 },
1305        { 0x17, SONYPI_EVENT_FNKEY_F7 },
1306        { 0x18, SONYPI_EVENT_FNKEY_F8 },
1307        { 0x19, SONYPI_EVENT_FNKEY_F9 },
1308        { 0x1a, SONYPI_EVENT_FNKEY_F10 },
1309        { 0x1b, SONYPI_EVENT_FNKEY_F11 },
1310        { 0x1c, SONYPI_EVENT_FNKEY_F12 },
1311        { 0x1f, SONYPI_EVENT_FNKEY_RELEASED },
1312        { 0x21, SONYPI_EVENT_FNKEY_1 },
1313        { 0x22, SONYPI_EVENT_FNKEY_2 },
1314        { 0x31, SONYPI_EVENT_FNKEY_D },
1315        { 0x32, SONYPI_EVENT_FNKEY_E },
1316        { 0x33, SONYPI_EVENT_FNKEY_F },
1317        { 0x34, SONYPI_EVENT_FNKEY_S },
1318        { 0x35, SONYPI_EVENT_FNKEY_B },
1319        { 0x36, SONYPI_EVENT_FNKEY_ONLY },
1320        { 0, 0 }
1321};
1322
1323/* The set of possible program key events */
1324static struct sonypi_event sonypi_pkeyev[] = {
1325        { 0x01, SONYPI_EVENT_PKEY_P1 },
1326        { 0x02, SONYPI_EVENT_PKEY_P2 },
1327        { 0x04, SONYPI_EVENT_PKEY_P3 },
1328        { 0, 0 }
1329};
1330
1331/* The set of possible bluetooth events */
1332static struct sonypi_event sonypi_blueev[] = {
1333        { 0x55, SONYPI_EVENT_BLUETOOTH_PRESSED },
1334        { 0x59, SONYPI_EVENT_BLUETOOTH_ON },
1335        { 0x5a, SONYPI_EVENT_BLUETOOTH_OFF },
1336        { 0, 0 }
1337};
1338
1339/* The set of possible wireless events */
1340static struct sonypi_event sonypi_wlessev[] = {
1341        { 0x59, SONYPI_EVENT_WIRELESS_ON },
1342        { 0x5a, SONYPI_EVENT_WIRELESS_OFF },
1343        { 0, 0 }
1344};
1345
1346/* The set of possible back button events */
1347static struct sonypi_event sonypi_backev[] = {
1348        { 0x20, SONYPI_EVENT_BACK_PRESSED },
1349        { 0, 0 }
1350};
1351
1352/* The set of possible help button events */
1353static struct sonypi_event sonypi_helpev[] = {
1354        { 0x3b, SONYPI_EVENT_HELP_PRESSED },
1355        { 0, 0 }
1356};
1357
1358
1359/* The set of possible lid events */
1360static struct sonypi_event sonypi_lidev[] = {
1361        { 0x51, SONYPI_EVENT_LID_CLOSED },
1362        { 0x50, SONYPI_EVENT_LID_OPENED },
1363        { 0, 0 }
1364};
1365
1366/* The set of possible zoom events */
1367static struct sonypi_event sonypi_zoomev[] = {
1368        { 0x39, SONYPI_EVENT_ZOOM_PRESSED },
1369        { 0x10, SONYPI_EVENT_ZOOM_IN_PRESSED },
1370        { 0x20, SONYPI_EVENT_ZOOM_OUT_PRESSED },
1371        { 0, 0 }
1372};
1373
1374/* The set of possible thumbphrase events */
1375static struct sonypi_event sonypi_thumbphraseev[] = {
1376        { 0x3a, SONYPI_EVENT_THUMBPHRASE_PRESSED },
1377        { 0, 0 }
1378};
1379
1380/* The set of possible motioneye camera events */
1381static struct sonypi_event sonypi_meyeev[] = {
1382        { 0x00, SONYPI_EVENT_MEYE_FACE },
1383        { 0x01, SONYPI_EVENT_MEYE_OPPOSITE },
1384        { 0, 0 }
1385};
1386
1387/* The set of possible memorystick events */
1388static struct sonypi_event sonypi_memorystickev[] = {
1389        { 0x53, SONYPI_EVENT_MEMORYSTICK_INSERT },
1390        { 0x54, SONYPI_EVENT_MEMORYSTICK_EJECT },
1391        { 0, 0 }
1392};
1393
1394/* The set of possible battery events */
1395static struct sonypi_event sonypi_batteryev[] = {
1396        { 0x20, SONYPI_EVENT_BATTERY_INSERT },
1397        { 0x30, SONYPI_EVENT_BATTERY_REMOVE },
1398        { 0, 0 }
1399};
1400
1401static struct sonypi_eventtypes type1_events[] = {
1402        { 0, 0xffffffff, sonypi_releaseev },
1403        { 0x70, SONYPI_MEYE_MASK, sonypi_meyeev },
1404        { 0x30, SONYPI_LID_MASK, sonypi_lidev },
1405        { 0x60, SONYPI_CAPTURE_MASK, sonypi_captureev },
1406        { 0x10, SONYPI_JOGGER_MASK, sonypi_joggerev },
1407        { 0x20, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
1408        { 0x30, SONYPI_BLUETOOTH_MASK, sonypi_blueev },
1409        { 0x40, SONYPI_PKEY_MASK, sonypi_pkeyev },
1410        { 0x30, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
1411        { 0x40, SONYPI_BATTERY_MASK, sonypi_batteryev },
1412        { 0 },
1413};
1414static struct sonypi_eventtypes type2_events[] = {
1415        { 0, 0xffffffff, sonypi_releaseev },
1416        { 0x38, SONYPI_LID_MASK, sonypi_lidev },
1417        { 0x11, SONYPI_JOGGER_MASK, sonypi_joggerev },
1418        { 0x61, SONYPI_CAPTURE_MASK, sonypi_captureev },
1419        { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
1420        { 0x31, SONYPI_BLUETOOTH_MASK, sonypi_blueev },
1421        { 0x08, SONYPI_PKEY_MASK, sonypi_pkeyev },
1422        { 0x11, SONYPI_BACK_MASK, sonypi_backev },
1423        { 0x21, SONYPI_HELP_MASK, sonypi_helpev },
1424        { 0x21, SONYPI_ZOOM_MASK, sonypi_zoomev },
1425        { 0x20, SONYPI_THUMBPHRASE_MASK, sonypi_thumbphraseev },
1426        { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
1427        { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
1428        { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev },
1429        { 0 },
1430};
1431static struct sonypi_eventtypes type3_events[] = {
1432        { 0, 0xffffffff, sonypi_releaseev },
1433        { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
1434        { 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev },
1435        { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
1436        { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
1437        { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev },
1438        { 0 },
1439};
1440static struct sonypi_eventtypes type4_events[] = {
1441        { 0, 0xffffffff, sonypi_releaseev },
1442        { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
1443        { 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev },
1444        { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
1445        { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
1446        { 0x05, SONYPI_PKEY_MASK, sonypi_pkeyev },
1447        { 0x05, SONYPI_ZOOM_MASK, sonypi_zoomev },
1448        { 0x05, SONYPI_CAPTURE_MASK, sonypi_captureev },
1449        { 0 },
1450};
1451
1452/* low level spic calls */
1453#define ITERATIONS_LONG                10000
1454#define ITERATIONS_SHORT        10
1455#define wait_on_command(command, iterations) {                                \
1456        unsigned int n = iterations;                                        \
1457        while (--n && (command))                                        \
1458                udelay(1);                                                \
1459        if (!n)                                                                \
1460                dprintk("command failed at %s : %s (line %d)\n",        \
1461                                __FILE__, __func__, __LINE__);        \
1462}
1463
1464static u8 sony_pic_call1(u8 dev)
1465{
1466        u8 v1, v2;
1467
1468        wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
1469                        ITERATIONS_LONG);
1470        outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
1471        v1 = inb_p(spic_dev.cur_ioport->io1.minimum + 4);
1472        v2 = inb_p(spic_dev.cur_ioport->io1.minimum);
1473        dprintk("sony_pic_call1(0x%.2x): 0x%.4x\n", dev, (v2 << 8) | v1);
1474        return v2;
1475}
1476
1477static u8 sony_pic_call2(u8 dev, u8 fn)
1478{
1479        u8 v1;
1480
1481        wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
1482                        ITERATIONS_LONG);
1483        outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
1484        wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
1485                        ITERATIONS_LONG);
1486        outb(fn, spic_dev.cur_ioport->io1.minimum);
1487        v1 = inb_p(spic_dev.cur_ioport->io1.minimum);
1488        dprintk("sony_pic_call2(0x%.2x - 0x%.2x): 0x%.4x\n", dev, fn, v1);
1489        return v1;
1490}
1491
1492static u8 sony_pic_call3(u8 dev, u8 fn, u8 v)
1493{
1494        u8 v1;
1495
1496        wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
1497        outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
1498        wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
1499        outb(fn, spic_dev.cur_ioport->io1.minimum);
1500        wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
1501        outb(v, spic_dev.cur_ioport->io1.minimum);
1502        v1 = inb_p(spic_dev.cur_ioport->io1.minimum);
1503        dprintk("sony_pic_call3(0x%.2x - 0x%.2x - 0x%.2x): 0x%.4x\n",
1504                        dev, fn, v, v1);
1505        return v1;
1506}
1507
1508/*
1509 * minidrivers for SPIC models
1510 */
1511static int type4_handle_irq(const u8 data_mask, const u8 ev)
1512{
1513        /*
1514         * 0x31 could mean we have to take some extra action and wait for
1515         * the next irq for some Type4 models, it will generate a new
1516         * irq and we can read new data from the device:
1517         *  - 0x5c and 0x5f requires 0xA0
1518         *  - 0x61 requires 0xB3
1519         */
1520        if (data_mask == 0x31) {
1521                if (ev == 0x5c || ev == 0x5f)
1522                        sony_pic_call1(0xA0);
1523                else if (ev == 0x61)
1524                        sony_pic_call1(0xB3);
1525                return 0;
1526        }
1527        return 1;
1528}
1529
1530static struct device_ctrl spic_types[] = {
1531        {
1532                .model = SONYPI_DEVICE_TYPE1,
1533                .handle_irq = NULL,
1534                .evport_offset = SONYPI_TYPE1_OFFSET,
1535                .event_types = type1_events,
1536        },
1537        {
1538                .model = SONYPI_DEVICE_TYPE2,
1539                .handle_irq = NULL,
1540                .evport_offset = SONYPI_TYPE2_OFFSET,
1541                .event_types = type2_events,
1542        },
1543        {
1544                .model = SONYPI_DEVICE_TYPE3,
1545                .handle_irq = NULL,
1546                .evport_offset = SONYPI_TYPE3_OFFSET,
1547                .event_types = type3_events,
1548        },
1549        {
1550                .model = SONYPI_DEVICE_TYPE4,
1551                .handle_irq = type4_handle_irq,
1552                .evport_offset = SONYPI_TYPE4_OFFSET,
1553                .event_types = type4_events,
1554        },
1555};
1556
1557static void sony_pic_detect_device_type(struct sony_pic_dev *dev)
1558{
1559        struct pci_dev *pcidev;
1560
1561        pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
1562                        PCI_DEVICE_ID_INTEL_82371AB_3, NULL);
1563        if (pcidev) {
1564                dev->control = &spic_types[0];
1565                goto out;
1566        }
1567
1568        pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
1569                        PCI_DEVICE_ID_INTEL_ICH6_1, NULL);
1570        if (pcidev) {
1571                dev->control = &spic_types[2];
1572                goto out;
1573        }
1574
1575        pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
1576                        PCI_DEVICE_ID_INTEL_ICH7_1, NULL);
1577        if (pcidev) {
1578                dev->control = &spic_types[3];
1579                goto out;
1580        }
1581
1582        pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
1583                        PCI_DEVICE_ID_INTEL_ICH8_4, NULL);
1584        if (pcidev) {
1585                dev->control = &spic_types[3];
1586                goto out;
1587        }
1588
1589        /* default */
1590        dev->control = &spic_types[1];
1591
1592out:
1593        if (pcidev)
1594                pci_dev_put(pcidev);
1595
1596        printk(KERN_INFO DRV_PFX "detected Type%d model\n",
1597                        dev->control->model == SONYPI_DEVICE_TYPE1 ? 1 :
1598                        dev->control->model == SONYPI_DEVICE_TYPE2 ? 2 :
1599                        dev->control->model == SONYPI_DEVICE_TYPE3 ? 3 : 4);
1600}
1601
1602/* camera tests and poweron/poweroff */
1603#define SONYPI_CAMERA_PICTURE                5
1604#define SONYPI_CAMERA_CONTROL                0x10
1605
1606#define SONYPI_CAMERA_BRIGHTNESS                0
1607#define SONYPI_CAMERA_CONTRAST                        1
1608#define SONYPI_CAMERA_HUE                        2
1609#define SONYPI_CAMERA_COLOR                        3
1610#define SONYPI_CAMERA_SHARPNESS                        4
1611
1612#define SONYPI_CAMERA_EXPOSURE_MASK                0xC
1613#define SONYPI_CAMERA_WHITE_BALANCE_MASK        0x3
1614#define SONYPI_CAMERA_PICTURE_MODE_MASK                0x30
1615#define SONYPI_CAMERA_MUTE_MASK                        0x40
1616
1617/* the rest don't need a loop until not 0xff */
1618#define SONYPI_CAMERA_AGC                        6
1619#define SONYPI_CAMERA_AGC_MASK                        0x30
1620#define SONYPI_CAMERA_SHUTTER_MASK                 0x7
1621
1622#define SONYPI_CAMERA_SHUTDOWN_REQUEST                7
1623#define SONYPI_CAMERA_CONTROL                        0x10
1624
1625#define SONYPI_CAMERA_STATUS                         7
1626#define SONYPI_CAMERA_STATUS_READY                 0x2
1627#define SONYPI_CAMERA_STATUS_POSITION                0x4
1628
1629#define SONYPI_DIRECTION_BACKWARDS                 0x4
1630
1631#define SONYPI_CAMERA_REVISION                         8
1632#define SONYPI_CAMERA_ROMVERSION                 9
1633
1634static int __sony_pic_camera_ready(void)
1635{
1636        u8 v;
1637
1638        v = sony_pic_call2(0x8f, SONYPI_CAMERA_STATUS);
1639        return (v != 0xff && (v & SONYPI_CAMERA_STATUS_READY));
1640}
1641
1642static int __sony_pic_camera_off(void)
1643{
1644        if (!camera) {
1645                printk(KERN_WARNING DRV_PFX "camera control not enabled\n");
1646                return -ENODEV;
1647        }
1648
1649        wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE,
1650                                SONYPI_CAMERA_MUTE_MASK),
1651                        ITERATIONS_SHORT);
1652
1653        if (spic_dev.camera_power) {
1654                sony_pic_call2(0x91, 0);
1655                spic_dev.camera_power = 0;
1656        }
1657        return 0;
1658}
1659
1660static int __sony_pic_camera_on(void)
1661{
1662        int i, j, x;
1663
1664        if (!camera) {
1665                printk(KERN_WARNING DRV_PFX "camera control not enabled\n");
1666                return -ENODEV;
1667        }
1668
1669        if (spic_dev.camera_power)
1670                return 0;
1671
1672        for (j = 5; j > 0; j--) {
1673
1674                for (x = 0; x < 100 && sony_pic_call2(0x91, 0x1); x++)
1675                        msleep(10);
1676                sony_pic_call1(0x93);
1677
1678                for (i = 400; i > 0; i--) {
1679                        if (__sony_pic_camera_ready())
1680                                break;
1681                        msleep(10);
1682                }
1683                if (i)
1684                        break;
1685        }
1686
1687        if (j == 0) {
1688                printk(KERN_WARNING DRV_PFX "failed to power on camera\n");
1689                return -ENODEV;
1690        }
1691
1692        wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTROL,
1693                                0x5a),
1694                        ITERATIONS_SHORT);
1695
1696        spic_dev.camera_power = 1;
1697        return 0;
1698}
1699
1700/* External camera command (exported to the motion eye v4l driver) */
1701int sony_pic_camera_command(int command, u8 value)
1702{
1703        if (!camera)
1704                return -EIO;
1705
1706        mutex_lock(&spic_dev.lock);
1707
1708        switch (command) {
1709        case SONY_PIC_COMMAND_SETCAMERA:
1710                if (value)
1711                        __sony_pic_camera_on();
1712                else
1713                        __sony_pic_camera_off();
1714                break;
1715        case SONY_PIC_COMMAND_SETCAMERABRIGHTNESS:
1716                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_BRIGHTNESS, value),
1717                                ITERATIONS_SHORT);
1718                break;
1719        case SONY_PIC_COMMAND_SETCAMERACONTRAST:
1720                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTRAST, value),
1721                                ITERATIONS_SHORT);
1722                break;
1723        case SONY_PIC_COMMAND_SETCAMERAHUE:
1724                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_HUE, value),
1725                                ITERATIONS_SHORT);
1726                break;
1727        case SONY_PIC_COMMAND_SETCAMERACOLOR:
1728                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_COLOR, value),
1729                                ITERATIONS_SHORT);
1730                break;
1731        case SONY_PIC_COMMAND_SETCAMERASHARPNESS:
1732                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_SHARPNESS, value),
1733                                ITERATIONS_SHORT);
1734                break;
1735        case SONY_PIC_COMMAND_SETCAMERAPICTURE:
1736                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, value),
1737                                ITERATIONS_SHORT);
1738                break;
1739        case SONY_PIC_COMMAND_SETCAMERAAGC:
1740                wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_AGC, value),
1741                                ITERATIONS_SHORT);
1742                break;
1743        default:
1744                printk(KERN_ERR DRV_PFX "sony_pic_camera_command invalid: %d\n",
1745                       command);
1746                break;
1747        }
1748        mutex_unlock(&spic_dev.lock);
1749        return 0;
1750}
1751EXPORT_SYMBOL(sony_pic_camera_command);
1752
1753/* gprs/edge modem (SZ460N and SZ210P), thanks to Joshua Wise */
1754static void sony_pic_set_wwanpower(u8 state)
1755{
1756        state = !!state;
1757        mutex_lock(&spic_dev.lock);
1758        if (spic_dev.wwan_power == state) {
1759                mutex_unlock(&spic_dev.lock);
1760                return;
1761        }
1762        sony_pic_call2(0xB0, state);
1763        spic_dev.wwan_power = state;
1764        mutex_unlock(&spic_dev.lock);
1765}
1766
1767static ssize_t sony_pic_wwanpower_store(struct device *dev,
1768                struct device_attribute *attr,
1769                const char *buffer, size_t count)
1770{
1771        unsigned long value;
1772        if (count > 31)
1773                return -EINVAL;
1774
1775        value = simple_strtoul(buffer, NULL, 10);
1776        sony_pic_set_wwanpower(value);
1777
1778        return count;
1779}
1780
1781static ssize_t sony_pic_wwanpower_show(struct device *dev,
1782                struct device_attribute *attr, char *buffer)
1783{
1784        ssize_t count;
1785        mutex_lock(&spic_dev.lock);
1786        count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.wwan_power);
1787        mutex_unlock(&spic_dev.lock);
1788        return count;
1789}
1790
1791/* bluetooth subsystem power state */
1792static void __sony_pic_set_bluetoothpower(u8 state)
1793{
1794        state = !!state;
1795        if (spic_dev.bluetooth_power == state)
1796                return;
1797        sony_pic_call2(0x96, state);
1798        sony_pic_call1(0x82);
1799        spic_dev.bluetooth_power = state;
1800}
1801
1802static ssize_t sony_pic_bluetoothpower_store(struct device *dev,
1803                struct device_attribute *attr,
1804                const char *buffer, size_t count)
1805{
1806        unsigned long value;
1807        if (count > 31)
1808                return -EINVAL;
1809
1810        value = simple_strtoul(buffer, NULL, 10);
1811        mutex_lock(&spic_dev.lock);
1812        __sony_pic_set_bluetoothpower(value);
1813        mutex_unlock(&spic_dev.lock);
1814
1815        return count;
1816}
1817
1818static ssize_t sony_pic_bluetoothpower_show(struct device *dev,
1819                struct device_attribute *attr, char *buffer)
1820{
1821        ssize_t count = 0;
1822        mutex_lock(&spic_dev.lock);
1823        count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.bluetooth_power);
1824        mutex_unlock(&spic_dev.lock);
1825        return count;
1826}
1827
1828/* fan speed */
1829/* FAN0 information (reverse engineered from ACPI tables) */
1830#define SONY_PIC_FAN0_STATUS        0x93
1831static int sony_pic_set_fanspeed(unsigned long value)
1832{
1833        return ec_write(SONY_PIC_FAN0_STATUS, value);
1834}
1835
1836static int sony_pic_get_fanspeed(u8 *value)
1837{
1838        return ec_read(SONY_PIC_FAN0_STATUS, value);
1839}
1840
1841static ssize_t sony_pic_fanspeed_store(struct device *dev,
1842                struct device_attribute *attr,
1843                const char *buffer, size_t count)
1844{
1845        unsigned long value;
1846        if (count > 31)
1847                return -EINVAL;
1848
1849        value = simple_strtoul(buffer, NULL, 10);
1850        if (sony_pic_set_fanspeed(value))
1851                return -EIO;
1852
1853        return count;
1854}
1855
1856static ssize_t sony_pic_fanspeed_show(struct device *dev,
1857                struct device_attribute *attr, char *buffer)
1858{
1859        u8 value = 0;
1860        if (sony_pic_get_fanspeed(&value))
1861                return -EIO;
1862
1863        return snprintf(buffer, PAGE_SIZE, "%d\n", value);
1864}
1865
1866#define SPIC_ATTR(_name, _mode)                                        \
1867struct device_attribute spic_attr_##_name = __ATTR(_name,        \
1868                _mode, sony_pic_## _name ##_show,                \
1869                sony_pic_## _name ##_store)
1870
1871static SPIC_ATTR(bluetoothpower, 0644);
1872static SPIC_ATTR(wwanpower, 0644);
1873static SPIC_ATTR(fanspeed, 0644);
1874
1875static struct attribute *spic_attributes[] = {
1876        &spic_attr_bluetoothpower.attr,
1877        &spic_attr_wwanpower.attr,
1878        &spic_attr_fanspeed.attr,
1879        NULL
1880};
1881
1882static struct attribute_group spic_attribute_group = {
1883        .attrs = spic_attributes
1884};
1885
1886/******** SONYPI compatibility **********/
1887#ifdef CONFIG_SONYPI_COMPAT
1888
1889/* battery / brightness / temperature  addresses */
1890#define SONYPI_BAT_FLAGS        0x81
1891#define SONYPI_LCD_LIGHT        0x96
1892#define SONYPI_BAT1_PCTRM        0xa0
1893#define SONYPI_BAT1_LEFT        0xa2
1894#define SONYPI_BAT1_MAXRT        0xa4
1895#define SONYPI_BAT2_PCTRM        0xa8
1896#define SONYPI_BAT2_LEFT        0xaa
1897#define SONYPI_BAT2_MAXRT        0xac
1898#define SONYPI_BAT1_MAXTK        0xb0
1899#define SONYPI_BAT1_FULL        0xb2
1900#define SONYPI_BAT2_MAXTK        0xb8
1901#define SONYPI_BAT2_FULL        0xba
1902#define SONYPI_TEMP_STATUS        0xC1
1903
1904struct sonypi_compat_s {
1905        struct fasync_struct        *fifo_async;
1906        struct kfifo                *fifo;
1907        spinlock_t                fifo_lock;
1908        wait_queue_head_t        fifo_proc_list;
1909        atomic_t                open_count;
1910};
1911static struct sonypi_compat_s sonypi_compat = {
1912        .open_count = ATOMIC_INIT(0),
1913};
1914
1915static int sonypi_misc_fasync(int fd, struct file *filp, int on)
1916{
1917        int retval;
1918
1919        retval = fasync_helper(fd, filp, on, &sonypi_compat.fifo_async);
1920        if (retval < 0)
1921                return retval;
1922        return 0;
1923}
1924
1925static int sonypi_misc_release(struct inode *inode, struct file *file)
1926{
1927        atomic_dec(&sonypi_compat.open_count);
1928        return 0;
1929}
1930
1931static int sonypi_misc_open(struct inode *inode, struct file *file)
1932{
1933        /* Flush input queue on first open */
1934        lock_kernel();
1935        if (atomic_inc_return(&sonypi_compat.open_count) == 1)
1936                kfifo_reset(sonypi_compat.fifo);
1937        unlock_kernel();
1938        return 0;
1939}
1940
1941static ssize_t sonypi_misc_read(struct file *file, char __user *buf,
1942                                size_t count, loff_t *pos)
1943{
1944        ssize_t ret;
1945        unsigned char c;
1946
1947        if ((kfifo_len(sonypi_compat.fifo) == 0) &&
1948            (file->f_flags & O_NONBLOCK))
1949                return -EAGAIN;
1950
1951        ret = wait_event_interruptible(sonypi_compat.fifo_proc_list,
1952                                       kfifo_len(sonypi_compat.fifo) != 0);
1953        if (ret)
1954                return ret;
1955
1956        while (ret < count &&
1957               (kfifo_get(sonypi_compat.fifo, &c, sizeof(c)) == sizeof(c))) {
1958                if (put_user(c, buf++))
1959                        return -EFAULT;
1960                ret++;
1961        }
1962
1963        if (ret > 0) {
1964                struct inode *inode = file->f_path.dentry->d_inode;
1965                inode->i_atime = current_fs_time(inode->i_sb);
1966        }
1967
1968        return ret;
1969}
1970
1971static unsigned int sonypi_misc_poll(struct file *file, poll_table *wait)
1972{
1973        poll_wait(file, &sonypi_compat.fifo_proc_list, wait);
1974        if (kfifo_len(sonypi_compat.fifo))
1975                return POLLIN | POLLRDNORM;
1976        return 0;
1977}
1978
1979static int ec_read16(u8 addr, u16 *value)
1980{
1981        u8 val_lb, val_hb;
1982        if (ec_read(addr, &val_lb))
1983                return -1;
1984        if (ec_read(addr + 1, &val_hb))
1985                return -1;
1986        *value = val_lb | (val_hb << 8);
1987        return 0;
1988}
1989
1990static int sonypi_misc_ioctl(struct inode *ip, struct file *fp,
1991                             unsigned int cmd, unsigned long arg)
1992{
1993        int ret = 0;
1994        void __user *argp = (void __user *)arg;
1995        u8 val8;
1996        u16 val16;
1997        int value;
1998
1999        mutex_lock(&spic_dev.lock);
2000        switch (cmd) {
2001        case SONYPI_IOCGBRT:
2002                if (sony_backlight_device == NULL) {
2003                        ret = -EIO;
2004                        break;
2005                }
2006                if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value)) {
2007                        ret = -EIO;
2008                        break;
2009                }
2010                val8 = ((value & 0xff) - 1) << 5;
2011                if (copy_to_user(argp, &val8, sizeof(val8)))
2012                                ret = -EFAULT;
2013                break;
2014        case SONYPI_IOCSBRT:
2015                if (sony_backlight_device == NULL) {
2016                        ret = -EIO;
2017                        break;
2018                }
2019                if (copy_from_user(&val8, argp, sizeof(val8))) {
2020                        ret = -EFAULT;
2021                        break;
2022                }
2023                if (acpi_callsetfunc(sony_nc_acpi_handle, "SBRT",
2024                                (val8 >> 5) + 1, NULL)) {
2025                        ret = -EIO;
2026                        break;
2027                }
2028                /* sync the backlight device status */
2029                sony_backlight_device->props.brightness =
2030                    sony_backlight_get_brightness(sony_backlight_device);
2031                break;
2032        case SONYPI_IOCGBAT1CAP:
2033                if (ec_read16(SONYPI_BAT1_FULL, &val16)) {
2034                        ret = -EIO;
2035                        break;
2036                }
2037                if (copy_to_user(argp, &val16, sizeof(val16)))
2038                        ret = -EFAULT;
2039                break;
2040        case SONYPI_IOCGBAT1REM:
2041                if (ec_read16(SONYPI_BAT1_LEFT, &val16)) {
2042                        ret = -EIO;
2043                        break;
2044                }
2045                if (copy_to_user(argp, &val16, sizeof(val16)))
2046                        ret = -EFAULT;
2047                break;
2048        case SONYPI_IOCGBAT2CAP:
2049                if (ec_read16(SONYPI_BAT2_FULL, &val16)) {
2050                        ret = -EIO;
2051                        break;
2052                }
2053                if (copy_to_user(argp, &val16, sizeof(val16)))
2054                        ret = -EFAULT;
2055                break;
2056        case SONYPI_IOCGBAT2REM:
2057                if (ec_read16(SONYPI_BAT2_LEFT, &val16)) {
2058                        ret = -EIO;
2059                        break;
2060                }
2061                if (copy_to_user(argp, &val16, sizeof(val16)))
2062                        ret = -EFAULT;
2063                break;
2064        case SONYPI_IOCGBATFLAGS:
2065                if (ec_read(SONYPI_BAT_FLAGS, &val8)) {
2066                        ret = -EIO;
2067                        break;
2068                }
2069                val8 &= 0x07;
2070                if (copy_to_user(argp, &val8, sizeof(val8)))
2071                        ret = -EFAULT;
2072                break;
2073        case SONYPI_IOCGBLUE:
2074                val8 = spic_dev.bluetooth_power;
2075                if (copy_to_user(argp, &val8, sizeof(val8)))
2076                        ret = -EFAULT;
2077                break;
2078        case SONYPI_IOCSBLUE:
2079                if (copy_from_user(&val8, argp, sizeof(val8))) {
2080                        ret = -EFAULT;
2081                        break;
2082                }
2083                __sony_pic_set_bluetoothpower(val8);
2084                break;
2085        /* FAN Controls */
2086        case SONYPI_IOCGFAN:
2087                if (sony_pic_get_fanspeed(&val8)) {
2088                        ret = -EIO;
2089                        break;
2090                }
2091                if (copy_to_user(argp, &val8, sizeof(val8)))
2092                        ret = -EFAULT;
2093                break;
2094        case SONYPI_IOCSFAN:
2095                if (copy_from_user(&val8, argp, sizeof(val8))) {
2096                        ret = -EFAULT;
2097                        break;
2098                }
2099                if (sony_pic_set_fanspeed(val8))
2100                        ret = -EIO;
2101                break;
2102        /* GET Temperature (useful under APM) */
2103        case SONYPI_IOCGTEMP:
2104                if (ec_read(SONYPI_TEMP_STATUS, &val8)) {
2105                        ret = -EIO;
2106                        break;
2107                }
2108                if (copy_to_user(argp, &val8, sizeof(val8)))
2109                        ret = -EFAULT;
2110                break;
2111        default:
2112                ret = -EINVAL;
2113        }
2114        mutex_unlock(&spic_dev.lock);
2115        return ret;
2116}
2117
2118static const struct file_operations sonypi_misc_fops = {
2119        .owner                = THIS_MODULE,
2120        .read                = sonypi_misc_read,
2121        .poll                = sonypi_misc_poll,
2122        .open                = sonypi_misc_open,
2123        .release        = sonypi_misc_release,
2124        .fasync                = sonypi_misc_fasync,
2125        .ioctl                = sonypi_misc_ioctl,
2126};
2127
2128static struct miscdevice sonypi_misc_device = {
2129        .minor                = MISC_DYNAMIC_MINOR,
2130        .name                = "sonypi",
2131        .fops                = &sonypi_misc_fops,
2132};
2133
2134static void sonypi_compat_report_event(u8 event)
2135{
2136        kfifo_put(sonypi_compat.fifo, (unsigned char *)&event, sizeof(event));
2137        kill_fasync(&sonypi_compat.fifo_async, SIGIO, POLL_IN);
2138        wake_up_interruptible(&sonypi_compat.fifo_proc_list);
2139}
2140
2141static int sonypi_compat_init(void)
2142{
2143        int error;
2144
2145        spin_lock_init(&sonypi_compat.fifo_lock);
2146        sonypi_compat.fifo = kfifo_alloc(SONY_LAPTOP_BUF_SIZE, GFP_KERNEL,
2147                                         &sonypi_compat.fifo_lock);
2148        if (IS_ERR(sonypi_compat.fifo)) {
2149                printk(KERN_ERR DRV_PFX "kfifo_alloc failed\n");
2150                return PTR_ERR(sonypi_compat.fifo);
2151        }
2152
2153        init_waitqueue_head(&sonypi_compat.fifo_proc_list);
2154
2155        if (minor != -1)
2156                sonypi_misc_device.minor = minor;
2157        error = misc_register(&sonypi_misc_device);
2158        if (error) {
2159                printk(KERN_ERR DRV_PFX "misc_register failed\n");
2160                goto err_free_kfifo;
2161        }
2162        if (minor == -1)
2163                printk(KERN_INFO DRV_PFX "device allocated minor is %d\n",
2164                       sonypi_misc_device.minor);
2165
2166        return 0;
2167
2168err_free_kfifo:
2169        kfifo_free(sonypi_compat.fifo);
2170        return error;
2171}
2172
2173static void sonypi_compat_exit(void)
2174{
2175        misc_deregister(&sonypi_misc_device);
2176        kfifo_free(sonypi_compat.fifo);
2177}
2178#else
2179static int sonypi_compat_init(void) { return 0; }
2180static void sonypi_compat_exit(void) { }
2181static void sonypi_compat_report_event(u8 event) { }
2182#endif /* CONFIG_SONYPI_COMPAT */
2183
2184/*
2185 * ACPI callbacks
2186 */
2187static acpi_status
2188sony_pic_read_possible_resource(struct acpi_resource *resource, void *context)
2189{
2190        u32 i;
2191        struct sony_pic_dev *dev = (struct sony_pic_dev *)context;
2192
2193        switch (resource->type) {
2194        case ACPI_RESOURCE_TYPE_START_DEPENDENT:
2195                {
2196                        /* start IO enumeration */
2197                        struct sony_pic_ioport *ioport = kzalloc(sizeof(*ioport), GFP_KERNEL);
2198                        if (!ioport)
2199                                return AE_ERROR;
2200
2201                        list_add(&ioport->list, &dev->ioports);
2202                        return AE_OK;
2203                }
2204
2205        case ACPI_RESOURCE_TYPE_END_DEPENDENT:
2206                /* end IO enumeration */
2207                return AE_OK;
2208
2209        case ACPI_RESOURCE_TYPE_IRQ:
2210                {
2211                        struct acpi_resource_irq *p = &resource->data.irq;
2212                        struct sony_pic_irq *interrupt = NULL;
2213                        if (!p || !p->interrupt_count) {
2214                                /*
2215                                 * IRQ descriptors may have no IRQ# bits set,
2216                                 * particularly those those w/ _STA disabled
2217                                 */
2218                                dprintk("Blank IRQ resource\n");
2219                                return AE_OK;
2220                        }
2221                        for (i = 0; i < p->interrupt_count; i++) {
2222                                if (!p->interrupts[i]) {
2223                                        printk(KERN_WARNING DRV_PFX
2224                                                        "Invalid IRQ %d\n",
2225                                                        p->interrupts[i]);
2226                                        continue;
2227                                }
2228                                interrupt = kzalloc(sizeof(*interrupt),
2229                                                GFP_KERNEL);
2230                                if (!interrupt)
2231                                        return AE_ERROR;
2232
2233                                list_add(&interrupt->list, &dev->interrupts);
2234                                interrupt->irq.triggering = p->triggering;
2235                                interrupt->irq.polarity = p->polarity;
2236                                interrupt->irq.sharable = p->sharable;
2237                                interrupt->irq.interrupt_count = 1;
2238                                interrupt->irq.interrupts[0] = p->interrupts[i];
2239                        }
2240                        return AE_OK;
2241                }
2242        case ACPI_RESOURCE_TYPE_IO:
2243                {
2244                        struct acpi_resource_io *io = &resource->data.io;
2245                        struct sony_pic_ioport *ioport =
2246                                list_first_entry(&dev->ioports, struct sony_pic_ioport, list);
2247                        if (!io) {
2248                                dprintk("Blank IO resource\n");
2249                                return AE_OK;
2250                        }
2251
2252                        if (!ioport->io1.minimum) {
2253                                memcpy(&ioport->io1, io, sizeof(*io));
2254                                dprintk("IO1 at 0x%.4x (0x%.2x)\n", ioport->io1.minimum,
2255                                                ioport->io1.address_length);
2256                        }
2257                        else if (!ioport->io2.minimum) {
2258                                memcpy(&ioport->io2, io, sizeof(*io));
2259                                dprintk("IO2 at 0x%.4x (0x%.2x)\n", ioport->io2.minimum,
2260                                                ioport->io2.address_length);
2261                        }
2262                        else {
2263                                printk(KERN_ERR DRV_PFX "Unknown SPIC Type, more than 2 IO Ports\n");
2264                                return AE_ERROR;
2265                        }
2266                        return AE_OK;
2267                }
2268        default:
2269                dprintk("Resource %d isn't an IRQ nor an IO port\n",
2270                                resource->type);
2271
2272        case ACPI_RESOURCE_TYPE_END_TAG:
2273                return AE_OK;
2274        }
2275        return AE_CTRL_TERMINATE;
2276}
2277
2278static int sony_pic_possible_resources(struct acpi_device *device)
2279{
2280        int result = 0;
2281        acpi_status status = AE_OK;
2282
2283        if (!device)
2284                return -EINVAL;
2285
2286        /* get device status */
2287        /* see acpi_pci_link_get_current acpi_pci_link_get_possible */
2288        dprintk("Evaluating _STA\n");
2289        result = acpi_bus_get_status(device);
2290        if (result) {
2291                printk(KERN_WARNING DRV_PFX "Unable to read status\n");
2292                goto end;
2293        }
2294
2295        if (!device->status.enabled)
2296                dprintk("Device disabled\n");
2297        else
2298                dprintk("Device enabled\n");
2299
2300        /*
2301         * Query and parse 'method'
2302         */
2303        dprintk("Evaluating %s\n", METHOD_NAME__PRS);
2304        status = acpi_walk_resources(device->handle, METHOD_NAME__PRS,
2305                        sony_pic_read_possible_resource, &spic_dev);
2306        if (ACPI_FAILURE(status)) {
2307                printk(KERN_WARNING DRV_PFX
2308                                "Failure evaluating %s\n",
2309                                METHOD_NAME__PRS);
2310                result = -ENODEV;
2311        }
2312end:
2313        return result;
2314}
2315
2316/*
2317 *  Disable the spic device by calling its _DIS method
2318 */
2319static int sony_pic_disable(struct acpi_device *device)
2320{
2321        acpi_status ret = acpi_evaluate_object(device->handle, "_DIS", NULL,
2322                                               NULL);
2323
2324        if (ACPI_FAILURE(ret) && ret != AE_NOT_FOUND)
2325                return -ENXIO;
2326
2327        dprintk("Device disabled\n");
2328        return 0;
2329}
2330
2331
2332/*
2333 *  Based on drivers/acpi/pci_link.c:acpi_pci_link_set
2334 *
2335 *  Call _SRS to set current resources
2336 */
2337static int sony_pic_enable(struct acpi_device *device,
2338                struct sony_pic_ioport *ioport, struct sony_pic_irq *irq)
2339{
2340        acpi_status status;
2341        int result = 0;
2342        /* Type 1 resource layout is:
2343         *    IO
2344         *    IO
2345         *    IRQNoFlags
2346         *    End
2347         *
2348         * Type 2 and 3 resource layout is:
2349         *    IO
2350         *    IRQNoFlags
2351         *    End
2352         */
2353        struct {
2354                struct acpi_resource res1;
2355                struct acpi_resource res2;
2356                struct acpi_resource res3;
2357                struct acpi_resource res4;
2358        } *resource;
2359        struct acpi_buffer buffer = { 0, NULL };
2360
2361        if (!ioport || !irq)
2362                return -EINVAL;
2363
2364        /* init acpi_buffer */
2365        resource = kzalloc(sizeof(*resource) + 1, GFP_KERNEL);
2366        if (!resource)
2367                return -ENOMEM;
2368
2369        buffer.length = sizeof(*resource) + 1;
2370        buffer.pointer = resource;
2371
2372        /* setup Type 1 resources */
2373        if (spic_dev.control->model == SONYPI_DEVICE_TYPE1) {
2374
2375                /* setup io resources */
2376                resource->res1.type = ACPI_RESOURCE_TYPE_IO;
2377                resource->res1.length = sizeof(struct acpi_resource);
2378                memcpy(&resource->res1.data.io, &ioport->io1,
2379                                sizeof(struct acpi_resource_io));
2380
2381                resource->res2.type = ACPI_RESOURCE_TYPE_IO;
2382                resource->res2.length = sizeof(struct acpi_resource);
2383                memcpy(&resource->res2.data.io, &ioport->io2,
2384                                sizeof(struct acpi_resource_io));
2385
2386                /* setup irq resource */
2387                resource->res3.type = ACPI_RESOURCE_TYPE_IRQ;
2388                resource->res3.length = sizeof(struct acpi_resource);
2389                memcpy(&resource->res3.data.irq, &irq->irq,
2390                                sizeof(struct acpi_resource_irq));
2391                /* we requested a shared irq */
2392                resource->res3.data.irq.sharable = ACPI_SHARED;
2393
2394                resource->res4.type = ACPI_RESOURCE_TYPE_END_TAG;
2395
2396        }
2397        /* setup Type 2/3 resources */
2398        else {
2399                /* setup io resource */
2400                resource->res1.type = ACPI_RESOURCE_TYPE_IO;
2401                resource->res1.length = sizeof(struct acpi_resource);
2402                memcpy(&resource->res1.data.io, &ioport->io1,
2403                                sizeof(struct acpi_resource_io));
2404
2405                /* setup irq resource */
2406                resource->res2.type = ACPI_RESOURCE_TYPE_IRQ;
2407                resource->res2.length = sizeof(struct acpi_resource);
2408                memcpy(&resource->res2.data.irq, &irq->irq,
2409                                sizeof(struct acpi_resource_irq));
2410                /* we requested a shared irq */
2411                resource->res2.data.irq.sharable = ACPI_SHARED;
2412
2413                resource->res3.type = ACPI_RESOURCE_TYPE_END_TAG;
2414        }
2415
2416        /* Attempt to set the resource */
2417        dprintk("Evaluating _SRS\n");
2418        status = acpi_set_current_resources(device->handle, &buffer);
2419
2420        /* check for total failure */
2421        if (ACPI_FAILURE(status)) {
2422                printk(KERN_ERR DRV_PFX "Error evaluating _SRS\n");
2423                result = -ENODEV;
2424                goto end;
2425        }
2426
2427        /* Necessary device initializations calls (from sonypi) */
2428        sony_pic_call1(0x82);
2429        sony_pic_call2(0x81, 0xff);
2430        sony_pic_call1(compat ? 0x92 : 0x82);
2431
2432end:
2433        kfree(resource);
2434        return result;
2435}
2436
2437/*****************
2438 *
2439 * ISR: some event is available
2440 *
2441 *****************/
2442static irqreturn_t sony_pic_irq(int irq, void *dev_id)
2443{
2444        int i, j;
2445        u8 ev = 0;
2446        u8 data_mask = 0;
2447        u8 device_event = 0;
2448
2449        struct sony_pic_dev *dev = (struct sony_pic_dev *) dev_id;
2450
2451        ev = inb_p(dev->cur_ioport->io1.minimum);
2452        if (dev->cur_ioport->io2.minimum)
2453                data_mask = inb_p(dev->cur_ioport->io2.minimum);
2454        else
2455                data_mask = inb_p(dev->cur_ioport->io1.minimum +
2456                                dev->control->evport_offset);
2457
2458        dprintk("event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n",
2459                        ev, data_mask, dev->cur_ioport->io1.minimum,
2460                        dev->control->evport_offset);
2461
2462        if (ev == 0x00 || ev == 0xff)
2463                return IRQ_HANDLED;
2464
2465        for (i = 0; dev->control->event_types[i].mask; i++) {
2466
2467                if ((data_mask & dev->control->event_types[i].data) !=
2468                    dev->control->event_types[i].data)
2469                        continue;
2470
2471                if (!(mask & dev->control->event_types[i].mask))
2472                        continue;
2473
2474                for (j = 0; dev->control->event_types[i].events[j].event; j++) {
2475                        if (ev == dev->control->event_types[i].events[j].data) {
2476                                device_event =
2477                                        dev->control->
2478                                                event_types[i].events[j].event;
2479                                goto found;
2480                        }
2481                }
2482        }
2483        /* Still not able to decode the event try to pass
2484         * it over to the minidriver
2485         */
2486        if (dev->control->handle_irq &&
2487                        dev->control->handle_irq(data_mask, ev) == 0)
2488                return IRQ_HANDLED;
2489
2490        dprintk("unknown event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n",
2491                        ev, data_mask, dev->cur_ioport->io1.minimum,
2492                        dev->control->evport_offset);
2493        return IRQ_HANDLED;
2494
2495found:
2496        sony_laptop_report_input_event(device_event);
2497        acpi_bus_generate_proc_event(dev->acpi_dev, 1, device_event);
2498        sonypi_compat_report_event(device_event);
2499
2500        return IRQ_HANDLED;
2501}
2502
2503/*****************
2504 *
2505 *  ACPI driver
2506 *
2507 *****************/
2508static int sony_pic_remove(struct acpi_device *device, int type)
2509{
2510        struct sony_pic_ioport *io, *tmp_io;
2511        struct sony_pic_irq *irq, *tmp_irq;
2512
2513        if (sony_pic_disable(device)) {
2514                printk(KERN_ERR DRV_PFX "Couldn't disable device.\n");
2515                return -ENXIO;
2516        }
2517
2518        free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev);
2519        release_region(spic_dev.cur_ioport->io1.minimum,
2520                        spic_dev.cur_ioport->io1.address_length);
2521        if (spic_dev.cur_ioport->io2.minimum)
2522                release_region(spic_dev.cur_ioport->io2.minimum,
2523                                spic_dev.cur_ioport->io2.address_length);
2524
2525        sonypi_compat_exit();
2526
2527        sony_laptop_remove_input();
2528
2529        /* pf attrs */
2530        sysfs_remove_group(&sony_pf_device->dev.kobj, &spic_attribute_group);
2531        sony_pf_remove();
2532
2533        list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) {
2534                list_del(&io->list);
2535                kfree(io);
2536        }
2537        list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) {
2538                list_del(&irq->list);
2539                kfree(irq);
2540        }
2541        spic_dev.cur_ioport = NULL;
2542        spic_dev.cur_irq = NULL;
2543
2544        dprintk(SONY_PIC_DRIVER_NAME " removed.\n");
2545        return 0;
2546}
2547
2548static int sony_pic_add(struct acpi_device *device)
2549{
2550        int result;
2551        struct sony_pic_ioport *io, *tmp_io;
2552        struct sony_pic_irq *irq, *tmp_irq;
2553
2554        printk(KERN_INFO DRV_PFX "%s v%s.\n",
2555                SONY_PIC_DRIVER_NAME, SONY_LAPTOP_DRIVER_VERSION);
2556
2557        spic_dev.acpi_dev = device;
2558        strcpy(acpi_device_class(device), "sony/hotkey");
2559        sony_pic_detect_device_type(&spic_dev);
2560        mutex_init(&spic_dev.lock);
2561
2562        /* read _PRS resources */
2563        result = sony_pic_possible_resources(device);
2564        if (result) {
2565                printk(KERN_ERR DRV_PFX
2566                                "Unabe to read possible resources.\n");
2567                goto err_free_resources;
2568        }
2569
2570        /* setup input devices and helper fifo */
2571        result = sony_laptop_setup_input(device);
2572        if (result) {
2573                printk(KERN_ERR DRV_PFX
2574                                "Unabe to create input devices.\n");
2575                goto err_free_resources;
2576        }
2577
2578        if (sonypi_compat_init())
2579                goto err_remove_input;
2580
2581        /* request io port */
2582        list_for_each_entry_reverse(io, &spic_dev.ioports, list) {
2583                if (request_region(io->io1.minimum, io->io1.address_length,
2584                                        "Sony Programable I/O Device")) {
2585                        dprintk("I/O port1: 0x%.4x (0x%.4x) + 0x%.2x\n",
2586                                        io->io1.minimum, io->io1.maximum,
2587                                        io->io1.address_length);
2588                        /* Type 1 have 2 ioports */
2589                        if (io->io2.minimum) {
2590                                if (request_region(io->io2.minimum,
2591                                                io->io2.address_length,
2592                                                "Sony Programable I/O Device")) {
2593                                        dprintk("I/O port2: 0x%.4x (0x%.4x) + 0x%.2x\n",
2594                                                        io->io2.minimum, io->io2.maximum,
2595                                                        io->io2.address_length);
2596                                        spic_dev.cur_ioport = io;
2597                                        break;
2598                                }
2599                                else {
2600                                        dprintk("Unable to get I/O port2: "
2601                                                        "0x%.4x (0x%.4x) + 0x%.2x\n",
2602                                                        io->io2.minimum, io->io2.maximum,
2603                                                        io->io2.address_length);
2604                                        release_region(io->io1.minimum,
2605                                                        io->io1.address_length);
2606                                }
2607                        }
2608                        else {
2609                                spic_dev.cur_ioport = io;
2610                                break;
2611                        }
2612                }
2613        }
2614        if (!spic_dev.cur_ioport) {
2615                printk(KERN_ERR DRV_PFX "Failed to request_region.\n");
2616                result = -ENODEV;
2617                goto err_remove_compat;
2618        }
2619
2620        /* request IRQ */
2621        list_for_each_entry_reverse(irq, &spic_dev.interrupts, list) {
2622                if (!request_irq(irq->irq.interrupts[0], sony_pic_irq,
2623                                        IRQF_SHARED, "sony-laptop", &spic_dev)) {
2624                        dprintk("IRQ: %d - triggering: %d - "
2625                                        "polarity: %d - shr: %d\n",
2626                                        irq->irq.interrupts[0],
2627                                        irq->irq.triggering,
2628                                        irq->irq.polarity,
2629                                        irq->irq.sharable);
2630                        spic_dev.cur_irq = irq;
2631                        break;
2632                }
2633        }
2634        if (!spic_dev.cur_irq) {
2635                printk(KERN_ERR DRV_PFX "Failed to request_irq.\n");
2636                result = -ENODEV;
2637                goto err_release_region;
2638        }
2639
2640        /* set resource status _SRS */
2641        result = sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq);
2642        if (result) {
2643                printk(KERN_ERR DRV_PFX "Couldn't enable device.\n");
2644                goto err_free_irq;
2645        }
2646
2647        spic_dev.bluetooth_power = -1;
2648        /* create device attributes */
2649        result = sony_pf_add();
2650        if (result)
2651                goto err_disable_device;
2652
2653        result = sysfs_create_group(&sony_pf_device->dev.kobj, &spic_attribute_group);
2654        if (result)
2655                goto err_remove_pf;
2656
2657        return 0;
2658
2659err_remove_pf:
2660        sony_pf_remove();
2661
2662err_disable_device:
2663        sony_pic_disable(device);
2664
2665err_free_irq:
2666        free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev);
2667
2668err_release_region:
2669        release_region(spic_dev.cur_ioport->io1.minimum,
2670                        spic_dev.cur_ioport->io1.address_length);
2671        if (spic_dev.cur_ioport->io2.minimum)
2672                release_region(spic_dev.cur_ioport->io2.minimum,
2673                                spic_dev.cur_ioport->io2.address_length);
2674
2675err_remove_compat:
2676        sonypi_compat_exit();
2677
2678err_remove_input:
2679        sony_laptop_remove_input();
2680
2681err_free_resources:
2682        list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) {
2683                list_del(&io->list);
2684                kfree(io);
2685        }
2686        list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) {
2687                list_del(&irq->list);
2688                kfree(irq);
2689        }
2690        spic_dev.cur_ioport = NULL;
2691        spic_dev.cur_irq = NULL;
2692
2693        return result;
2694}
2695
2696static int sony_pic_suspend(struct acpi_device *device, pm_message_t state)
2697{
2698        if (sony_pic_disable(device))
2699                return -ENXIO;
2700        return 0;
2701}
2702
2703static int sony_pic_resume(struct acpi_device *device)
2704{
2705        sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq);
2706        return 0;
2707}
2708
2709static const struct acpi_device_id sony_pic_device_ids[] = {
2710        {SONY_PIC_HID, 0},
2711        {"", 0},
2712};
2713
2714static struct acpi_driver sony_pic_driver = {
2715        .name = SONY_PIC_DRIVER_NAME,
2716        .class = SONY_PIC_CLASS,
2717        .ids = sony_pic_device_ids,
2718        .owner = THIS_MODULE,
2719        .ops = {
2720                .add = sony_pic_add,
2721                .remove = sony_pic_remove,
2722                .suspend = sony_pic_suspend,
2723                .resume = sony_pic_resume,
2724                },
2725};
2726
2727static struct dmi_system_id __initdata sonypi_dmi_table[] = {
2728        {
2729                .ident = "Sony Vaio",
2730                .matches = {
2731                        DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
2732                        DMI_MATCH(DMI_PRODUCT_NAME, "PCG-"),
2733                },
2734        },
2735        {
2736                .ident = "Sony Vaio",
2737                .matches = {
2738                        DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
2739                        DMI_MATCH(DMI_PRODUCT_NAME, "VGN-"),
2740                },
2741        },
2742        { }
2743};
2744
2745static int __init sony_laptop_init(void)
2746{
2747        int result;
2748
2749        if (!no_spic && dmi_check_system(sonypi_dmi_table)) {
2750                result = acpi_bus_register_driver(&sony_pic_driver);
2751                if (result) {
2752                        printk(KERN_ERR DRV_PFX
2753                                        "Unable to register SPIC driver.");
2754                        goto out;
2755                }
2756        }
2757
2758        result = acpi_bus_register_driver(&sony_nc_driver);
2759        if (result) {
2760                printk(KERN_ERR DRV_PFX "Unable to register SNC driver.");
2761                goto out_unregister_pic;
2762        }
2763
2764        return 0;
2765
2766out_unregister_pic:
2767        if (!no_spic)
2768                acpi_bus_unregister_driver(&sony_pic_driver);
2769out:
2770        return result;
2771}
2772
2773static void __exit sony_laptop_exit(void)
2774{
2775        acpi_bus_unregister_driver(&sony_nc_driver);
2776        if (!no_spic)
2777                acpi_bus_unregister_driver(&sony_pic_driver);
2778}
2779
2780module_init(sony_laptop_init);
2781module_exit(sony_laptop_exit);