drivers/platform/x86/toshiba_acpi.c

   1 /*
   2  *  toshiba_acpi.c - Toshiba Laptop ACPI Extras
   3  *
   4  *
   5  *  Copyright (C) 2002-2004 John Belmonte
   6  *  Copyright (C) 2008 Philip Langdale
   7  *  Copyright (C) 2010 Pierre Ducroquet
   8  *
   9  *  This program is free software; you can redistribute it and/or modify
  10  *  it under the terms of the GNU General Public License as published by
  11  *  the Free Software Foundation; either version 2 of the License, or
  12  *  (at your option) any later version.
  13  *
  14  *  This program is distributed in the hope that it will be useful,
  15  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  *  GNU General Public License for more details.
  18  *
  19  *  You should have received a copy of the GNU General Public License
  20  *  along with this program; if not, write to the Free Software
  21  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  22  *
  23  *
  24  *  The devolpment page for this driver is located at
  25  *  http://memebeam.org/toys/ToshibaAcpiDriver.
  26  *
  27  *  Credits:
  28  *      Jonathan A. Buzzard - Toshiba HCI info, and critical tips on reverse
  29  *              engineering the Windows drivers
  30  *      Yasushi Nagato - changes for linux kernel 2.4 -> 2.5
  31  *      Rob Miller - TV out and hotkeys help
  32  *
  33  *
  34  *  TODO
  35  *
  36  */
  37
  38 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  39
  40 #define TOSHIBA_ACPI_VERSION    "0.19"
  41 #define PROC_INTERFACE_VERSION  1
  42
  43 #include <linux/kernel.h>
  44 #include <linux/module.h>
  45 #include <linux/init.h>
  46 #include <linux/types.h>
  47 #include <linux/proc_fs.h>
  48 #include <linux/seq_file.h>
  49 #include <linux/backlight.h>
  50 #include <linux/rfkill.h>
  51 #include <linux/input.h>
  52 #include <linux/input/sparse-keymap.h>
  53 #include <linux/leds.h>
  54 #include <linux/slab.h>
  55
  56 #include <asm/uaccess.h>
  57
  58 #include <acpi/acpi_drivers.h>
  59
  60 MODULE_AUTHOR("John Belmonte");
  61 MODULE_DESCRIPTION("Toshiba Laptop ACPI Extras Driver");
  62 MODULE_LICENSE("GPL");
  63
  64 /* Toshiba ACPI method paths */
  65 #define METHOD_VIDEO_OUT        "\\_SB_.VALX.DSSX"
  66
  67 /* Toshiba HCI interface definitions
  68  *
  69  * HCI is Toshiba's "Hardware Control Interface" which is supposed to
  70  * be uniform across all their models.  Ideally we would just call
  71  * dedicated ACPI methods instead of using this primitive interface.
  72  * However the ACPI methods seem to be incomplete in some areas (for
  73  * example they allow setting, but not reading, the LCD brightness value),
  74  * so this is still useful.
  75  */
  76
  77 #define HCI_WORDS                       6
  78
  79 /* operations */
  80 #define HCI_SET                         0xff00
  81 #define HCI_GET                         0xfe00
  82
  83 /* return codes */
  84 #define HCI_SUCCESS                     0x0000
  85 #define HCI_FAILURE                     0x1000
  86 #define HCI_NOT_SUPPORTED               0x8000
  87 #define HCI_EMPTY                       0x8c00
  88
  89 /* registers */
  90 #define HCI_FAN                         0x0004
  91 #define HCI_SYSTEM_EVENT                0x0016
  92 #define HCI_VIDEO_OUT                   0x001c
  93 #define HCI_HOTKEY_EVENT                0x001e
  94 #define HCI_LCD_BRIGHTNESS              0x002a
  95 #define HCI_WIRELESS                    0x0056
  96
  97 /* field definitions */
  98 #define HCI_LCD_BRIGHTNESS_BITS         3
  99 #define HCI_LCD_BRIGHTNESS_SHIFT        (16-HCI_LCD_BRIGHTNESS_BITS)
 100 #define HCI_LCD_BRIGHTNESS_LEVELS       (1 << HCI_LCD_BRIGHTNESS_BITS)
 101 #define HCI_VIDEO_OUT_LCD               0x1
 102 #define HCI_VIDEO_OUT_CRT               0x2
 103 #define HCI_VIDEO_OUT_TV                0x4
 104 #define HCI_WIRELESS_KILL_SWITCH        0x01
 105 #define HCI_WIRELESS_BT_PRESENT         0x0f
 106 #define HCI_WIRELESS_BT_ATTACH          0x40
 107 #define HCI_WIRELESS_BT_POWER           0x80
 108
 109 struct toshiba_acpi_dev {
 110         struct acpi_device *acpi_dev;
 111         const char *method_hci;
 112         struct rfkill *bt_rfk;
 113         struct input_dev *hotkey_dev;
 114         struct backlight_device *backlight_dev;
 115         struct led_classdev led_dev;
 116
 117         int force_fan;
 118         int last_key_event;
 119         int key_event_valid;
 120
 121         int illumination_supported:1;
 122         int video_supported:1;
 123         int fan_supported:1;
 124         int system_event_supported:1;
 125
 126         struct mutex mutex;
 127 };
 128
 129 static const struct acpi_device_id toshiba_device_ids[] = {
 130         {"TOS6200", 0},
 131         {"TOS6208", 0},
 132         {"TOS1900", 0},
 133         {"", 0},
 134 };
 135 MODULE_DEVICE_TABLE(acpi, toshiba_device_ids);
 136
 137 static const struct key_entry toshiba_acpi_keymap[] __devinitconst = {
 138         { KE_KEY, 0x101, { KEY_MUTE } },
 139         { KE_KEY, 0x102, { KEY_ZOOMOUT } },
 140         { KE_KEY, 0x103, { KEY_ZOOMIN } },
 141         { KE_KEY, 0x13b, { KEY_COFFEE } },
 142         { KE_KEY, 0x13c, { KEY_BATTERY } },
 143         { KE_KEY, 0x13d, { KEY_SLEEP } },
 144         { KE_KEY, 0x13e, { KEY_SUSPEND } },
 145         { KE_KEY, 0x13f, { KEY_SWITCHVIDEOMODE } },
 146         { KE_KEY, 0x140, { KEY_BRIGHTNESSDOWN } },
 147         { KE_KEY, 0x141, { KEY_BRIGHTNESSUP } },
 148         { KE_KEY, 0x142, { KEY_WLAN } },
 149         { KE_KEY, 0x143, { KEY_PROG1 } },
 150         { KE_KEY, 0x17f, { KEY_FN } },
 151         { KE_KEY, 0xb05, { KEY_PROG2 } },
 152         { KE_KEY, 0xb06, { KEY_WWW } },
 153         { KE_KEY, 0xb07, { KEY_MAIL } },
 154         { KE_KEY, 0xb30, { KEY_STOP } },
 155         { KE_KEY, 0xb31, { KEY_PREVIOUSSONG } },
 156         { KE_KEY, 0xb32, { KEY_NEXTSONG } },
 157         { KE_KEY, 0xb33, { KEY_PLAYPAUSE } },
 158         { KE_KEY, 0xb5a, { KEY_MEDIA } },
 159         { KE_END, 0 },
 160 };
 161
 162 /* utility
 163  */
 164
 165 static __inline__ void _set_bit(u32 * word, u32 mask, int value)
 166 {
 167         *word = (*word & ~mask) | (mask * value);
 168 }
 169
 170 /* acpi interface wrappers
 171  */
 172
 173 static int write_acpi_int(const char *methodName, int val)
 174 {
 175         struct acpi_object_list params;
 176         union acpi_object in_objs[1];
 177         acpi_status status;
 178
 179         params.count = ARRAY_SIZE(in_objs);
 180         params.pointer = in_objs;
 181         in_objs[0].type = ACPI_TYPE_INTEGER;
 182         in_objs[0].integer.value = val;
 183
 184         status = acpi_evaluate_object(NULL, (char *)methodName, &params, NULL);
 185         return (status == AE_OK) ? 0 : -EIO;
 186 }
 187
 188 /* Perform a raw HCI call.  Here we don't care about input or output buffer
 189  * format.
 190  */
 191 static acpi_status hci_raw(struct toshiba_acpi_dev *dev,
 192                            const u32 in[HCI_WORDS], u32 out[HCI_WORDS])
 193 {
 194         struct acpi_object_list params;
 195         union acpi_object in_objs[HCI_WORDS];
 196         struct acpi_buffer results;
 197         union acpi_object out_objs[HCI_WORDS + 1];
 198         acpi_status status;
 199         int i;
 200
 201         params.count = HCI_WORDS;
 202         params.pointer = in_objs;
 203         for (i = 0; i < HCI_WORDS; ++i) {
 204                 in_objs[i].type = ACPI_TYPE_INTEGER;
 205                 in_objs[i].integer.value = in[i];
 206         }
 207
 208         results.length = sizeof(out_objs);
 209         results.pointer = out_objs;
 210
 211         status = acpi_evaluate_object(dev->acpi_dev->handle,
 212                                       (char *)dev->method_hci, &params,
 213                                       &results);
 214         if ((status == AE_OK) && (out_objs->package.count <= HCI_WORDS)) {
 215                 for (i = 0; i < out_objs->package.count; ++i) {
 216                         out[i] = out_objs->package.elements[i].integer.value;
 217                 }
 218         }
 219
 220         return status;
 221 }
 222
 223 /* common hci tasks (get or set one or two value)
 224  *
 225  * In addition to the ACPI status, the HCI system returns a result which
 226  * may be useful (such as "not supported").
 227  */
 228
 229 static acpi_status hci_write1(struct toshiba_acpi_dev *dev, u32 reg,
 230                               u32 in1, u32 *result)
 231 {
 232         u32 in[HCI_WORDS] = { HCI_SET, reg, in1, 0, 0, 0 };
 233         u32 out[HCI_WORDS];
 234         acpi_status status = hci_raw(dev, in, out);
 235         *result = (status == AE_OK) ? out[0] : HCI_FAILURE;
 236         return status;
 237 }
 238
 239 static acpi_status hci_read1(struct toshiba_acpi_dev *dev, u32 reg,
 240                              u32 *out1, u32 *result)
 241 {
 242         u32 in[HCI_WORDS] = { HCI_GET, reg, 0, 0, 0, 0 };
 243         u32 out[HCI_WORDS];
 244         acpi_status status = hci_raw(dev, in, out);
 245         *out1 = out[2];
 246         *result = (status == AE_OK) ? out[0] : HCI_FAILURE;
 247         return status;
 248 }
 249
 250 static acpi_status hci_write2(struct toshiba_acpi_dev *dev, u32 reg,
 251                               u32 in1, u32 in2, u32 *result)
 252 {
 253         u32 in[HCI_WORDS] = { HCI_SET, reg, in1, in2, 0, 0 };
 254         u32 out[HCI_WORDS];
 255         acpi_status status = hci_raw(dev, in, out);
 256         *result = (status == AE_OK) ? out[0] : HCI_FAILURE;
 257         return status;
 258 }
 259
 260 static acpi_status hci_read2(struct toshiba_acpi_dev *dev, u32 reg,
 261                              u32 *out1, u32 *out2, u32 *result)
 262 {
 263         u32 in[HCI_WORDS] = { HCI_GET, reg, *out1, *out2, 0, 0 };
 264         u32 out[HCI_WORDS];
 265         acpi_status status = hci_raw(dev, in, out);
 266         *out1 = out[2];
 267         *out2 = out[3];
 268         *result = (status == AE_OK) ? out[0] : HCI_FAILURE;
 269         return status;
 270 }
 271
 272 /* Illumination support */
 273 static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
 274 {
 275         u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
 276         u32 out[HCI_WORDS];
 277         acpi_status status;
 278
 279         in[0] = 0xf100;
 280         status = hci_raw(dev, in, out);
 281         if (ACPI_FAILURE(status)) {
 282                 pr_info("Illumination device not available\n");
 283                 return 0;
 284         }
 285         in[0] = 0xf400;
 286         status = hci_raw(dev, in, out);
 287         return 1;
 288 }
 289
 290 static void toshiba_illumination_set(struct led_classdev *cdev,
 291                                      enum led_brightness brightness)
 292 {
 293         struct toshiba_acpi_dev *dev = container_of(cdev,
 294                         struct toshiba_acpi_dev, led_dev);
 295         u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
 296         u32 out[HCI_WORDS];
 297         acpi_status status;
 298
 299         /* First request : initialize communication. */
 300         in[0] = 0xf100;
 301         status = hci_raw(dev, in, out);
 302         if (ACPI_FAILURE(status)) {
 303                 pr_info("Illumination device not available\n");
 304                 return;
 305         }
 306
 307         if (brightness) {
 308                 /* Switch the illumination on */
 309                 in[0] = 0xf400;
 310                 in[1] = 0x14e;
 311                 in[2] = 1;
 312                 status = hci_raw(dev, in, out);
 313                 if (ACPI_FAILURE(status)) {
 314                         pr_info("ACPI call for illumination failed\n");
 315                         return;
 316                 }
 317         } else {
 318                 /* Switch the illumination off */
 319                 in[0] = 0xf400;
 320                 in[1] = 0x14e;
 321                 in[2] = 0;
 322                 status = hci_raw(dev, in, out);
 323                 if (ACPI_FAILURE(status)) {
 324                         pr_info("ACPI call for illumination failed.\n");
 325                         return;
 326                 }
 327         }
 328
 329         /* Last request : close communication. */
 330         in[0] = 0xf200;
 331         in[1] = 0;
 332         in[2] = 0;
 333         hci_raw(dev, in, out);
 334 }
 335
 336 static enum led_brightness toshiba_illumination_get(struct led_classdev *cdev)
 337 {
 338         struct toshiba_acpi_dev *dev = container_of(cdev,
 339                         struct toshiba_acpi_dev, led_dev);
 340         u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
 341         u32 out[HCI_WORDS];
 342         acpi_status status;
 343         enum led_brightness result;
 344
 345         /* First request : initialize communication. */
 346         in[0] = 0xf100;
 347         status = hci_raw(dev, in, out);
 348         if (ACPI_FAILURE(status)) {
 349                 pr_info("Illumination device not available\n");
 350                 return LED_OFF;
 351         }
 352
 353         /* Check the illumination */
 354         in[0] = 0xf300;
 355         in[1] = 0x14e;
 356         status = hci_raw(dev, in, out);
 357         if (ACPI_FAILURE(status)) {
 358                 pr_info("ACPI call for illumination failed.\n");
 359                 return LED_OFF;
 360         }
 361
 362         result = out[2] ? LED_FULL : LED_OFF;
 363
 364         /* Last request : close communication. */
 365         in[0] = 0xf200;
 366         in[1] = 0;
 367         in[2] = 0;
 368         hci_raw(dev, in, out);
 369
 370         return result;
 371 }
 372
 373 /* Bluetooth rfkill handlers */
 374
 375 static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
 376 {
 377         u32 hci_result;
 378         u32 value, value2;
 379
 380         value = 0;
 381         value2 = 0;
 382         hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
 383         if (hci_result == HCI_SUCCESS)
 384                 *present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;
 385
 386         return hci_result;
 387 }
 388
 389 static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
 390 {
 391         u32 hci_result;
 392         u32 value, value2;
 393
 394         value = 0;
 395         value2 = 0x0001;
 396         hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
 397
 398         *radio_state = value & HCI_WIRELESS_KILL_SWITCH;
 399         return hci_result;
 400 }
 401
 402 static int bt_rfkill_set_block(void *data, bool blocked)
 403 {
 404         struct toshiba_acpi_dev *dev = data;
 405         u32 result1, result2;
 406         u32 value;
 407         int err;
 408         bool radio_state;
 409
 410         value = (blocked == false);
 411
 412         mutex_lock(&dev->mutex);
 413         if (hci_get_radio_state(dev, &radio_state) != HCI_SUCCESS) {
 414                 err = -EIO;
 415                 goto out;
 416         }
 417
 418         if (!radio_state) {
 419                 err = 0;
 420                 goto out;
 421         }
 422
 423         hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
 424         hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
 425
 426         if (result1 != HCI_SUCCESS || result2 != HCI_SUCCESS)
 427                 err = -EIO;
 428         else
 429                 err = 0;
 430  out:
 431         mutex_unlock(&dev->mutex);
 432         return err;
 433 }
 434
 435 static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
 436 {
 437         bool new_rfk_state;
 438         bool value;
 439         u32 hci_result;
 440         struct toshiba_acpi_dev *dev = data;
 441
 442         mutex_lock(&dev->mutex);
 443
 444         hci_result = hci_get_radio_state(dev, &value);
 445         if (hci_result != HCI_SUCCESS) {
 446                 /* Can't do anything useful */
 447                 mutex_unlock(&dev->mutex);
 448                 return;
 449         }
 450
 451         new_rfk_state = value;
 452
 453         mutex_unlock(&dev->mutex);
 454
 455         if (rfkill_set_hw_state(rfkill, !new_rfk_state))
 456                 bt_rfkill_set_block(data, true);
 457 }
 458
 459 static const struct rfkill_ops toshiba_rfk_ops = {
 460         .set_block = bt_rfkill_set_block,
 461         .poll = bt_rfkill_poll,
 462 };
 463
 464 static struct proc_dir_entry *toshiba_proc_dir /*= 0*/ ;
 465
 466 static int get_lcd(struct backlight_device *bd)
 467 {
 468         struct toshiba_acpi_dev *dev = bl_get_data(bd);
 469         u32 hci_result;
 470         u32 value;
 471
 472         hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
 473         if (hci_result == HCI_SUCCESS)
 474                 return (value >> HCI_LCD_BRIGHTNESS_SHIFT);
 475
 476         return -EIO;
 477 }
 478
 479 static int lcd_proc_show(struct seq_file *m, void *v)
 480 {
 481         struct toshiba_acpi_dev *dev = m->private;
 482         int value;
 483
 484         if (!dev->backlight_dev)
 485                 return -ENODEV;
 486
 487         value = get_lcd(dev->backlight_dev);
 488         if (value >= 0) {
 489                 seq_printf(m, "brightness:              %d\n", value);
 490                 seq_printf(m, "brightness_levels:       %d\n",
 491                              HCI_LCD_BRIGHTNESS_LEVELS);
 492                 return 0;
 493         }
 494
 495         pr_err("Error reading LCD brightness\n");
 496         return -EIO;
 497 }
 498
 499 static int lcd_proc_open(struct inode *inode, struct file *file)
 500 {
 501         return single_open(file, lcd_proc_show, PDE(inode)->data);
 502 }
 503
 504 static int set_lcd(struct toshiba_acpi_dev *dev, int value)
 505 {
 506         u32 hci_result;
 507
 508         value = value << HCI_LCD_BRIGHTNESS_SHIFT;
 509         hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
 510         return hci_result == HCI_SUCCESS ? 0 : -EIO;
 511 }
 512
 513 static int set_lcd_status(struct backlight_device *bd)
 514 {
 515         struct toshiba_acpi_dev *dev = bl_get_data(bd);
 516         return set_lcd(dev, bd->props.brightness);
 517 }
 518
 519 static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
 520                               size_t count, loff_t *pos)
 521 {
 522         struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
 523         char cmd[42];
 524         size_t len;
 525         int value;
 526         int ret;
 527
 528         len = min(count, sizeof(cmd) - 1);
 529         if (copy_from_user(cmd, buf, len))
 530                 return -EFAULT;
 531         cmd[len] = '\0';
 532
 533         if (sscanf(cmd, " brightness : %i", &value) == 1 &&
 534             value >= 0 && value < HCI_LCD_BRIGHTNESS_LEVELS) {
 535                 ret = set_lcd(dev, value);
 536                 if (ret == 0)
 537                         ret = count;
 538         } else {
 539                 ret = -EINVAL;
 540         }
 541         return ret;
 542 }
 543
 544 static const struct file_operations lcd_proc_fops = {
 545         .owner          = THIS_MODULE,
 546         .open           = lcd_proc_open,
 547         .read           = seq_read,
 548         .llseek         = seq_lseek,
 549         .release        = single_release,
 550         .write          = lcd_proc_write,
 551 };
 552
 553 static int get_video_status(struct toshiba_acpi_dev *dev, u32 *status)
 554 {
 555         u32 hci_result;
 556
 557         hci_read1(dev, HCI_VIDEO_OUT, status, &hci_result);
 558         return hci_result == HCI_SUCCESS ? 0 : -EIO;
 559 }
 560
 561 static int video_proc_show(struct seq_file *m, void *v)
 562 {
 563         struct toshiba_acpi_dev *dev = m->private;
 564         u32 value;
 565         int ret;
 566
 567         ret = get_video_status(dev, &value);
 568         if (!ret) {
 569                 int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
 570                 int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
 571                 int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
 572                 seq_printf(m, "lcd_out:                 %d\n", is_lcd);
 573                 seq_printf(m, "crt_out:                 %d\n", is_crt);
 574                 seq_printf(m, "tv_out:                  %d\n", is_tv);
 575         }
 576
 577         return ret;
 578 }
 579
 580 static int video_proc_open(struct inode *inode, struct file *file)
 581 {
 582         return single_open(file, video_proc_show, PDE(inode)->data);
 583 }
 584
 585 static ssize_t video_proc_write(struct file *file, const char __user *buf,
 586                                 size_t count, loff_t *pos)
 587 {
 588         struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
 589         char *cmd, *buffer;
 590         int ret;
 591         int value;
 592         int remain = count;
 593         int lcd_out = -1;
 594         int crt_out = -1;
 595         int tv_out = -1;
 596         u32 video_out;
 597
 598         cmd = kmalloc(count + 1, GFP_KERNEL);
 599         if (!cmd)
 600                 return -ENOMEM;
 601         if (copy_from_user(cmd, buf, count)) {
 602                 kfree(cmd);
 603                 return -EFAULT;
 604         }
 605         cmd[count] = '\0';
 606
 607         buffer = cmd;
 608
 609         /* scan expression.  Multiple expressions may be delimited with ;
 610          *
 611          *  NOTE: to keep scanning simple, invalid fields are ignored
 612          */
 613         while (remain) {
 614                 if (sscanf(buffer, " lcd_out : %i", &value) == 1)
 615                         lcd_out = value & 1;
 616                 else if (sscanf(buffer, " crt_out : %i", &value) == 1)
 617                         crt_out = value & 1;
 618                 else if (sscanf(buffer, " tv_out : %i", &value) == 1)
 619                         tv_out = value & 1;
 620                 /* advance to one character past the next ; */
 621                 do {
 622                         ++buffer;
 623                         --remain;
 624                 }
 625                 while (remain && *(buffer - 1) != ';');
 626         }
 627
 628         kfree(cmd);
 629
 630         ret = get_video_status(dev, &video_out);
 631         if (!ret) {
 632                 unsigned int new_video_out = video_out;
 633                 if (lcd_out != -1)
 634                         _set_bit(&new_video_out, HCI_VIDEO_OUT_LCD, lcd_out);
 635                 if (crt_out != -1)
 636                         _set_bit(&new_video_out, HCI_VIDEO_OUT_CRT, crt_out);
 637                 if (tv_out != -1)
 638                         _set_bit(&new_video_out, HCI_VIDEO_OUT_TV, tv_out);
 639                 /* To avoid unnecessary video disruption, only write the new
 640                  * video setting if something changed. */
 641                 if (new_video_out != video_out)
 642                         ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
 643         }
 644
 645         return ret ? ret : count;
 646 }
 647
 648 static const struct file_operations video_proc_fops = {
 649         .owner          = THIS_MODULE,
 650         .open           = video_proc_open,
 651         .read           = seq_read,
 652         .llseek         = seq_lseek,
 653         .release        = single_release,
 654         .write          = video_proc_write,
 655 };
 656
 657 static int get_fan_status(struct toshiba_acpi_dev *dev, u32 *status)
 658 {
 659         u32 hci_result;
 660
 661         hci_read1(dev, HCI_FAN, status, &hci_result);
 662         return hci_result == HCI_SUCCESS ? 0 : -EIO;
 663 }
 664
 665 static int fan_proc_show(struct seq_file *m, void *v)
 666 {
 667         struct toshiba_acpi_dev *dev = m->private;
 668         int ret;
 669         u32 value;
 670
 671         ret = get_fan_status(dev, &value);
 672         if (!ret) {
 673                 seq_printf(m, "running:                 %d\n", (value > 0));
 674                 seq_printf(m, "force_on:                %d\n", dev->force_fan);
 675         }
 676
 677         return ret;
 678 }
 679
 680 static int fan_proc_open(struct inode *inode, struct file *file)
 681 {
 682         return single_open(file, fan_proc_show, PDE(inode)->data);
 683 }
 684
 685 static ssize_t fan_proc_write(struct file *file, const char __user *buf,
 686                               size_t count, loff_t *pos)
 687 {
 688         struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
 689         char cmd[42];
 690         size_t len;
 691         int value;
 692         u32 hci_result;
 693
 694         len = min(count, sizeof(cmd) - 1);
 695         if (copy_from_user(cmd, buf, len))
 696                 return -EFAULT;
 697         cmd[len] = '\0';
 698
 699         if (sscanf(cmd, " force_on : %i", &value) == 1 &&
 700             value >= 0 && value <= 1) {
 701                 hci_write1(dev, HCI_FAN, value, &hci_result);
 702                 if (hci_result != HCI_SUCCESS)
 703                         return -EIO;
 704                 else
 705                         dev->force_fan = value;
 706         } else {
 707                 return -EINVAL;
 708         }
 709
 710         return count;
 711 }
 712
 713 static const struct file_operations fan_proc_fops = {
 714         .owner          = THIS_MODULE,
 715         .open           = fan_proc_open,
 716         .read           = seq_read,
 717         .llseek         = seq_lseek,
 718         .release        = single_release,
 719         .write          = fan_proc_write,
 720 };
 721
 722 static int keys_proc_show(struct seq_file *m, void *v)
 723 {
 724         struct toshiba_acpi_dev *dev = m->private;
 725         u32 hci_result;
 726         u32 value;
 727
 728         if (!dev->key_event_valid && dev->system_event_supported) {
 729                 hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
 730                 if (hci_result == HCI_SUCCESS) {
 731                         dev->key_event_valid = 1;
 732                         dev->last_key_event = value;
 733                 } else if (hci_result == HCI_EMPTY) {
 734                         /* better luck next time */
 735                 } else if (hci_result == HCI_NOT_SUPPORTED) {
 736                         /* This is a workaround for an unresolved issue on
 737                          * some machines where system events sporadically
 738                          * become disabled. */
 739                         hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
 740                         pr_notice("Re-enabled hotkeys\n");
 741                 } else {
 742                         pr_err("Error reading hotkey status\n");
 743                         return -EIO;
 744                 }
 745         }
 746
 747         seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
 748         seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
 749         return 0;
 750 }
 751
 752 static int keys_proc_open(struct inode *inode, struct file *file)
 753 {
 754         return single_open(file, keys_proc_show, PDE(inode)->data);
 755 }
 756
 757 static ssize_t keys_proc_write(struct file *file, const char __user *buf,
 758                                size_t count, loff_t *pos)
 759 {
 760         struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
 761         char cmd[42];
 762         size_t len;
 763         int value;
 764
 765         len = min(count, sizeof(cmd) - 1);
 766         if (copy_from_user(cmd, buf, len))
 767                 return -EFAULT;
 768         cmd[len] = '\0';
 769
 770         if (sscanf(cmd, " hotkey_ready : %i", &value) == 1 && value == 0) {
 771                 dev->key_event_valid = 0;
 772         } else {
 773                 return -EINVAL;
 774         }
 775
 776         return count;
 777 }
 778
 779 static const struct file_operations keys_proc_fops = {
 780         .owner          = THIS_MODULE,
 781         .open           = keys_proc_open,
 782         .read           = seq_read,
 783         .llseek         = seq_lseek,
 784         .release        = single_release,
 785         .write          = keys_proc_write,
 786 };
 787
 788 static int version_proc_show(struct seq_file *m, void *v)
 789 {
 790         seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
 791         seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
 792         return 0;
 793 }
 794
 795 static int version_proc_open(struct inode *inode, struct file *file)
 796 {
 797         return single_open(file, version_proc_show, PDE(inode)->data);
 798 }
 799
 800 static const struct file_operations version_proc_fops = {
 801         .owner          = THIS_MODULE,
 802         .open           = version_proc_open,
 803         .read           = seq_read,
 804         .llseek         = seq_lseek,
 805         .release        = single_release,
 806 };
 807
 808 /* proc and module init
 809  */
 810
 811 #define PROC_TOSHIBA            "toshiba"
 812
 813 static void __devinit
 814 create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
 815 {
 816         if (dev->backlight_dev)
 817                 proc_create_data("lcd", S_IRUGO | S_IWUSR, toshiba_proc_dir,
 818                                  &lcd_proc_fops, dev);
 819         if (dev->video_supported)
 820                 proc_create_data("video", S_IRUGO | S_IWUSR, toshiba_proc_dir,
 821                                  &video_proc_fops, dev);
 822         if (dev->fan_supported)
 823                 proc_create_data("fan", S_IRUGO | S_IWUSR, toshiba_proc_dir,
 824                                  &fan_proc_fops, dev);
 825         if (dev->hotkey_dev)
 826                 proc_create_data("keys", S_IRUGO | S_IWUSR, toshiba_proc_dir,
 827                                  &keys_proc_fops, dev);
 828         proc_create_data("version", S_IRUGO, toshiba_proc_dir,
 829                          &version_proc_fops, dev);
 830 }
 831
 832 static void remove_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
 833 {
 834         if (dev->backlight_dev)
 835                 remove_proc_entry("lcd", toshiba_proc_dir);
 836         if (dev->video_supported)
 837                 remove_proc_entry("video", toshiba_proc_dir);
 838         if (dev->fan_supported)
 839                 remove_proc_entry("fan", toshiba_proc_dir);
 840         if (dev->hotkey_dev)
 841                 remove_proc_entry("keys", toshiba_proc_dir);
 842         remove_proc_entry("version", toshiba_proc_dir);
 843 }
 844
 845 static const struct backlight_ops toshiba_backlight_data = {
 846         .get_brightness = get_lcd,
 847         .update_status  = set_lcd_status,
 848 };
 849
 850 static int __devinit toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
 851 {
 852         acpi_status status;
 853         int error;
 854
 855         dev->hotkey_dev = input_allocate_device();
 856         if (!dev->hotkey_dev) {
 857                 pr_info("Unable to register input device\n");
 858                 return -ENOMEM;
 859         }
 860
 861         dev->hotkey_dev->name = "Toshiba input device";
 862         dev->hotkey_dev->phys = "toshiba_acpi/input0";
 863         dev->hotkey_dev->id.bustype = BUS_HOST;
 864
 865         error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
 866         if (error)
 867                 goto err_free_dev;
 868
 869         status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
 870         if (ACPI_FAILURE(status)) {
 871                 pr_info("Unable to enable hotkeys\n");
 872                 error = -ENODEV;
 873                 goto err_free_keymap;
 874         }
 875
 876         error = input_register_device(dev->hotkey_dev);
 877         if (error) {
 878                 pr_info("Unable to register input device\n");
 879                 goto err_free_keymap;
 880         }
 881
 882         return 0;
 883
 884  err_free_keymap:
 885         sparse_keymap_free(dev->hotkey_dev);
 886  err_free_dev:
 887         input_free_device(dev->hotkey_dev);
 888         dev->hotkey_dev = NULL;
 889         return error;
 890 }
 891
 892 static int toshiba_acpi_remove(struct acpi_device *acpi_dev, int type)
 893 {
 894         struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
 895
 896         remove_toshiba_proc_entries(dev);
 897
 898         if (dev->hotkey_dev) {
 899                 input_unregister_device(dev->hotkey_dev);
 900                 sparse_keymap_free(dev->hotkey_dev);
 901         }
 902
 903         if (dev->bt_rfk) {
 904                 rfkill_unregister(dev->bt_rfk);
 905                 rfkill_destroy(dev->bt_rfk);
 906         }
 907
 908         if (dev->backlight_dev)
 909                 backlight_device_unregister(dev->backlight_dev);
 910
 911         if (dev->illumination_supported)
 912                 led_classdev_unregister(&dev->led_dev);
 913
 914         kfree(dev);
 915
 916         return 0;
 917 }
 918
 919 static const char * __devinit find_hci_method(acpi_handle handle)
 920 {
 921         acpi_status status;
 922         acpi_handle hci_handle;
 923
 924         status = acpi_get_handle(handle, "GHCI", &hci_handle);
 925         if (ACPI_SUCCESS(status))
 926                 return "GHCI";
 927
 928         status = acpi_get_handle(handle, "SPFC", &hci_handle);
 929         if (ACPI_SUCCESS(status))
 930                 return "SPFC";
 931
 932         return NULL;
 933 }
 934
 935 static int __devinit toshiba_acpi_add(struct acpi_device *acpi_dev)
 936 {
 937         struct toshiba_acpi_dev *dev;
 938         const char *hci_method;
 939         u32 hci_result;
 940         u32 dummy;
 941         bool bt_present;
 942         int ret = 0;
 943         struct backlight_properties props;
 944
 945         pr_info("Toshiba Laptop ACPI Extras version %s\n",
 946                TOSHIBA_ACPI_VERSION);
 947
 948         hci_method = find_hci_method(acpi_dev->handle);
 949         if (!hci_method) {
 950                 pr_err("HCI interface not found\n");
 951                 return -ENODEV;
 952         }
 953
 954         dev = kzalloc(sizeof(*dev), GFP_KERNEL);
 955         if (!dev)
 956                 return -ENOMEM;
 957         dev->acpi_dev = acpi_dev;
 958         dev->method_hci = hci_method;
 959         acpi_dev->driver_data = dev;
 960
 961         if (toshiba_acpi_setup_keyboard(dev))
 962                 pr_info("Unable to activate hotkeys\n");
 963
 964         mutex_init(&dev->mutex);
 965
 966         /* enable event fifo */
 967         hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
 968         if (hci_result == HCI_SUCCESS)
 969                 dev->system_event_supported = 1;
 970
 971         props.type = BACKLIGHT_PLATFORM;
 972         props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;
 973         dev->backlight_dev = backlight_device_register("toshiba",
 974                                                        &acpi_dev->dev,
 975                                                        dev,
 976                                                        &toshiba_backlight_data,
 977                                                        &props);
 978         if (IS_ERR(dev->backlight_dev)) {
 979                 ret = PTR_ERR(dev->backlight_dev);
 980
 981                 pr_err("Could not register toshiba backlight device\n");
 982                 dev->backlight_dev = NULL;
 983                 goto error;
 984         }
 985         dev->backlight_dev->props.brightness = get_lcd(dev->backlight_dev);
 986
 987         /* Register rfkill switch for Bluetooth */
 988         if (hci_get_bt_present(dev, &bt_present) == HCI_SUCCESS && bt_present) {
 989                 dev->bt_rfk = rfkill_alloc("Toshiba Bluetooth",
 990                                            &acpi_dev->dev,
 991                                            RFKILL_TYPE_BLUETOOTH,
 992                                            &toshiba_rfk_ops,
 993                                            dev);
 994                 if (!dev->bt_rfk) {
 995                         pr_err("unable to allocate rfkill device\n");
 996                         ret = -ENOMEM;
 997                         goto error;
 998                 }
 999
1000                 ret = rfkill_register(dev->bt_rfk);
1001                 if (ret) {
1002                         pr_err("unable to register rfkill device\n");
1003                         rfkill_destroy(dev->bt_rfk);
1004                         goto error;
1005                 }
1006         }
1007
1008         if (toshiba_illumination_available(dev)) {
1009                 dev->led_dev.name = "toshiba::illumination";
1010                 dev->led_dev.max_brightness = 1;
1011                 dev->led_dev.brightness_set = toshiba_illumination_set;
1012                 dev->led_dev.brightness_get = toshiba_illumination_get;
1013                 if (!led_classdev_register(&acpi_dev->dev, &dev->led_dev))
1014                         dev->illumination_supported = 1;
1015         }
1016
1017         /* Determine whether or not BIOS supports fan and video interfaces */
1018
1019         ret = get_video_status(dev, &dummy);
1020         dev->video_supported = !ret;
1021
1022         ret = get_fan_status(dev, &dummy);
1023         dev->fan_supported = !ret;
1024
1025         create_toshiba_proc_entries(dev);
1026
1027         return 0;
1028
1029 error:
1030         toshiba_acpi_remove(acpi_dev, 0);
1031         return ret;
1032 }
1033
1034 static void toshiba_acpi_notify(struct acpi_device *acpi_dev, u32 event)
1035 {
1036         struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
1037         u32 hci_result, value;
1038         int retries = 3;
1039
1040         if (!dev->system_event_supported || event != 0x80)
1041                 return;
1042
1043         do {
1044                 hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
1045                 switch (hci_result) {
1046                 case HCI_SUCCESS:
1047                         if (value == 0x100)
1048                                 continue;
1049                         /* act on key press; ignore key release */
1050                         if (value & 0x80)
1051                                 continue;
1052
1053                         if (!sparse_keymap_report_event(dev->hotkey_dev,
1054                                                         value, 1, true)) {
1055                                 pr_info("Unknown key %x\n",
1056                                        value);
1057                         }
1058                         break;
1059                 case HCI_NOT_SUPPORTED:
1060                         /* This is a workaround for an unresolved issue on
1061                          * some machines where system events sporadically
1062                          * become disabled. */
1063                         hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
1064                         pr_notice("Re-enabled hotkeys\n");
1065                         /* fall through */
1066                 default:
1067                         retries--;
1068                         break;
1069                 }
1070         } while (retries && hci_result != HCI_EMPTY);
1071 }
1072
1073
1074 static struct acpi_driver toshiba_acpi_driver = {
1075         .name   = "Toshiba ACPI driver",
1076         .owner  = THIS_MODULE,
1077         .ids    = toshiba_device_ids,
1078         .flags  = ACPI_DRIVER_ALL_NOTIFY_EVENTS,
1079         .ops    = {
1080                 .add            = toshiba_acpi_add,
1081                 .remove         = toshiba_acpi_remove,
1082                 .notify         = toshiba_acpi_notify,
1083         },
1084 };
1085
1086 static int __init toshiba_acpi_init(void)
1087 {
1088         int ret;
1089
1090         toshiba_proc_dir = proc_mkdir(PROC_TOSHIBA, acpi_root_dir);
1091         if (!toshiba_proc_dir) {
1092                 pr_err("Unable to create proc dir " PROC_TOSHIBA "\n");
1093                 return -ENODEV;
1094         }
1095
1096         ret = acpi_bus_register_driver(&toshiba_acpi_driver);
1097         if (ret) {
1098                 pr_err("Failed to register ACPI driver: %d\n", ret);
1099                 remove_proc_entry(PROC_TOSHIBA, acpi_root_dir);
1100         }
1101
1102         return ret;
1103 }
1104
1105 static void __exit toshiba_acpi_exit(void)
1106 {
1107         acpi_bus_unregister_driver(&toshiba_acpi_driver);
1108         if (toshiba_proc_dir)
1109                 remove_proc_entry(PROC_TOSHIBA, acpi_root_dir);
1110 }
1111
1112 module_init(toshiba_acpi_init);
1113 module_exit(toshiba_acpi_exit);