1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * ACPI Sony Notebook Control Driver (SNC and SPIC) 4 * 5 * Copyright (C) 2004-2005 Stelian Pop <stelian@popies.net> 6 * Copyright (C) 2007-2009 Mattia Dongili <malattia@linux.it> 7 * 8 * Parts of this driver inspired from asus_acpi.c and ibm_acpi.c 9 * which are copyrighted by their respective authors. 10 * 11 * The SNY6001 driver part is based on the sonypi driver which includes 12 * material from: 13 * 14 * Copyright (C) 2001-2005 Stelian Pop <stelian@popies.net> 15 * 16 * Copyright (C) 2005 Narayanan R S <nars@kadamba.org> 17 * 18 * Copyright (C) 2001-2002 Alcôve <www.alcove.com> 19 * 20 * Copyright (C) 2001 Michael Ashley <m.ashley@unsw.edu.au> 21 * 22 * Copyright (C) 2001 Junichi Morita <jun1m@mars.dti.ne.jp> 23 * 24 * Copyright (C) 2000 Takaya Kinjo <t-kinjo@tc4.so-net.ne.jp> 25 * 26 * Copyright (C) 2000 Andrew Tridgell <tridge@valinux.com> 27 * 28 * Earlier work by Werner Almesberger, Paul `Rusty' Russell and Paul Mackerras. 29 */ 30 31 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 32 33 #include <linux/kernel.h> 34 #include <linux/module.h> 35 #include <linux/moduleparam.h> 36 #include <linux/init.h> 37 #include <linux/types.h> 38 #include <linux/backlight.h> 39 #include <linux/platform_device.h> 40 #include <linux/err.h> 41 #include <linux/dmi.h> 42 #include <linux/pci.h> 43 #include <linux/interrupt.h> 44 #include <linux/delay.h> 45 #include <linux/input.h> 46 #include <linux/kfifo.h> 47 #include <linux/workqueue.h> 48 #include <linux/acpi.h> 49 #include <linux/slab.h> 50 #include <linux/sonypi.h> 51 #include <linux/sony-laptop.h> 52 #include <linux/rfkill.h> 53 #ifdef CONFIG_SONYPI_COMPAT 54 #include <linux/poll.h> 55 #include <linux/miscdevice.h> 56 #endif 57 #include <linux/uaccess.h> 58 #include <acpi/video.h> 59 60 #define dprintk(fmt, ...) \ 61 do { \ 62 if (debug) \ 63 pr_warn(fmt, ##__VA_ARGS__); \ 64 } while (0) 65 66 #define SONY_NC_CLASS "sony-nc" 67 #define SONY_NC_HID "SNY5001" 68 #define SONY_NC_DRIVER_NAME "Sony Notebook Control Driver" 69 70 #define SONY_PIC_CLASS "sony-pic" 71 #define SONY_PIC_HID "SNY6001" 72 #define SONY_PIC_DRIVER_NAME "Sony Programmable IO Control Driver" 73 74 MODULE_AUTHOR("Stelian Pop, Mattia Dongili"); 75 MODULE_DESCRIPTION("Sony laptop extras driver (SPIC and SNC ACPI device)"); 76 MODULE_LICENSE("GPL"); 77 78 static int debug; 79 module_param(debug, int, 0); 80 MODULE_PARM_DESC(debug, "set this to 1 (and RTFM) if you want to help " 81 "the development of this driver"); 82 83 static int no_spic; /* = 0 */ 84 module_param(no_spic, int, 0444); 85 MODULE_PARM_DESC(no_spic, 86 "set this if you don't want to enable the SPIC device"); 87 88 static int compat; /* = 0 */ 89 module_param(compat, int, 0444); 90 MODULE_PARM_DESC(compat, 91 "set this if you want to enable backward compatibility mode"); 92 93 static unsigned long mask = 0xffffffff; 94 module_param(mask, ulong, 0644); 95 MODULE_PARM_DESC(mask, 96 "set this to the mask of event you want to enable (see doc)"); 97 98 static int camera; /* = 0 */ 99 module_param(camera, int, 0444); 100 MODULE_PARM_DESC(camera, 101 "set this to 1 to enable Motion Eye camera controls " 102 "(only use it if you have a C1VE or C1VN model)"); 103 104 #ifdef CONFIG_SONYPI_COMPAT 105 static int minor = -1; 106 module_param(minor, int, 0); 107 MODULE_PARM_DESC(minor, 108 "minor number of the misc device for the SPIC compatibility code, " 109 "default is -1 (automatic)"); 110 #endif 111 112 static int kbd_backlight = -1; 113 module_param(kbd_backlight, int, 0444); 114 MODULE_PARM_DESC(kbd_backlight, 115 "set this to 0 to disable keyboard backlight, " 116 "1 to enable it with automatic control and 2 to have it always " 117 "on (default: no change from current value)"); 118 119 static int kbd_backlight_timeout = -1; 120 module_param(kbd_backlight_timeout, int, 0444); 121 MODULE_PARM_DESC(kbd_backlight_timeout, 122 "meaningful values vary from 0 to 3 and their meaning depends " 123 "on the model (default: no change from current value)"); 124 125 #ifdef CONFIG_PM_SLEEP 126 static void sony_nc_thermal_resume(void); 127 #endif 128 static int sony_nc_kbd_backlight_setup(struct platform_device *pd, 129 unsigned int handle); 130 static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd, 131 unsigned int handle); 132 133 static int sony_nc_battery_care_setup(struct platform_device *pd, 134 unsigned int handle); 135 static void sony_nc_battery_care_cleanup(struct platform_device *pd); 136 137 static int sony_nc_thermal_setup(struct platform_device *pd); 138 static void sony_nc_thermal_cleanup(struct platform_device *pd); 139 140 static int sony_nc_lid_resume_setup(struct platform_device *pd, 141 unsigned int handle); 142 static void sony_nc_lid_resume_cleanup(struct platform_device *pd); 143 144 static int sony_nc_gfx_switch_setup(struct platform_device *pd, 145 unsigned int handle); 146 static void sony_nc_gfx_switch_cleanup(struct platform_device *pd); 147 static int __sony_nc_gfx_switch_status_get(void); 148 149 static int sony_nc_highspeed_charging_setup(struct platform_device *pd); 150 static void sony_nc_highspeed_charging_cleanup(struct platform_device *pd); 151 152 static int sony_nc_lowbatt_setup(struct platform_device *pd); 153 static void sony_nc_lowbatt_cleanup(struct platform_device *pd); 154 155 static int sony_nc_fanspeed_setup(struct platform_device *pd); 156 static void sony_nc_fanspeed_cleanup(struct platform_device *pd); 157 158 static int sony_nc_usb_charge_setup(struct platform_device *pd); 159 static void sony_nc_usb_charge_cleanup(struct platform_device *pd); 160 161 static int sony_nc_panelid_setup(struct platform_device *pd); 162 static void sony_nc_panelid_cleanup(struct platform_device *pd); 163 164 static int sony_nc_smart_conn_setup(struct platform_device *pd); 165 static void sony_nc_smart_conn_cleanup(struct platform_device *pd); 166 167 static int sony_nc_touchpad_setup(struct platform_device *pd, 168 unsigned int handle); 169 static void sony_nc_touchpad_cleanup(struct platform_device *pd); 170 171 enum sony_nc_rfkill { 172 SONY_WIFI, 173 SONY_BLUETOOTH, 174 SONY_WWAN, 175 SONY_WIMAX, 176 N_SONY_RFKILL, 177 }; 178 179 static int sony_rfkill_handle; 180 static struct rfkill *sony_rfkill_devices[N_SONY_RFKILL]; 181 static int sony_rfkill_address[N_SONY_RFKILL] = {0x300, 0x500, 0x700, 0x900}; 182 static int sony_nc_rfkill_setup(struct acpi_device *device, 183 unsigned int handle); 184 static void sony_nc_rfkill_cleanup(void); 185 static void sony_nc_rfkill_update(void); 186 187 /*********** Input Devices ***********/ 188 189 #define SONY_LAPTOP_BUF_SIZE 128 190 struct sony_laptop_input_s { 191 atomic_t users; 192 struct input_dev *jog_dev; 193 struct input_dev *key_dev; 194 struct kfifo fifo; 195 spinlock_t fifo_lock; 196 struct timer_list release_key_timer; 197 }; 198 199 static struct sony_laptop_input_s sony_laptop_input = { 200 .users = ATOMIC_INIT(0), 201 }; 202 203 struct sony_laptop_keypress { 204 struct input_dev *dev; 205 int key; 206 }; 207 208 /* Correspondance table between sonypi events 209 * and input layer indexes in the keymap 210 */ 211 static const int sony_laptop_input_index[] = { 212 -1, /* 0 no event */ 213 -1, /* 1 SONYPI_EVENT_JOGDIAL_DOWN */ 214 -1, /* 2 SONYPI_EVENT_JOGDIAL_UP */ 215 -1, /* 3 SONYPI_EVENT_JOGDIAL_DOWN_PRESSED */ 216 -1, /* 4 SONYPI_EVENT_JOGDIAL_UP_PRESSED */ 217 -1, /* 5 SONYPI_EVENT_JOGDIAL_PRESSED */ 218 -1, /* 6 SONYPI_EVENT_JOGDIAL_RELEASED */ 219 0, /* 7 SONYPI_EVENT_CAPTURE_PRESSED */ 220 1, /* 8 SONYPI_EVENT_CAPTURE_RELEASED */ 221 2, /* 9 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */ 222 3, /* 10 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */ 223 4, /* 11 SONYPI_EVENT_FNKEY_ESC */ 224 5, /* 12 SONYPI_EVENT_FNKEY_F1 */ 225 6, /* 13 SONYPI_EVENT_FNKEY_F2 */ 226 7, /* 14 SONYPI_EVENT_FNKEY_F3 */ 227 8, /* 15 SONYPI_EVENT_FNKEY_F4 */ 228 9, /* 16 SONYPI_EVENT_FNKEY_F5 */ 229 10, /* 17 SONYPI_EVENT_FNKEY_F6 */ 230 11, /* 18 SONYPI_EVENT_FNKEY_F7 */ 231 12, /* 19 SONYPI_EVENT_FNKEY_F8 */ 232 13, /* 20 SONYPI_EVENT_FNKEY_F9 */ 233 14, /* 21 SONYPI_EVENT_FNKEY_F10 */ 234 15, /* 22 SONYPI_EVENT_FNKEY_F11 */ 235 16, /* 23 SONYPI_EVENT_FNKEY_F12 */ 236 17, /* 24 SONYPI_EVENT_FNKEY_1 */ 237 18, /* 25 SONYPI_EVENT_FNKEY_2 */ 238 19, /* 26 SONYPI_EVENT_FNKEY_D */ 239 20, /* 27 SONYPI_EVENT_FNKEY_E */ 240 21, /* 28 SONYPI_EVENT_FNKEY_F */ 241 22, /* 29 SONYPI_EVENT_FNKEY_S */ 242 23, /* 30 SONYPI_EVENT_FNKEY_B */ 243 24, /* 31 SONYPI_EVENT_BLUETOOTH_PRESSED */ 244 25, /* 32 SONYPI_EVENT_PKEY_P1 */ 245 26, /* 33 SONYPI_EVENT_PKEY_P2 */ 246 27, /* 34 SONYPI_EVENT_PKEY_P3 */ 247 28, /* 35 SONYPI_EVENT_BACK_PRESSED */ 248 -1, /* 36 SONYPI_EVENT_LID_CLOSED */ 249 -1, /* 37 SONYPI_EVENT_LID_OPENED */ 250 29, /* 38 SONYPI_EVENT_BLUETOOTH_ON */ 251 30, /* 39 SONYPI_EVENT_BLUETOOTH_OFF */ 252 31, /* 40 SONYPI_EVENT_HELP_PRESSED */ 253 32, /* 41 SONYPI_EVENT_FNKEY_ONLY */ 254 33, /* 42 SONYPI_EVENT_JOGDIAL_FAST_DOWN */ 255 34, /* 43 SONYPI_EVENT_JOGDIAL_FAST_UP */ 256 35, /* 44 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */ 257 36, /* 45 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */ 258 37, /* 46 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */ 259 38, /* 47 SONYPI_EVENT_JOGDIAL_VFAST_UP */ 260 39, /* 48 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */ 261 40, /* 49 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */ 262 41, /* 50 SONYPI_EVENT_ZOOM_PRESSED */ 263 42, /* 51 SONYPI_EVENT_THUMBPHRASE_PRESSED */ 264 43, /* 52 SONYPI_EVENT_MEYE_FACE */ 265 44, /* 53 SONYPI_EVENT_MEYE_OPPOSITE */ 266 45, /* 54 SONYPI_EVENT_MEMORYSTICK_INSERT */ 267 46, /* 55 SONYPI_EVENT_MEMORYSTICK_EJECT */ 268 -1, /* 56 SONYPI_EVENT_ANYBUTTON_RELEASED */ 269 -1, /* 57 SONYPI_EVENT_BATTERY_INSERT */ 270 -1, /* 58 SONYPI_EVENT_BATTERY_REMOVE */ 271 -1, /* 59 SONYPI_EVENT_FNKEY_RELEASED */ 272 47, /* 60 SONYPI_EVENT_WIRELESS_ON */ 273 48, /* 61 SONYPI_EVENT_WIRELESS_OFF */ 274 49, /* 62 SONYPI_EVENT_ZOOM_IN_PRESSED */ 275 50, /* 63 SONYPI_EVENT_ZOOM_OUT_PRESSED */ 276 51, /* 64 SONYPI_EVENT_CD_EJECT_PRESSED */ 277 52, /* 65 SONYPI_EVENT_MODEKEY_PRESSED */ 278 53, /* 66 SONYPI_EVENT_PKEY_P4 */ 279 54, /* 67 SONYPI_EVENT_PKEY_P5 */ 280 55, /* 68 SONYPI_EVENT_SETTINGKEY_PRESSED */ 281 56, /* 69 SONYPI_EVENT_VOLUME_INC_PRESSED */ 282 57, /* 70 SONYPI_EVENT_VOLUME_DEC_PRESSED */ 283 -1, /* 71 SONYPI_EVENT_BRIGHTNESS_PRESSED */ 284 58, /* 72 SONYPI_EVENT_MEDIA_PRESSED */ 285 59, /* 72 SONYPI_EVENT_VENDOR_PRESSED */ 286 }; 287 288 static int sony_laptop_input_keycode_map[] = { 289 KEY_CAMERA, /* 0 SONYPI_EVENT_CAPTURE_PRESSED */ 290 KEY_RESERVED, /* 1 SONYPI_EVENT_CAPTURE_RELEASED */ 291 KEY_RESERVED, /* 2 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */ 292 KEY_RESERVED, /* 3 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */ 293 KEY_FN_ESC, /* 4 SONYPI_EVENT_FNKEY_ESC */ 294 KEY_FN_F1, /* 5 SONYPI_EVENT_FNKEY_F1 */ 295 KEY_FN_F2, /* 6 SONYPI_EVENT_FNKEY_F2 */ 296 KEY_FN_F3, /* 7 SONYPI_EVENT_FNKEY_F3 */ 297 KEY_FN_F4, /* 8 SONYPI_EVENT_FNKEY_F4 */ 298 KEY_FN_F5, /* 9 SONYPI_EVENT_FNKEY_F5 */ 299 KEY_FN_F6, /* 10 SONYPI_EVENT_FNKEY_F6 */ 300 KEY_FN_F7, /* 11 SONYPI_EVENT_FNKEY_F7 */ 301 KEY_FN_F8, /* 12 SONYPI_EVENT_FNKEY_F8 */ 302 KEY_FN_F9, /* 13 SONYPI_EVENT_FNKEY_F9 */ 303 KEY_FN_F10, /* 14 SONYPI_EVENT_FNKEY_F10 */ 304 KEY_FN_F11, /* 15 SONYPI_EVENT_FNKEY_F11 */ 305 KEY_FN_F12, /* 16 SONYPI_EVENT_FNKEY_F12 */ 306 KEY_FN_1, /* 17 SONYPI_EVENT_FNKEY_1 */ 307 KEY_FN_2, /* 18 SONYPI_EVENT_FNKEY_2 */ 308 KEY_FN_D, /* 19 SONYPI_EVENT_FNKEY_D */ 309 KEY_FN_E, /* 20 SONYPI_EVENT_FNKEY_E */ 310 KEY_FN_F, /* 21 SONYPI_EVENT_FNKEY_F */ 311 KEY_FN_S, /* 22 SONYPI_EVENT_FNKEY_S */ 312 KEY_FN_B, /* 23 SONYPI_EVENT_FNKEY_B */ 313 KEY_BLUETOOTH, /* 24 SONYPI_EVENT_BLUETOOTH_PRESSED */ 314 KEY_PROG1, /* 25 SONYPI_EVENT_PKEY_P1 */ 315 KEY_PROG2, /* 26 SONYPI_EVENT_PKEY_P2 */ 316 KEY_PROG3, /* 27 SONYPI_EVENT_PKEY_P3 */ 317 KEY_BACK, /* 28 SONYPI_EVENT_BACK_PRESSED */ 318 KEY_BLUETOOTH, /* 29 SONYPI_EVENT_BLUETOOTH_ON */ 319 KEY_BLUETOOTH, /* 30 SONYPI_EVENT_BLUETOOTH_OFF */ 320 KEY_HELP, /* 31 SONYPI_EVENT_HELP_PRESSED */ 321 KEY_FN, /* 32 SONYPI_EVENT_FNKEY_ONLY */ 322 KEY_RESERVED, /* 33 SONYPI_EVENT_JOGDIAL_FAST_DOWN */ 323 KEY_RESERVED, /* 34 SONYPI_EVENT_JOGDIAL_FAST_UP */ 324 KEY_RESERVED, /* 35 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */ 325 KEY_RESERVED, /* 36 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */ 326 KEY_RESERVED, /* 37 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */ 327 KEY_RESERVED, /* 38 SONYPI_EVENT_JOGDIAL_VFAST_UP */ 328 KEY_RESERVED, /* 39 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */ 329 KEY_RESERVED, /* 40 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */ 330 KEY_ZOOM, /* 41 SONYPI_EVENT_ZOOM_PRESSED */ 331 BTN_THUMB, /* 42 SONYPI_EVENT_THUMBPHRASE_PRESSED */ 332 KEY_RESERVED, /* 43 SONYPI_EVENT_MEYE_FACE */ 333 KEY_RESERVED, /* 44 SONYPI_EVENT_MEYE_OPPOSITE */ 334 KEY_RESERVED, /* 45 SONYPI_EVENT_MEMORYSTICK_INSERT */ 335 KEY_RESERVED, /* 46 SONYPI_EVENT_MEMORYSTICK_EJECT */ 336 KEY_WLAN, /* 47 SONYPI_EVENT_WIRELESS_ON */ 337 KEY_WLAN, /* 48 SONYPI_EVENT_WIRELESS_OFF */ 338 KEY_ZOOMIN, /* 49 SONYPI_EVENT_ZOOM_IN_PRESSED */ 339 KEY_ZOOMOUT, /* 50 SONYPI_EVENT_ZOOM_OUT_PRESSED */ 340 KEY_EJECTCD, /* 51 SONYPI_EVENT_CD_EJECT_PRESSED */ 341 KEY_F13, /* 52 SONYPI_EVENT_MODEKEY_PRESSED */ 342 KEY_PROG4, /* 53 SONYPI_EVENT_PKEY_P4 */ 343 KEY_F14, /* 54 SONYPI_EVENT_PKEY_P5 */ 344 KEY_F15, /* 55 SONYPI_EVENT_SETTINGKEY_PRESSED */ 345 KEY_VOLUMEUP, /* 56 SONYPI_EVENT_VOLUME_INC_PRESSED */ 346 KEY_VOLUMEDOWN, /* 57 SONYPI_EVENT_VOLUME_DEC_PRESSED */ 347 KEY_MEDIA, /* 58 SONYPI_EVENT_MEDIA_PRESSED */ 348 KEY_VENDOR, /* 59 SONYPI_EVENT_VENDOR_PRESSED */ 349 }; 350 351 /* release buttons after a short delay if pressed */ 352 static void do_sony_laptop_release_key(struct timer_list *unused) 353 { 354 struct sony_laptop_keypress kp; 355 unsigned long flags; 356 357 spin_lock_irqsave(&sony_laptop_input.fifo_lock, flags); 358 359 if (kfifo_out(&sony_laptop_input.fifo, 360 (unsigned char *)&kp, sizeof(kp)) == sizeof(kp)) { 361 input_report_key(kp.dev, kp.key, 0); 362 input_sync(kp.dev); 363 } 364 365 /* If there is something in the fifo schedule next release. */ 366 if (kfifo_len(&sony_laptop_input.fifo) != 0) 367 mod_timer(&sony_laptop_input.release_key_timer, 368 jiffies + msecs_to_jiffies(10)); 369 370 spin_unlock_irqrestore(&sony_laptop_input.fifo_lock, flags); 371 } 372 373 /* forward event to the input subsystem */ 374 static void sony_laptop_report_input_event(u8 event) 375 { 376 struct input_dev *jog_dev = sony_laptop_input.jog_dev; 377 struct input_dev *key_dev = sony_laptop_input.key_dev; 378 struct sony_laptop_keypress kp = { NULL }; 379 int scancode = -1; 380 381 if (event == SONYPI_EVENT_FNKEY_RELEASED || 382 event == SONYPI_EVENT_ANYBUTTON_RELEASED) { 383 /* Nothing, not all VAIOs generate this event */ 384 return; 385 } 386 387 /* report events */ 388 switch (event) { 389 /* jog_dev events */ 390 case SONYPI_EVENT_JOGDIAL_UP: 391 case SONYPI_EVENT_JOGDIAL_UP_PRESSED: 392 input_report_rel(jog_dev, REL_WHEEL, 1); 393 input_sync(jog_dev); 394 return; 395 396 case SONYPI_EVENT_JOGDIAL_DOWN: 397 case SONYPI_EVENT_JOGDIAL_DOWN_PRESSED: 398 input_report_rel(jog_dev, REL_WHEEL, -1); 399 input_sync(jog_dev); 400 return; 401 402 /* key_dev events */ 403 case SONYPI_EVENT_JOGDIAL_PRESSED: 404 kp.key = BTN_MIDDLE; 405 kp.dev = jog_dev; 406 break; 407 408 default: 409 if (event >= ARRAY_SIZE(sony_laptop_input_index)) { 410 dprintk("sony_laptop_report_input_event, event not known: %d\n", event); 411 break; 412 } 413 if ((scancode = sony_laptop_input_index[event]) != -1) { 414 kp.key = sony_laptop_input_keycode_map[scancode]; 415 if (kp.key != KEY_UNKNOWN) 416 kp.dev = key_dev; 417 } 418 break; 419 } 420 421 if (kp.dev) { 422 /* if we have a scancode we emit it so we can always 423 remap the key */ 424 if (scancode != -1) 425 input_event(kp.dev, EV_MSC, MSC_SCAN, scancode); 426 input_report_key(kp.dev, kp.key, 1); 427 input_sync(kp.dev); 428 429 /* schedule key release */ 430 kfifo_in_locked(&sony_laptop_input.fifo, 431 (unsigned char *)&kp, sizeof(kp), 432 &sony_laptop_input.fifo_lock); 433 mod_timer(&sony_laptop_input.release_key_timer, 434 jiffies + msecs_to_jiffies(10)); 435 } else 436 dprintk("unknown input event %.2x\n", event); 437 } 438 439 static int sony_laptop_setup_input(struct acpi_device *acpi_device) 440 { 441 struct input_dev *jog_dev; 442 struct input_dev *key_dev; 443 int i; 444 int error; 445 446 /* don't run again if already initialized */ 447 if (atomic_add_return(1, &sony_laptop_input.users) > 1) 448 return 0; 449 450 /* kfifo */ 451 spin_lock_init(&sony_laptop_input.fifo_lock); 452 error = kfifo_alloc(&sony_laptop_input.fifo, 453 SONY_LAPTOP_BUF_SIZE, GFP_KERNEL); 454 if (error) { 455 pr_err("kfifo_alloc failed\n"); 456 goto err_dec_users; 457 } 458 459 timer_setup(&sony_laptop_input.release_key_timer, 460 do_sony_laptop_release_key, 0); 461 462 /* input keys */ 463 key_dev = input_allocate_device(); 464 if (!key_dev) { 465 error = -ENOMEM; 466 goto err_free_kfifo; 467 } 468 469 key_dev->name = "Sony Vaio Keys"; 470 key_dev->id.bustype = BUS_ISA; 471 key_dev->id.vendor = PCI_VENDOR_ID_SONY; 472 key_dev->dev.parent = &acpi_device->dev; 473 474 /* Initialize the Input Drivers: special keys */ 475 input_set_capability(key_dev, EV_MSC, MSC_SCAN); 476 477 __set_bit(EV_KEY, key_dev->evbit); 478 key_dev->keycodesize = sizeof(sony_laptop_input_keycode_map[0]); 479 key_dev->keycodemax = ARRAY_SIZE(sony_laptop_input_keycode_map); 480 key_dev->keycode = &sony_laptop_input_keycode_map; 481 for (i = 0; i < ARRAY_SIZE(sony_laptop_input_keycode_map); i++) 482 __set_bit(sony_laptop_input_keycode_map[i], key_dev->keybit); 483 __clear_bit(KEY_RESERVED, key_dev->keybit); 484 485 error = input_register_device(key_dev); 486 if (error) 487 goto err_free_keydev; 488 489 sony_laptop_input.key_dev = key_dev; 490 491 /* jogdial */ 492 jog_dev = input_allocate_device(); 493 if (!jog_dev) { 494 error = -ENOMEM; 495 goto err_unregister_keydev; 496 } 497 498 jog_dev->name = "Sony Vaio Jogdial"; 499 jog_dev->id.bustype = BUS_ISA; 500 jog_dev->id.vendor = PCI_VENDOR_ID_SONY; 501 jog_dev->dev.parent = &acpi_device->dev; 502 503 input_set_capability(jog_dev, EV_KEY, BTN_MIDDLE); 504 input_set_capability(jog_dev, EV_REL, REL_WHEEL); 505 506 error = input_register_device(jog_dev); 507 if (error) 508 goto err_free_jogdev; 509 510 sony_laptop_input.jog_dev = jog_dev; 511 512 return 0; 513 514 err_free_jogdev: 515 input_free_device(jog_dev); 516 517 err_unregister_keydev: 518 input_unregister_device(key_dev); 519 /* to avoid kref underflow below at input_free_device */ 520 key_dev = NULL; 521 522 err_free_keydev: 523 input_free_device(key_dev); 524 525 err_free_kfifo: 526 kfifo_free(&sony_laptop_input.fifo); 527 528 err_dec_users: 529 atomic_dec(&sony_laptop_input.users); 530 return error; 531 } 532 533 static void sony_laptop_remove_input(void) 534 { 535 struct sony_laptop_keypress kp = { NULL }; 536 537 /* Cleanup only after the last user has gone */ 538 if (!atomic_dec_and_test(&sony_laptop_input.users)) 539 return; 540 541 del_timer_sync(&sony_laptop_input.release_key_timer); 542 543 /* 544 * Generate key-up events for remaining keys. Note that we don't 545 * need locking since nobody is adding new events to the kfifo. 546 */ 547 while (kfifo_out(&sony_laptop_input.fifo, 548 (unsigned char *)&kp, sizeof(kp)) == sizeof(kp)) { 549 input_report_key(kp.dev, kp.key, 0); 550 input_sync(kp.dev); 551 } 552 553 /* destroy input devs */ 554 input_unregister_device(sony_laptop_input.key_dev); 555 sony_laptop_input.key_dev = NULL; 556 557 if (sony_laptop_input.jog_dev) { 558 input_unregister_device(sony_laptop_input.jog_dev); 559 sony_laptop_input.jog_dev = NULL; 560 } 561 562 kfifo_free(&sony_laptop_input.fifo); 563 } 564 565 /*********** Platform Device ***********/ 566 567 static atomic_t sony_pf_users = ATOMIC_INIT(0); 568 static struct platform_driver sony_pf_driver = { 569 .driver = { 570 .name = "sony-laptop", 571 } 572 }; 573 static struct platform_device *sony_pf_device; 574 575 static int sony_pf_add(void) 576 { 577 int ret = 0; 578 579 /* don't run again if already initialized */ 580 if (atomic_add_return(1, &sony_pf_users) > 1) 581 return 0; 582 583 ret = platform_driver_register(&sony_pf_driver); 584 if (ret) 585 goto out; 586 587 sony_pf_device = platform_device_alloc("sony-laptop", PLATFORM_DEVID_NONE); 588 if (!sony_pf_device) { 589 ret = -ENOMEM; 590 goto out_platform_registered; 591 } 592 593 ret = platform_device_add(sony_pf_device); 594 if (ret) 595 goto out_platform_alloced; 596 597 return 0; 598 599 out_platform_alloced: 600 platform_device_put(sony_pf_device); 601 sony_pf_device = NULL; 602 out_platform_registered: 603 platform_driver_unregister(&sony_pf_driver); 604 out: 605 atomic_dec(&sony_pf_users); 606 return ret; 607 } 608 609 static void sony_pf_remove(void) 610 { 611 /* deregister only after the last user has gone */ 612 if (!atomic_dec_and_test(&sony_pf_users)) 613 return; 614 615 platform_device_unregister(sony_pf_device); 616 platform_driver_unregister(&sony_pf_driver); 617 } 618 619 /*********** SNC (SNY5001) Device ***********/ 620 621 /* the device uses 1-based values, while the backlight subsystem uses 622 0-based values */ 623 #define SONY_MAX_BRIGHTNESS 8 624 625 #define SNC_VALIDATE_IN 0 626 #define SNC_VALIDATE_OUT 1 627 628 static ssize_t sony_nc_sysfs_show(struct device *, struct device_attribute *, 629 char *); 630 static ssize_t sony_nc_sysfs_store(struct device *, struct device_attribute *, 631 const char *, size_t); 632 static int boolean_validate(const int, const int); 633 static int brightness_default_validate(const int, const int); 634 635 struct sony_nc_value { 636 char *name; /* name of the entry */ 637 char **acpiget; /* names of the ACPI get function */ 638 char **acpiset; /* names of the ACPI set function */ 639 int (*validate)(const int, const int); /* input/output validation */ 640 int value; /* current setting */ 641 int valid; /* Has ever been set */ 642 int debug; /* active only in debug mode ? */ 643 struct device_attribute devattr; /* sysfs attribute */ 644 }; 645 646 #define SNC_HANDLE_NAMES(_name, _values...) \ 647 static char *snc_##_name[] = { _values, NULL } 648 649 #define SNC_HANDLE(_name, _getters, _setters, _validate, _debug) \ 650 { \ 651 .name = __stringify(_name), \ 652 .acpiget = _getters, \ 653 .acpiset = _setters, \ 654 .validate = _validate, \ 655 .debug = _debug, \ 656 .devattr = __ATTR(_name, 0, sony_nc_sysfs_show, sony_nc_sysfs_store), \ 657 } 658 659 #define SNC_HANDLE_NULL { .name = NULL } 660 661 SNC_HANDLE_NAMES(fnkey_get, "GHKE"); 662 663 SNC_HANDLE_NAMES(brightness_def_get, "GPBR"); 664 SNC_HANDLE_NAMES(brightness_def_set, "SPBR"); 665 666 SNC_HANDLE_NAMES(cdpower_get, "GCDP"); 667 SNC_HANDLE_NAMES(cdpower_set, "SCDP", "CDPW"); 668 669 SNC_HANDLE_NAMES(audiopower_get, "GAZP"); 670 SNC_HANDLE_NAMES(audiopower_set, "AZPW"); 671 672 SNC_HANDLE_NAMES(lanpower_get, "GLNP"); 673 SNC_HANDLE_NAMES(lanpower_set, "LNPW"); 674 675 SNC_HANDLE_NAMES(lidstate_get, "GLID"); 676 677 SNC_HANDLE_NAMES(indicatorlamp_get, "GILS"); 678 SNC_HANDLE_NAMES(indicatorlamp_set, "SILS"); 679 680 SNC_HANDLE_NAMES(gainbass_get, "GMGB"); 681 SNC_HANDLE_NAMES(gainbass_set, "CMGB"); 682 683 SNC_HANDLE_NAMES(PID_get, "GPID"); 684 685 SNC_HANDLE_NAMES(CTR_get, "GCTR"); 686 SNC_HANDLE_NAMES(CTR_set, "SCTR"); 687 688 SNC_HANDLE_NAMES(PCR_get, "GPCR"); 689 SNC_HANDLE_NAMES(PCR_set, "SPCR"); 690 691 SNC_HANDLE_NAMES(CMI_get, "GCMI"); 692 SNC_HANDLE_NAMES(CMI_set, "SCMI"); 693 694 static struct sony_nc_value sony_nc_values[] = { 695 SNC_HANDLE(brightness_default, snc_brightness_def_get, 696 snc_brightness_def_set, brightness_default_validate, 0), 697 SNC_HANDLE(fnkey, snc_fnkey_get, NULL, NULL, 0), 698 SNC_HANDLE(cdpower, snc_cdpower_get, snc_cdpower_set, boolean_validate, 0), 699 SNC_HANDLE(audiopower, snc_audiopower_get, snc_audiopower_set, 700 boolean_validate, 0), 701 SNC_HANDLE(lanpower, snc_lanpower_get, snc_lanpower_set, 702 boolean_validate, 1), 703 SNC_HANDLE(lidstate, snc_lidstate_get, NULL, 704 boolean_validate, 0), 705 SNC_HANDLE(indicatorlamp, snc_indicatorlamp_get, snc_indicatorlamp_set, 706 boolean_validate, 0), 707 SNC_HANDLE(gainbass, snc_gainbass_get, snc_gainbass_set, 708 boolean_validate, 0), 709 /* unknown methods */ 710 SNC_HANDLE(PID, snc_PID_get, NULL, NULL, 1), 711 SNC_HANDLE(CTR, snc_CTR_get, snc_CTR_set, NULL, 1), 712 SNC_HANDLE(PCR, snc_PCR_get, snc_PCR_set, NULL, 1), 713 SNC_HANDLE(CMI, snc_CMI_get, snc_CMI_set, NULL, 1), 714 SNC_HANDLE_NULL 715 }; 716 717 static acpi_handle sony_nc_acpi_handle; 718 static struct acpi_device *sony_nc_acpi_device = NULL; 719 720 /* 721 * acpi_evaluate_object wrappers 722 * all useful calls into SNC methods take one or zero parameters and return 723 * integers or arrays. 724 */ 725 static union acpi_object *__call_snc_method(acpi_handle handle, char *method, 726 u64 *value) 727 { 728 union acpi_object *result = NULL; 729 struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL }; 730 acpi_status status; 731 732 if (value) { 733 struct acpi_object_list params; 734 union acpi_object in; 735 in.type = ACPI_TYPE_INTEGER; 736 in.integer.value = *value; 737 params.count = 1; 738 params.pointer = ∈ 739 status = acpi_evaluate_object(handle, method, ¶ms, &output); 740 dprintk("__call_snc_method: [%s:0x%.8x%.8x]\n", method, 741 (unsigned int)(*value >> 32), 742 (unsigned int)*value & 0xffffffff); 743 } else { 744 status = acpi_evaluate_object(handle, method, NULL, &output); 745 dprintk("__call_snc_method: [%s]\n", method); 746 } 747 748 if (ACPI_FAILURE(status)) { 749 pr_err("Failed to evaluate [%s]\n", method); 750 return NULL; 751 } 752 753 result = (union acpi_object *) output.pointer; 754 if (!result) 755 dprintk("No return object [%s]\n", method); 756 757 return result; 758 } 759 760 #define MIN(a, b) (a > b ? b : a) 761 static int sony_nc_buffer_call(acpi_handle handle, char *name, u64 *value, 762 void *buffer, size_t buflen) 763 { 764 int ret = 0; 765 size_t len; 766 union acpi_object *object = __call_snc_method(handle, name, value); 767 768 if (!object) 769 return -EINVAL; 770 771 if (!buffer) { 772 /* do nothing */ 773 } else if (object->type == ACPI_TYPE_BUFFER) { 774 len = MIN(buflen, object->buffer.length); 775 memset(buffer, 0, buflen); 776 memcpy(buffer, object->buffer.pointer, len); 777 778 } else if (object->type == ACPI_TYPE_INTEGER) { 779 len = MIN(buflen, sizeof(object->integer.value)); 780 memset(buffer, 0, buflen); 781 memcpy(buffer, &object->integer.value, len); 782 783 } else { 784 pr_warn("Unexpected acpi_object: 0x%x\n", object->type); 785 ret = -EINVAL; 786 } 787 788 kfree(object); 789 return ret; 790 } 791 792 static int sony_nc_int_call(acpi_handle handle, char *name, int *value, int 793 *result) 794 { 795 int ret; 796 797 if (value) { 798 u64 v = *value; 799 800 ret = sony_nc_buffer_call(handle, name, &v, result, 801 sizeof(*result)); 802 } else { 803 ret = sony_nc_buffer_call(handle, name, NULL, result, 804 sizeof(*result)); 805 } 806 return ret; 807 } 808 809 struct sony_nc_handles { 810 u16 cap[0x10]; 811 struct device_attribute devattr; 812 }; 813 814 static struct sony_nc_handles *handles; 815 816 static ssize_t sony_nc_handles_show(struct device *dev, 817 struct device_attribute *attr, char *buffer) 818 { 819 ssize_t len = 0; 820 int i; 821 822 for (i = 0; i < ARRAY_SIZE(handles->cap); i++) { 823 len += sysfs_emit_at(buffer, len, "0x%.4x ", handles->cap[i]); 824 } 825 len += sysfs_emit_at(buffer, len, "\n"); 826 827 return len; 828 } 829 830 static int sony_nc_handles_setup(struct platform_device *pd) 831 { 832 int i, r, result, arg; 833 834 handles = kzalloc(sizeof(*handles), GFP_KERNEL); 835 if (!handles) 836 return -ENOMEM; 837 838 for (i = 0; i < ARRAY_SIZE(handles->cap); i++) { 839 arg = i + 0x20; 840 r = sony_nc_int_call(sony_nc_acpi_handle, "SN00", &arg, 841 &result); 842 if (!r) { 843 dprintk("caching handle 0x%.4x (offset: 0x%.2x)\n", 844 result, i); 845 handles->cap[i] = result; 846 } 847 } 848 849 if (debug) { 850 sysfs_attr_init(&handles->devattr.attr); 851 handles->devattr.attr.name = "handles"; 852 handles->devattr.attr.mode = S_IRUGO; 853 handles->devattr.show = sony_nc_handles_show; 854 855 /* allow reading capabilities via sysfs */ 856 if (device_create_file(&pd->dev, &handles->devattr)) { 857 kfree(handles); 858 handles = NULL; 859 return -1; 860 } 861 } 862 863 return 0; 864 } 865 866 static int sony_nc_handles_cleanup(struct platform_device *pd) 867 { 868 if (handles) { 869 if (debug) 870 device_remove_file(&pd->dev, &handles->devattr); 871 kfree(handles); 872 handles = NULL; 873 } 874 return 0; 875 } 876 877 static int sony_find_snc_handle(int handle) 878 { 879 int i; 880 881 /* not initialized yet, return early */ 882 if (!handles || !handle) 883 return -EINVAL; 884 885 for (i = 0; i < 0x10; i++) { 886 if (handles->cap[i] == handle) { 887 dprintk("found handle 0x%.4x (offset: 0x%.2x)\n", 888 handle, i); 889 return i; 890 } 891 } 892 dprintk("handle 0x%.4x not found\n", handle); 893 return -EINVAL; 894 } 895 896 static int sony_call_snc_handle(int handle, int argument, int *result) 897 { 898 int arg, ret = 0; 899 int offset = sony_find_snc_handle(handle); 900 901 if (offset < 0) 902 return offset; 903 904 arg = offset | argument; 905 ret = sony_nc_int_call(sony_nc_acpi_handle, "SN07", &arg, result); 906 dprintk("called SN07 with 0x%.4x (result: 0x%.4x)\n", arg, *result); 907 return ret; 908 } 909 910 /* 911 * sony_nc_values input/output validate functions 912 */ 913 914 /* brightness_default_validate: 915 * 916 * manipulate input output values to keep consistency with the 917 * backlight framework for which brightness values are 0-based. 918 */ 919 static int brightness_default_validate(const int direction, const int value) 920 { 921 switch (direction) { 922 case SNC_VALIDATE_OUT: 923 return value - 1; 924 case SNC_VALIDATE_IN: 925 if (value >= 0 && value < SONY_MAX_BRIGHTNESS) 926 return value + 1; 927 } 928 return -EINVAL; 929 } 930 931 /* boolean_validate: 932 * 933 * on input validate boolean values 0/1, on output just pass the 934 * received value. 935 */ 936 static int boolean_validate(const int direction, const int value) 937 { 938 if (direction == SNC_VALIDATE_IN) { 939 if (value != 0 && value != 1) 940 return -EINVAL; 941 } 942 return value; 943 } 944 945 /* 946 * Sysfs show/store common to all sony_nc_values 947 */ 948 static ssize_t sony_nc_sysfs_show(struct device *dev, struct device_attribute *attr, 949 char *buffer) 950 { 951 int value, ret = 0; 952 struct sony_nc_value *item = 953 container_of(attr, struct sony_nc_value, devattr); 954 955 if (!*item->acpiget) 956 return -EIO; 957 958 ret = sony_nc_int_call(sony_nc_acpi_handle, *item->acpiget, NULL, 959 &value); 960 if (ret < 0) 961 return -EIO; 962 963 if (item->validate) 964 value = item->validate(SNC_VALIDATE_OUT, value); 965 966 return sysfs_emit(buffer, "%d\n", value); 967 } 968 969 static ssize_t sony_nc_sysfs_store(struct device *dev, 970 struct device_attribute *attr, 971 const char *buffer, size_t count) 972 { 973 int value; 974 int ret = 0; 975 struct sony_nc_value *item = 976 container_of(attr, struct sony_nc_value, devattr); 977 978 if (!item->acpiset) 979 return -EIO; 980 981 if (count > 31) 982 return -EINVAL; 983 984 if (kstrtoint(buffer, 10, &value)) 985 return -EINVAL; 986 987 if (item->validate) 988 value = item->validate(SNC_VALIDATE_IN, value); 989 990 if (value < 0) 991 return value; 992 993 ret = sony_nc_int_call(sony_nc_acpi_handle, *item->acpiset, 994 &value, NULL); 995 if (ret < 0) 996 return -EIO; 997 998 item->value = value; 999 item->valid = 1; 1000 return count; 1001 } 1002 1003 1004 /* 1005 * Backlight device 1006 */ 1007 struct sony_backlight_props { 1008 struct backlight_device *dev; 1009 int handle; 1010 int cmd_base; 1011 u8 offset; 1012 u8 maxlvl; 1013 }; 1014 static struct sony_backlight_props sony_bl_props; 1015 1016 static int sony_backlight_update_status(struct backlight_device *bd) 1017 { 1018 int arg = bd->props.brightness + 1; 1019 return sony_nc_int_call(sony_nc_acpi_handle, "SBRT", &arg, NULL); 1020 } 1021 1022 static int sony_backlight_get_brightness(struct backlight_device *bd) 1023 { 1024 int value; 1025 1026 if (sony_nc_int_call(sony_nc_acpi_handle, "GBRT", NULL, &value)) 1027 return 0; 1028 /* brightness levels are 1-based, while backlight ones are 0-based */ 1029 return value - 1; 1030 } 1031 1032 static int sony_nc_get_brightness_ng(struct backlight_device *bd) 1033 { 1034 int result; 1035 struct sony_backlight_props *sdev = 1036 (struct sony_backlight_props *)bl_get_data(bd); 1037 1038 sony_call_snc_handle(sdev->handle, sdev->cmd_base + 0x100, &result); 1039 1040 return (result & 0xff) - sdev->offset; 1041 } 1042 1043 static int sony_nc_update_status_ng(struct backlight_device *bd) 1044 { 1045 int value, result; 1046 struct sony_backlight_props *sdev = 1047 (struct sony_backlight_props *)bl_get_data(bd); 1048 1049 value = bd->props.brightness + sdev->offset; 1050 if (sony_call_snc_handle(sdev->handle, sdev->cmd_base | (value << 0x10), 1051 &result)) 1052 return -EIO; 1053 1054 return value; 1055 } 1056 1057 static const struct backlight_ops sony_backlight_ops = { 1058 .options = BL_CORE_SUSPENDRESUME, 1059 .update_status = sony_backlight_update_status, 1060 .get_brightness = sony_backlight_get_brightness, 1061 }; 1062 static const struct backlight_ops sony_backlight_ng_ops = { 1063 .options = BL_CORE_SUSPENDRESUME, 1064 .update_status = sony_nc_update_status_ng, 1065 .get_brightness = sony_nc_get_brightness_ng, 1066 }; 1067 1068 /* 1069 * New SNC-only Vaios event mapping to driver known keys 1070 */ 1071 struct sony_nc_event { 1072 u8 data; 1073 u8 event; 1074 }; 1075 1076 static struct sony_nc_event sony_100_events[] = { 1077 { 0x90, SONYPI_EVENT_PKEY_P1 }, 1078 { 0x10, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1079 { 0x91, SONYPI_EVENT_PKEY_P2 }, 1080 { 0x11, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1081 { 0x81, SONYPI_EVENT_FNKEY_F1 }, 1082 { 0x01, SONYPI_EVENT_FNKEY_RELEASED }, 1083 { 0x82, SONYPI_EVENT_FNKEY_F2 }, 1084 { 0x02, SONYPI_EVENT_FNKEY_RELEASED }, 1085 { 0x83, SONYPI_EVENT_FNKEY_F3 }, 1086 { 0x03, SONYPI_EVENT_FNKEY_RELEASED }, 1087 { 0x84, SONYPI_EVENT_FNKEY_F4 }, 1088 { 0x04, SONYPI_EVENT_FNKEY_RELEASED }, 1089 { 0x85, SONYPI_EVENT_FNKEY_F5 }, 1090 { 0x05, SONYPI_EVENT_FNKEY_RELEASED }, 1091 { 0x86, SONYPI_EVENT_FNKEY_F6 }, 1092 { 0x06, SONYPI_EVENT_FNKEY_RELEASED }, 1093 { 0x87, SONYPI_EVENT_FNKEY_F7 }, 1094 { 0x07, SONYPI_EVENT_FNKEY_RELEASED }, 1095 { 0x88, SONYPI_EVENT_FNKEY_F8 }, 1096 { 0x08, SONYPI_EVENT_FNKEY_RELEASED }, 1097 { 0x89, SONYPI_EVENT_FNKEY_F9 }, 1098 { 0x09, SONYPI_EVENT_FNKEY_RELEASED }, 1099 { 0x8A, SONYPI_EVENT_FNKEY_F10 }, 1100 { 0x0A, SONYPI_EVENT_FNKEY_RELEASED }, 1101 { 0x8B, SONYPI_EVENT_FNKEY_F11 }, 1102 { 0x0B, SONYPI_EVENT_FNKEY_RELEASED }, 1103 { 0x8C, SONYPI_EVENT_FNKEY_F12 }, 1104 { 0x0C, SONYPI_EVENT_FNKEY_RELEASED }, 1105 { 0x9d, SONYPI_EVENT_ZOOM_PRESSED }, 1106 { 0x1d, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1107 { 0x9f, SONYPI_EVENT_CD_EJECT_PRESSED }, 1108 { 0x1f, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1109 { 0xa1, SONYPI_EVENT_MEDIA_PRESSED }, 1110 { 0x21, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1111 { 0xa4, SONYPI_EVENT_CD_EJECT_PRESSED }, 1112 { 0x24, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1113 { 0xa5, SONYPI_EVENT_VENDOR_PRESSED }, 1114 { 0x25, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1115 { 0xa6, SONYPI_EVENT_HELP_PRESSED }, 1116 { 0x26, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1117 { 0xa8, SONYPI_EVENT_FNKEY_1 }, 1118 { 0x28, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1119 { 0, 0 }, 1120 }; 1121 1122 static struct sony_nc_event sony_127_events[] = { 1123 { 0x81, SONYPI_EVENT_MODEKEY_PRESSED }, 1124 { 0x01, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1125 { 0x82, SONYPI_EVENT_PKEY_P1 }, 1126 { 0x02, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1127 { 0x83, SONYPI_EVENT_PKEY_P2 }, 1128 { 0x03, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1129 { 0x84, SONYPI_EVENT_PKEY_P3 }, 1130 { 0x04, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1131 { 0x85, SONYPI_EVENT_PKEY_P4 }, 1132 { 0x05, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1133 { 0x86, SONYPI_EVENT_PKEY_P5 }, 1134 { 0x06, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1135 { 0x87, SONYPI_EVENT_SETTINGKEY_PRESSED }, 1136 { 0x07, SONYPI_EVENT_ANYBUTTON_RELEASED }, 1137 { 0, 0 }, 1138 }; 1139 1140 static int sony_nc_hotkeys_decode(u32 event, unsigned int handle) 1141 { 1142 int ret = -EINVAL; 1143 unsigned int result = 0; 1144 struct sony_nc_event *key_event; 1145 1146 if (sony_call_snc_handle(handle, 0x200, &result)) { 1147 dprintk("Unable to decode event 0x%.2x 0x%.2x\n", handle, 1148 event); 1149 return -EINVAL; 1150 } 1151 1152 result &= 0xFF; 1153 1154 if (handle == 0x0100) 1155 key_event = sony_100_events; 1156 else 1157 key_event = sony_127_events; 1158 1159 for (; key_event->data; key_event++) { 1160 if (key_event->data == result) { 1161 ret = key_event->event; 1162 break; 1163 } 1164 } 1165 1166 if (!key_event->data) 1167 pr_info("Unknown hotkey 0x%.2x/0x%.2x (handle 0x%.2x)\n", 1168 event, result, handle); 1169 1170 return ret; 1171 } 1172 1173 /* 1174 * ACPI callbacks 1175 */ 1176 enum event_types { 1177 HOTKEY = 1, 1178 KILLSWITCH, 1179 GFX_SWITCH 1180 }; 1181 static void sony_nc_notify(struct acpi_device *device, u32 event) 1182 { 1183 u32 real_ev = event; 1184 u8 ev_type = 0; 1185 int ret; 1186 1187 dprintk("sony_nc_notify, event: 0x%.2x\n", event); 1188 1189 if (event >= 0x90) { 1190 unsigned int result = 0; 1191 unsigned int arg = 0; 1192 unsigned int handle = 0; 1193 unsigned int offset = event - 0x90; 1194 1195 if (offset >= ARRAY_SIZE(handles->cap)) { 1196 pr_err("Event 0x%x outside of capabilities list\n", 1197 event); 1198 return; 1199 } 1200 handle = handles->cap[offset]; 1201 1202 /* list of handles known for generating events */ 1203 switch (handle) { 1204 /* hotkey event */ 1205 case 0x0100: 1206 case 0x0127: 1207 ev_type = HOTKEY; 1208 ret = sony_nc_hotkeys_decode(event, handle); 1209 1210 if (ret > 0) { 1211 sony_laptop_report_input_event(ret); 1212 real_ev = ret; 1213 } 1214 1215 break; 1216 1217 /* wlan switch */ 1218 case 0x0124: 1219 case 0x0135: 1220 /* events on this handle are reported when the 1221 * switch changes position or for battery 1222 * events. We'll notify both of them but only 1223 * update the rfkill device status when the 1224 * switch is moved. 1225 */ 1226 ev_type = KILLSWITCH; 1227 sony_call_snc_handle(handle, 0x0100, &result); 1228 real_ev = result & 0x03; 1229 1230 /* hw switch event */ 1231 if (real_ev == 1) 1232 sony_nc_rfkill_update(); 1233 1234 break; 1235 1236 case 0x0128: 1237 case 0x0146: 1238 /* Hybrid GFX switching */ 1239 sony_call_snc_handle(handle, 0x0000, &result); 1240 dprintk("GFX switch event received (reason: %s)\n", 1241 (result == 0x1) ? "switch change" : 1242 (result == 0x2) ? "output switch" : 1243 (result == 0x3) ? "output switch" : 1244 ""); 1245 1246 ev_type = GFX_SWITCH; 1247 real_ev = __sony_nc_gfx_switch_status_get(); 1248 break; 1249 1250 case 0x015B: 1251 /* Hybrid GFX switching SVS151290S */ 1252 ev_type = GFX_SWITCH; 1253 real_ev = __sony_nc_gfx_switch_status_get(); 1254 break; 1255 default: 1256 dprintk("Unknown event 0x%x for handle 0x%x\n", 1257 event, handle); 1258 break; 1259 } 1260 1261 /* clear the event (and the event reason when present) */ 1262 arg = 1 << offset; 1263 sony_nc_int_call(sony_nc_acpi_handle, "SN05", &arg, &result); 1264 1265 } else { 1266 /* old style event */ 1267 ev_type = HOTKEY; 1268 sony_laptop_report_input_event(real_ev); 1269 } 1270 acpi_bus_generate_netlink_event(sony_nc_acpi_device->pnp.device_class, 1271 dev_name(&sony_nc_acpi_device->dev), ev_type, real_ev); 1272 } 1273 1274 static acpi_status sony_walk_callback(acpi_handle handle, u32 level, 1275 void *context, void **return_value) 1276 { 1277 struct acpi_device_info *info; 1278 1279 if (ACPI_SUCCESS(acpi_get_object_info(handle, &info))) { 1280 pr_warn("method: name: %4.4s, args %X\n", 1281 (char *)&info->name, info->param_count); 1282 1283 kfree(info); 1284 } 1285 1286 return AE_OK; 1287 } 1288 1289 /* 1290 * ACPI device 1291 */ 1292 static void sony_nc_function_setup(struct acpi_device *device, 1293 struct platform_device *pf_device) 1294 { 1295 unsigned int i, result, bitmask, arg; 1296 1297 if (!handles) 1298 return; 1299 1300 /* setup found handles here */ 1301 for (i = 0; i < ARRAY_SIZE(handles->cap); i++) { 1302 unsigned int handle = handles->cap[i]; 1303 1304 if (!handle) 1305 continue; 1306 1307 dprintk("setting up handle 0x%.4x\n", handle); 1308 1309 switch (handle) { 1310 case 0x0100: 1311 case 0x0101: 1312 case 0x0127: 1313 /* setup hotkeys */ 1314 sony_call_snc_handle(handle, 0, &result); 1315 break; 1316 case 0x0102: 1317 /* setup hotkeys */ 1318 sony_call_snc_handle(handle, 0x100, &result); 1319 break; 1320 case 0x0105: 1321 case 0x0148: 1322 /* touchpad enable/disable */ 1323 result = sony_nc_touchpad_setup(pf_device, handle); 1324 if (result) 1325 pr_err("couldn't set up touchpad control function (%d)\n", 1326 result); 1327 break; 1328 case 0x0115: 1329 case 0x0136: 1330 case 0x013f: 1331 result = sony_nc_battery_care_setup(pf_device, handle); 1332 if (result) 1333 pr_err("couldn't set up battery care function (%d)\n", 1334 result); 1335 break; 1336 case 0x0119: 1337 case 0x015D: 1338 result = sony_nc_lid_resume_setup(pf_device, handle); 1339 if (result) 1340 pr_err("couldn't set up lid resume function (%d)\n", 1341 result); 1342 break; 1343 case 0x0122: 1344 result = sony_nc_thermal_setup(pf_device); 1345 if (result) 1346 pr_err("couldn't set up thermal profile function (%d)\n", 1347 result); 1348 break; 1349 case 0x0128: 1350 case 0x0146: 1351 case 0x015B: 1352 result = sony_nc_gfx_switch_setup(pf_device, handle); 1353 if (result) 1354 pr_err("couldn't set up GFX Switch status (%d)\n", 1355 result); 1356 break; 1357 case 0x0131: 1358 result = sony_nc_highspeed_charging_setup(pf_device); 1359 if (result) 1360 pr_err("couldn't set up high speed charging function (%d)\n", 1361 result); 1362 break; 1363 case 0x0124: 1364 case 0x0135: 1365 result = sony_nc_rfkill_setup(device, handle); 1366 if (result) 1367 pr_err("couldn't set up rfkill support (%d)\n", 1368 result); 1369 break; 1370 case 0x0137: 1371 case 0x0143: 1372 case 0x014b: 1373 case 0x014c: 1374 case 0x0153: 1375 case 0x0163: 1376 result = sony_nc_kbd_backlight_setup(pf_device, handle); 1377 if (result) 1378 pr_err("couldn't set up keyboard backlight function (%d)\n", 1379 result); 1380 break; 1381 case 0x0121: 1382 result = sony_nc_lowbatt_setup(pf_device); 1383 if (result) 1384 pr_err("couldn't set up low battery function (%d)\n", 1385 result); 1386 break; 1387 case 0x0149: 1388 result = sony_nc_fanspeed_setup(pf_device); 1389 if (result) 1390 pr_err("couldn't set up fan speed function (%d)\n", 1391 result); 1392 break; 1393 case 0x0155: 1394 result = sony_nc_usb_charge_setup(pf_device); 1395 if (result) 1396 pr_err("couldn't set up USB charge support (%d)\n", 1397 result); 1398 break; 1399 case 0x011D: 1400 result = sony_nc_panelid_setup(pf_device); 1401 if (result) 1402 pr_err("couldn't set up panel ID function (%d)\n", 1403 result); 1404 break; 1405 case 0x0168: 1406 result = sony_nc_smart_conn_setup(pf_device); 1407 if (result) 1408 pr_err("couldn't set up smart connect support (%d)\n", 1409 result); 1410 break; 1411 default: 1412 continue; 1413 } 1414 } 1415 1416 /* Enable all events */ 1417 arg = 0x10; 1418 if (!sony_nc_int_call(sony_nc_acpi_handle, "SN00", &arg, &bitmask)) 1419 sony_nc_int_call(sony_nc_acpi_handle, "SN02", &bitmask, 1420 &result); 1421 } 1422 1423 static void sony_nc_function_cleanup(struct platform_device *pd) 1424 { 1425 unsigned int i, result, bitmask, handle; 1426 1427 if (!handles) 1428 return; 1429 1430 /* get enabled events and disable them */ 1431 sony_nc_int_call(sony_nc_acpi_handle, "SN01", NULL, &bitmask); 1432 sony_nc_int_call(sony_nc_acpi_handle, "SN03", &bitmask, &result); 1433 1434 /* cleanup handles here */ 1435 for (i = 0; i < ARRAY_SIZE(handles->cap); i++) { 1436 1437 handle = handles->cap[i]; 1438 1439 if (!handle) 1440 continue; 1441 1442 switch (handle) { 1443 case 0x0105: 1444 case 0x0148: 1445 sony_nc_touchpad_cleanup(pd); 1446 break; 1447 case 0x0115: 1448 case 0x0136: 1449 case 0x013f: 1450 sony_nc_battery_care_cleanup(pd); 1451 break; 1452 case 0x0119: 1453 case 0x015D: 1454 sony_nc_lid_resume_cleanup(pd); 1455 break; 1456 case 0x0122: 1457 sony_nc_thermal_cleanup(pd); 1458 break; 1459 case 0x0128: 1460 case 0x0146: 1461 case 0x015B: 1462 sony_nc_gfx_switch_cleanup(pd); 1463 break; 1464 case 0x0131: 1465 sony_nc_highspeed_charging_cleanup(pd); 1466 break; 1467 case 0x0124: 1468 case 0x0135: 1469 sony_nc_rfkill_cleanup(); 1470 break; 1471 case 0x0137: 1472 case 0x0143: 1473 case 0x014b: 1474 case 0x014c: 1475 case 0x0153: 1476 case 0x0163: 1477 sony_nc_kbd_backlight_cleanup(pd, handle); 1478 break; 1479 case 0x0121: 1480 sony_nc_lowbatt_cleanup(pd); 1481 break; 1482 case 0x0149: 1483 sony_nc_fanspeed_cleanup(pd); 1484 break; 1485 case 0x0155: 1486 sony_nc_usb_charge_cleanup(pd); 1487 break; 1488 case 0x011D: 1489 sony_nc_panelid_cleanup(pd); 1490 break; 1491 case 0x0168: 1492 sony_nc_smart_conn_cleanup(pd); 1493 break; 1494 default: 1495 continue; 1496 } 1497 } 1498 1499 /* finally cleanup the handles list */ 1500 sony_nc_handles_cleanup(pd); 1501 } 1502 1503 #ifdef CONFIG_PM_SLEEP 1504 static void sony_nc_function_resume(void) 1505 { 1506 unsigned int i, result, bitmask, arg; 1507 1508 dprintk("Resuming SNC device\n"); 1509 1510 for (i = 0; i < ARRAY_SIZE(handles->cap); i++) { 1511 unsigned int handle = handles->cap[i]; 1512 1513 if (!handle) 1514 continue; 1515 1516 switch (handle) { 1517 case 0x0100: 1518 case 0x0101: 1519 case 0x0127: 1520 /* re-enable hotkeys */ 1521 sony_call_snc_handle(handle, 0, &result); 1522 break; 1523 case 0x0102: 1524 /* re-enable hotkeys */ 1525 sony_call_snc_handle(handle, 0x100, &result); 1526 break; 1527 case 0x0122: 1528 sony_nc_thermal_resume(); 1529 break; 1530 case 0x0124: 1531 case 0x0135: 1532 sony_nc_rfkill_update(); 1533 break; 1534 default: 1535 continue; 1536 } 1537 } 1538 1539 /* Enable all events */ 1540 arg = 0x10; 1541 if (!sony_nc_int_call(sony_nc_acpi_handle, "SN00", &arg, &bitmask)) 1542 sony_nc_int_call(sony_nc_acpi_handle, "SN02", &bitmask, 1543 &result); 1544 } 1545 1546 static int sony_nc_resume(struct device *dev) 1547 { 1548 struct sony_nc_value *item; 1549 1550 for (item = sony_nc_values; item->name; item++) { 1551 int ret; 1552 1553 if (!item->valid) 1554 continue; 1555 ret = sony_nc_int_call(sony_nc_acpi_handle, *item->acpiset, 1556 &item->value, NULL); 1557 if (ret < 0) { 1558 pr_err("%s: %d\n", __func__, ret); 1559 break; 1560 } 1561 } 1562 1563 if (acpi_has_method(sony_nc_acpi_handle, "ECON")) { 1564 int arg = 1; 1565 if (sony_nc_int_call(sony_nc_acpi_handle, "ECON", &arg, NULL)) 1566 dprintk("ECON Method failed\n"); 1567 } 1568 1569 if (acpi_has_method(sony_nc_acpi_handle, "SN00")) 1570 sony_nc_function_resume(); 1571 1572 return 0; 1573 } 1574 #endif 1575 1576 static SIMPLE_DEV_PM_OPS(sony_nc_pm, NULL, sony_nc_resume); 1577 1578 static void sony_nc_rfkill_cleanup(void) 1579 { 1580 int i; 1581 1582 for (i = 0; i < N_SONY_RFKILL; i++) { 1583 if (sony_rfkill_devices[i]) { 1584 rfkill_unregister(sony_rfkill_devices[i]); 1585 rfkill_destroy(sony_rfkill_devices[i]); 1586 } 1587 } 1588 } 1589 1590 static int sony_nc_rfkill_set(void *data, bool blocked) 1591 { 1592 int result; 1593 int argument = sony_rfkill_address[(long) data] + 0x100; 1594 1595 if (!blocked) 1596 argument |= 0x070000; 1597 1598 return sony_call_snc_handle(sony_rfkill_handle, argument, &result); 1599 } 1600 1601 static const struct rfkill_ops sony_rfkill_ops = { 1602 .set_block = sony_nc_rfkill_set, 1603 }; 1604 1605 static int sony_nc_setup_rfkill(struct acpi_device *device, 1606 enum sony_nc_rfkill nc_type) 1607 { 1608 int err; 1609 struct rfkill *rfk; 1610 enum rfkill_type type; 1611 const char *name; 1612 int result; 1613 bool hwblock, swblock; 1614 1615 switch (nc_type) { 1616 case SONY_WIFI: 1617 type = RFKILL_TYPE_WLAN; 1618 name = "sony-wifi"; 1619 break; 1620 case SONY_BLUETOOTH: 1621 type = RFKILL_TYPE_BLUETOOTH; 1622 name = "sony-bluetooth"; 1623 break; 1624 case SONY_WWAN: 1625 type = RFKILL_TYPE_WWAN; 1626 name = "sony-wwan"; 1627 break; 1628 case SONY_WIMAX: 1629 type = RFKILL_TYPE_WIMAX; 1630 name = "sony-wimax"; 1631 break; 1632 default: 1633 return -EINVAL; 1634 } 1635 1636 rfk = rfkill_alloc(name, &device->dev, type, 1637 &sony_rfkill_ops, (void *)nc_type); 1638 if (!rfk) 1639 return -ENOMEM; 1640 1641 err = sony_call_snc_handle(sony_rfkill_handle, 0x200, &result); 1642 if (err < 0) { 1643 rfkill_destroy(rfk); 1644 return err; 1645 } 1646 hwblock = !(result & 0x1); 1647 1648 err = sony_call_snc_handle(sony_rfkill_handle, 1649 sony_rfkill_address[nc_type], 1650 &result); 1651 if (err < 0) { 1652 rfkill_destroy(rfk); 1653 return err; 1654 } 1655 swblock = !(result & 0x2); 1656 1657 rfkill_init_sw_state(rfk, swblock); 1658 rfkill_set_hw_state(rfk, hwblock); 1659 1660 err = rfkill_register(rfk); 1661 if (err) { 1662 rfkill_destroy(rfk); 1663 return err; 1664 } 1665 sony_rfkill_devices[nc_type] = rfk; 1666 return err; 1667 } 1668 1669 static void sony_nc_rfkill_update(void) 1670 { 1671 enum sony_nc_rfkill i; 1672 int result; 1673 bool hwblock; 1674 1675 sony_call_snc_handle(sony_rfkill_handle, 0x200, &result); 1676 hwblock = !(result & 0x1); 1677 1678 for (i = 0; i < N_SONY_RFKILL; i++) { 1679 int argument = sony_rfkill_address[i]; 1680 1681 if (!sony_rfkill_devices[i]) 1682 continue; 1683 1684 if (hwblock) { 1685 if (rfkill_set_hw_state(sony_rfkill_devices[i], true)) { 1686 /* we already know we're blocked */ 1687 } 1688 continue; 1689 } 1690 1691 sony_call_snc_handle(sony_rfkill_handle, argument, &result); 1692 rfkill_set_states(sony_rfkill_devices[i], 1693 !(result & 0x2), false); 1694 } 1695 } 1696 1697 static int sony_nc_rfkill_setup(struct acpi_device *device, 1698 unsigned int handle) 1699 { 1700 u64 offset; 1701 int i; 1702 unsigned char buffer[32] = { 0 }; 1703 1704 offset = sony_find_snc_handle(handle); 1705 sony_rfkill_handle = handle; 1706 1707 i = sony_nc_buffer_call(sony_nc_acpi_handle, "SN06", &offset, buffer, 1708 32); 1709 if (i < 0) 1710 return i; 1711 1712 /* The buffer is filled with magic numbers describing the devices 1713 * available, 0xff terminates the enumeration. 1714 * Known codes: 1715 * 0x00 WLAN 1716 * 0x10 BLUETOOTH 1717 * 0x20 WWAN GPRS-EDGE 1718 * 0x21 WWAN HSDPA 1719 * 0x22 WWAN EV-DO 1720 * 0x23 WWAN GPS 1721 * 0x25 Gobi WWAN no GPS 1722 * 0x26 Gobi WWAN + GPS 1723 * 0x28 Gobi WWAN no GPS 1724 * 0x29 Gobi WWAN + GPS 1725 * 0x30 WIMAX 1726 * 0x50 Gobi WWAN no GPS 1727 * 0x51 Gobi WWAN + GPS 1728 * 0x70 no SIM card slot 1729 * 0x71 SIM card slot 1730 */ 1731 for (i = 0; i < ARRAY_SIZE(buffer); i++) { 1732 1733 if (buffer[i] == 0xff) 1734 break; 1735 1736 dprintk("Radio devices, found 0x%.2x\n", buffer[i]); 1737 1738 if (buffer[i] == 0 && !sony_rfkill_devices[SONY_WIFI]) 1739 sony_nc_setup_rfkill(device, SONY_WIFI); 1740 1741 if (buffer[i] == 0x10 && !sony_rfkill_devices[SONY_BLUETOOTH]) 1742 sony_nc_setup_rfkill(device, SONY_BLUETOOTH); 1743 1744 if (((0xf0 & buffer[i]) == 0x20 || 1745 (0xf0 & buffer[i]) == 0x50) && 1746 !sony_rfkill_devices[SONY_WWAN]) 1747 sony_nc_setup_rfkill(device, SONY_WWAN); 1748 1749 if (buffer[i] == 0x30 && !sony_rfkill_devices[SONY_WIMAX]) 1750 sony_nc_setup_rfkill(device, SONY_WIMAX); 1751 } 1752 return 0; 1753 } 1754 1755 /* Keyboard backlight feature */ 1756 struct kbd_backlight { 1757 unsigned int handle; 1758 unsigned int base; 1759 unsigned int mode; 1760 unsigned int timeout; 1761 unsigned int has_timeout; 1762 struct device_attribute mode_attr; 1763 struct device_attribute timeout_attr; 1764 }; 1765 1766 static struct kbd_backlight *kbdbl_ctl; 1767 1768 static ssize_t __sony_nc_kbd_backlight_mode_set(u8 value) 1769 { 1770 int result; 1771 1772 if (value > 2) 1773 return -EINVAL; 1774 1775 if (sony_call_snc_handle(kbdbl_ctl->handle, 1776 (value << 0x10) | (kbdbl_ctl->base), &result)) 1777 return -EIO; 1778 1779 /* Try to turn the light on/off immediately */ 1780 if (value != 1) 1781 sony_call_snc_handle(kbdbl_ctl->handle, 1782 (value << 0x0f) | (kbdbl_ctl->base + 0x100), 1783 &result); 1784 1785 kbdbl_ctl->mode = value; 1786 1787 return 0; 1788 } 1789 1790 static ssize_t sony_nc_kbd_backlight_mode_store(struct device *dev, 1791 struct device_attribute *attr, 1792 const char *buffer, size_t count) 1793 { 1794 int ret = 0; 1795 unsigned long value; 1796 1797 if (count > 31) 1798 return -EINVAL; 1799 1800 if (kstrtoul(buffer, 10, &value)) 1801 return -EINVAL; 1802 1803 ret = __sony_nc_kbd_backlight_mode_set(value); 1804 if (ret < 0) 1805 return ret; 1806 1807 return count; 1808 } 1809 1810 static ssize_t sony_nc_kbd_backlight_mode_show(struct device *dev, 1811 struct device_attribute *attr, char *buffer) 1812 { 1813 return sysfs_emit(buffer, "%d\n", kbdbl_ctl->mode); 1814 } 1815 1816 static int __sony_nc_kbd_backlight_timeout_set(u8 value) 1817 { 1818 int result; 1819 1820 if (value > 3) 1821 return -EINVAL; 1822 1823 if (sony_call_snc_handle(kbdbl_ctl->handle, (value << 0x10) | 1824 (kbdbl_ctl->base + 0x200), &result)) 1825 return -EIO; 1826 1827 kbdbl_ctl->timeout = value; 1828 1829 return 0; 1830 } 1831 1832 static ssize_t sony_nc_kbd_backlight_timeout_store(struct device *dev, 1833 struct device_attribute *attr, 1834 const char *buffer, size_t count) 1835 { 1836 int ret = 0; 1837 unsigned long value; 1838 1839 if (count > 31) 1840 return -EINVAL; 1841 1842 if (kstrtoul(buffer, 10, &value)) 1843 return -EINVAL; 1844 1845 ret = __sony_nc_kbd_backlight_timeout_set(value); 1846 if (ret < 0) 1847 return ret; 1848 1849 return count; 1850 } 1851 1852 static ssize_t sony_nc_kbd_backlight_timeout_show(struct device *dev, 1853 struct device_attribute *attr, char *buffer) 1854 { 1855 return sysfs_emit(buffer, "%d\n", kbdbl_ctl->timeout); 1856 } 1857 1858 static int sony_nc_kbd_backlight_setup(struct platform_device *pd, 1859 unsigned int handle) 1860 { 1861 int result; 1862 int probe_base = 0; 1863 int ctl_base = 0; 1864 int ret = 0; 1865 1866 if (kbdbl_ctl) { 1867 pr_warn("handle 0x%.4x: keyboard backlight setup already done for 0x%.4x\n", 1868 handle, kbdbl_ctl->handle); 1869 return -EBUSY; 1870 } 1871 1872 /* verify the kbd backlight presence, some of these handles are not used 1873 * for keyboard backlight only 1874 */ 1875 switch (handle) { 1876 case 0x0153: 1877 probe_base = 0x0; 1878 ctl_base = 0x0; 1879 break; 1880 case 0x0137: 1881 probe_base = 0x0B00; 1882 ctl_base = 0x0C00; 1883 break; 1884 default: 1885 probe_base = 0x0100; 1886 ctl_base = 0x4000; 1887 break; 1888 } 1889 1890 ret = sony_call_snc_handle(handle, probe_base, &result); 1891 if (ret) 1892 return ret; 1893 1894 if ((handle == 0x0137 && !(result & 0x02)) || 1895 !(result & 0x01)) { 1896 dprintk("no backlight keyboard found\n"); 1897 return 0; 1898 } 1899 1900 kbdbl_ctl = kzalloc(sizeof(*kbdbl_ctl), GFP_KERNEL); 1901 if (!kbdbl_ctl) 1902 return -ENOMEM; 1903 1904 kbdbl_ctl->mode = kbd_backlight; 1905 kbdbl_ctl->timeout = kbd_backlight_timeout; 1906 kbdbl_ctl->handle = handle; 1907 kbdbl_ctl->base = ctl_base; 1908 /* Some models do not allow timeout control */ 1909 kbdbl_ctl->has_timeout = handle != 0x0153; 1910 1911 sysfs_attr_init(&kbdbl_ctl->mode_attr.attr); 1912 kbdbl_ctl->mode_attr.attr.name = "kbd_backlight"; 1913 kbdbl_ctl->mode_attr.attr.mode = S_IRUGO | S_IWUSR; 1914 kbdbl_ctl->mode_attr.show = sony_nc_kbd_backlight_mode_show; 1915 kbdbl_ctl->mode_attr.store = sony_nc_kbd_backlight_mode_store; 1916 1917 ret = device_create_file(&pd->dev, &kbdbl_ctl->mode_attr); 1918 if (ret) 1919 goto outkzalloc; 1920 1921 __sony_nc_kbd_backlight_mode_set(kbdbl_ctl->mode); 1922 1923 if (kbdbl_ctl->has_timeout) { 1924 sysfs_attr_init(&kbdbl_ctl->timeout_attr.attr); 1925 kbdbl_ctl->timeout_attr.attr.name = "kbd_backlight_timeout"; 1926 kbdbl_ctl->timeout_attr.attr.mode = S_IRUGO | S_IWUSR; 1927 kbdbl_ctl->timeout_attr.show = 1928 sony_nc_kbd_backlight_timeout_show; 1929 kbdbl_ctl->timeout_attr.store = 1930 sony_nc_kbd_backlight_timeout_store; 1931 1932 ret = device_create_file(&pd->dev, &kbdbl_ctl->timeout_attr); 1933 if (ret) 1934 goto outmode; 1935 1936 __sony_nc_kbd_backlight_timeout_set(kbdbl_ctl->timeout); 1937 } 1938 1939 1940 return 0; 1941 1942 outmode: 1943 device_remove_file(&pd->dev, &kbdbl_ctl->mode_attr); 1944 outkzalloc: 1945 kfree(kbdbl_ctl); 1946 kbdbl_ctl = NULL; 1947 return ret; 1948 } 1949 1950 static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd, 1951 unsigned int handle) 1952 { 1953 if (kbdbl_ctl && handle == kbdbl_ctl->handle) { 1954 device_remove_file(&pd->dev, &kbdbl_ctl->mode_attr); 1955 if (kbdbl_ctl->has_timeout) 1956 device_remove_file(&pd->dev, &kbdbl_ctl->timeout_attr); 1957 kfree(kbdbl_ctl); 1958 kbdbl_ctl = NULL; 1959 } 1960 } 1961 1962 struct battery_care_control { 1963 struct device_attribute attrs[2]; 1964 unsigned int handle; 1965 }; 1966 static struct battery_care_control *bcare_ctl; 1967 1968 static ssize_t sony_nc_battery_care_limit_store(struct device *dev, 1969 struct device_attribute *attr, 1970 const char *buffer, size_t count) 1971 { 1972 unsigned int result, cmd; 1973 unsigned long value; 1974 1975 if (count > 31) 1976 return -EINVAL; 1977 1978 if (kstrtoul(buffer, 10, &value)) 1979 return -EINVAL; 1980 1981 /* limit values (2 bits): 1982 * 00 - none 1983 * 01 - 80% 1984 * 10 - 50% 1985 * 11 - 100% 1986 * 1987 * bit 0: 0 disable BCL, 1 enable BCL 1988 * bit 1: 1 tell to store the battery limit (see bits 6,7) too 1989 * bits 2,3: reserved 1990 * bits 4,5: store the limit into the EC 1991 * bits 6,7: store the limit into the battery 1992 */ 1993 cmd = 0; 1994 1995 if (value > 0) { 1996 if (value <= 50) 1997 cmd = 0x20; 1998 1999 else if (value <= 80) 2000 cmd = 0x10; 2001 2002 else if (value <= 100) 2003 cmd = 0x30; 2004 2005 else 2006 return -EINVAL; 2007 2008 /* 2009 * handle 0x0115 should allow storing on battery too; 2010 * handle 0x0136 same as 0x0115 + health status; 2011 * handle 0x013f, same as 0x0136 but no storing on the battery 2012 */ 2013 if (bcare_ctl->handle != 0x013f) 2014 cmd = cmd | (cmd << 2); 2015 2016 cmd = (cmd | 0x1) << 0x10; 2017 } 2018 2019 if (sony_call_snc_handle(bcare_ctl->handle, cmd | 0x0100, &result)) 2020 return -EIO; 2021 2022 return count; 2023 } 2024 2025 static ssize_t sony_nc_battery_care_limit_show(struct device *dev, 2026 struct device_attribute *attr, char *buffer) 2027 { 2028 unsigned int result, status; 2029 2030 if (sony_call_snc_handle(bcare_ctl->handle, 0x0000, &result)) 2031 return -EIO; 2032 2033 status = (result & 0x01) ? ((result & 0x30) >> 0x04) : 0; 2034 switch (status) { 2035 case 1: 2036 status = 80; 2037 break; 2038 case 2: 2039 status = 50; 2040 break; 2041 case 3: 2042 status = 100; 2043 break; 2044 default: 2045 status = 0; 2046 break; 2047 } 2048 2049 return sysfs_emit(buffer, "%d\n", status); 2050 } 2051 2052 static ssize_t sony_nc_battery_care_health_show(struct device *dev, 2053 struct device_attribute *attr, char *buffer) 2054 { 2055 unsigned int health; 2056 2057 if (sony_call_snc_handle(bcare_ctl->handle, 0x0200, &health)) 2058 return -EIO; 2059 2060 return sysfs_emit(buffer, "%d\n", health & 0xff); 2061 } 2062 2063 static int sony_nc_battery_care_setup(struct platform_device *pd, 2064 unsigned int handle) 2065 { 2066 int ret = 0; 2067 2068 bcare_ctl = kzalloc(sizeof(struct battery_care_control), GFP_KERNEL); 2069 if (!bcare_ctl) 2070 return -ENOMEM; 2071 2072 bcare_ctl->handle = handle; 2073 2074 sysfs_attr_init(&bcare_ctl->attrs[0].attr); 2075 bcare_ctl->attrs[0].attr.name = "battery_care_limiter"; 2076 bcare_ctl->attrs[0].attr.mode = S_IRUGO | S_IWUSR; 2077 bcare_ctl->attrs[0].show = sony_nc_battery_care_limit_show; 2078 bcare_ctl->attrs[0].store = sony_nc_battery_care_limit_store; 2079 2080 ret = device_create_file(&pd->dev, &bcare_ctl->attrs[0]); 2081 if (ret) 2082 goto outkzalloc; 2083 2084 /* 0x0115 is for models with no health reporting capability */ 2085 if (handle == 0x0115) 2086 return 0; 2087 2088 sysfs_attr_init(&bcare_ctl->attrs[1].attr); 2089 bcare_ctl->attrs[1].attr.name = "battery_care_health"; 2090 bcare_ctl->attrs[1].attr.mode = S_IRUGO; 2091 bcare_ctl->attrs[1].show = sony_nc_battery_care_health_show; 2092 2093 ret = device_create_file(&pd->dev, &bcare_ctl->attrs[1]); 2094 if (ret) 2095 goto outlimiter; 2096 2097 return 0; 2098 2099 outlimiter: 2100 device_remove_file(&pd->dev, &bcare_ctl->attrs[0]); 2101 2102 outkzalloc: 2103 kfree(bcare_ctl); 2104 bcare_ctl = NULL; 2105 2106 return ret; 2107 } 2108 2109 static void sony_nc_battery_care_cleanup(struct platform_device *pd) 2110 { 2111 if (bcare_ctl) { 2112 device_remove_file(&pd->dev, &bcare_ctl->attrs[0]); 2113 if (bcare_ctl->handle != 0x0115) 2114 device_remove_file(&pd->dev, &bcare_ctl->attrs[1]); 2115 2116 kfree(bcare_ctl); 2117 bcare_ctl = NULL; 2118 } 2119 } 2120 2121 struct snc_thermal_ctrl { 2122 unsigned int mode; 2123 unsigned int profiles; 2124 struct device_attribute mode_attr; 2125 struct device_attribute profiles_attr; 2126 }; 2127 static struct snc_thermal_ctrl *th_handle; 2128 2129 #define THM_PROFILE_MAX 3 2130 static const char * const snc_thermal_profiles[] = { 2131 "balanced", 2132 "silent", 2133 "performance" 2134 }; 2135 2136 static int sony_nc_thermal_mode_set(unsigned short mode) 2137 { 2138 unsigned int result; 2139 2140 /* the thermal profile seems to be a two bit bitmask: 2141 * lsb -> silent 2142 * msb -> performance 2143 * no bit set is the normal operation and is always valid 2144 * Some vaio models only have "balanced" and "performance" 2145 */ 2146 if ((mode && !(th_handle->profiles & mode)) || mode >= THM_PROFILE_MAX) 2147 return -EINVAL; 2148 2149 if (sony_call_snc_handle(0x0122, mode << 0x10 | 0x0200, &result)) 2150 return -EIO; 2151 2152 th_handle->mode = mode; 2153 2154 return 0; 2155 } 2156 2157 static int sony_nc_thermal_mode_get(void) 2158 { 2159 unsigned int result; 2160 2161 if (sony_call_snc_handle(0x0122, 0x0100, &result)) 2162 return -EIO; 2163 2164 return result & 0xff; 2165 } 2166 2167 static ssize_t sony_nc_thermal_profiles_show(struct device *dev, 2168 struct device_attribute *attr, char *buffer) 2169 { 2170 short cnt; 2171 size_t idx = 0; 2172 2173 for (cnt = 0; cnt < THM_PROFILE_MAX; cnt++) { 2174 if (!cnt || (th_handle->profiles & cnt)) 2175 idx += sysfs_emit_at(buffer, idx, "%s ", snc_thermal_profiles[cnt]); 2176 } 2177 idx += sysfs_emit_at(buffer, idx, "\n"); 2178 2179 return idx; 2180 } 2181 2182 static ssize_t sony_nc_thermal_mode_store(struct device *dev, 2183 struct device_attribute *attr, 2184 const char *buffer, size_t count) 2185 { 2186 unsigned short cmd; 2187 size_t len = count; 2188 2189 if (count == 0) 2190 return -EINVAL; 2191 2192 /* skip the newline if present */ 2193 if (buffer[len - 1] == '\n') 2194 len--; 2195 2196 for (cmd = 0; cmd < THM_PROFILE_MAX; cmd++) 2197 if (strncmp(buffer, snc_thermal_profiles[cmd], len) == 0) 2198 break; 2199 2200 if (sony_nc_thermal_mode_set(cmd)) 2201 return -EIO; 2202 2203 return count; 2204 } 2205 2206 static ssize_t sony_nc_thermal_mode_show(struct device *dev, 2207 struct device_attribute *attr, char *buffer) 2208 { 2209 int mode = sony_nc_thermal_mode_get(); 2210 2211 if (mode < 0) 2212 return mode; 2213 2214 return sysfs_emit(buffer, "%s\n", snc_thermal_profiles[mode]); 2215 } 2216 2217 static int sony_nc_thermal_setup(struct platform_device *pd) 2218 { 2219 int ret = 0; 2220 th_handle = kzalloc(sizeof(struct snc_thermal_ctrl), GFP_KERNEL); 2221 if (!th_handle) 2222 return -ENOMEM; 2223 2224 ret = sony_call_snc_handle(0x0122, 0x0000, &th_handle->profiles); 2225 if (ret) { 2226 pr_warn("couldn't to read the thermal profiles\n"); 2227 goto outkzalloc; 2228 } 2229 2230 ret = sony_nc_thermal_mode_get(); 2231 if (ret < 0) { 2232 pr_warn("couldn't to read the current thermal profile"); 2233 goto outkzalloc; 2234 } 2235 th_handle->mode = ret; 2236 2237 sysfs_attr_init(&th_handle->profiles_attr.attr); 2238 th_handle->profiles_attr.attr.name = "thermal_profiles"; 2239 th_handle->profiles_attr.attr.mode = S_IRUGO; 2240 th_handle->profiles_attr.show = sony_nc_thermal_profiles_show; 2241 2242 sysfs_attr_init(&th_handle->mode_attr.attr); 2243 th_handle->mode_attr.attr.name = "thermal_control"; 2244 th_handle->mode_attr.attr.mode = S_IRUGO | S_IWUSR; 2245 th_handle->mode_attr.show = sony_nc_thermal_mode_show; 2246 th_handle->mode_attr.store = sony_nc_thermal_mode_store; 2247 2248 ret = device_create_file(&pd->dev, &th_handle->profiles_attr); 2249 if (ret) 2250 goto outkzalloc; 2251 2252 ret = device_create_file(&pd->dev, &th_handle->mode_attr); 2253 if (ret) 2254 goto outprofiles; 2255 2256 return 0; 2257 2258 outprofiles: 2259 device_remove_file(&pd->dev, &th_handle->profiles_attr); 2260 outkzalloc: 2261 kfree(th_handle); 2262 th_handle = NULL; 2263 return ret; 2264 } 2265 2266 static void sony_nc_thermal_cleanup(struct platform_device *pd) 2267 { 2268 if (th_handle) { 2269 device_remove_file(&pd->dev, &th_handle->profiles_attr); 2270 device_remove_file(&pd->dev, &th_handle->mode_attr); 2271 kfree(th_handle); 2272 th_handle = NULL; 2273 } 2274 } 2275 2276 #ifdef CONFIG_PM_SLEEP 2277 static void sony_nc_thermal_resume(void) 2278 { 2279 int status; 2280 2281 if (!th_handle) 2282 return; 2283 2284 status = sony_nc_thermal_mode_get(); 2285 2286 if (status != th_handle->mode) 2287 sony_nc_thermal_mode_set(th_handle->mode); 2288 } 2289 #endif 2290 2291 /* resume on LID open */ 2292 #define LID_RESUME_S5 0 2293 #define LID_RESUME_S4 1 2294 #define LID_RESUME_S3 2 2295 #define LID_RESUME_MAX 3 2296 struct snc_lid_resume_control { 2297 struct device_attribute attrs[LID_RESUME_MAX]; 2298 unsigned int status; 2299 int handle; 2300 }; 2301 static struct snc_lid_resume_control *lid_ctl; 2302 2303 static ssize_t sony_nc_lid_resume_store(struct device *dev, 2304 struct device_attribute *attr, 2305 const char *buffer, size_t count) 2306 { 2307 unsigned int result; 2308 unsigned long value; 2309 unsigned int pos = LID_RESUME_S5; 2310 if (count > 31) 2311 return -EINVAL; 2312 2313 if (kstrtoul(buffer, 10, &value) || value > 1) 2314 return -EINVAL; 2315 2316 /* the value we have to write to SNC is a bitmask: 2317 * +--------------+ 2318 * | S3 | S4 | S5 | 2319 * +--------------+ 2320 * 2 1 0 2321 */ 2322 while (pos < LID_RESUME_MAX) { 2323 if (&lid_ctl->attrs[pos].attr == &attr->attr) 2324 break; 2325 pos++; 2326 } 2327 if (pos == LID_RESUME_MAX) 2328 return -EINVAL; 2329 2330 if (value) 2331 value = lid_ctl->status | (1 << pos); 2332 else 2333 value = lid_ctl->status & ~(1 << pos); 2334 2335 if (sony_call_snc_handle(lid_ctl->handle, value << 0x10 | 0x0100, 2336 &result)) 2337 return -EIO; 2338 2339 lid_ctl->status = value; 2340 2341 return count; 2342 } 2343 2344 static ssize_t sony_nc_lid_resume_show(struct device *dev, 2345 struct device_attribute *attr, 2346 char *buffer) 2347 { 2348 unsigned int pos = LID_RESUME_S5; 2349 2350 while (pos < LID_RESUME_MAX) { 2351 if (&lid_ctl->attrs[pos].attr == &attr->attr) 2352 return sysfs_emit(buffer, "%d\n", 2353 (lid_ctl->status >> pos) & 0x01); 2354 pos++; 2355 } 2356 return -EINVAL; 2357 } 2358 2359 static int sony_nc_lid_resume_setup(struct platform_device *pd, 2360 unsigned int handle) 2361 { 2362 unsigned int result; 2363 int i; 2364 2365 if (sony_call_snc_handle(handle, 0x0000, &result)) 2366 return -EIO; 2367 2368 lid_ctl = kzalloc(sizeof(struct snc_lid_resume_control), GFP_KERNEL); 2369 if (!lid_ctl) 2370 return -ENOMEM; 2371 2372 lid_ctl->status = result & 0x7; 2373 lid_ctl->handle = handle; 2374 2375 sysfs_attr_init(&lid_ctl->attrs[0].attr); 2376 lid_ctl->attrs[LID_RESUME_S5].attr.name = "lid_resume_S5"; 2377 lid_ctl->attrs[LID_RESUME_S5].attr.mode = S_IRUGO | S_IWUSR; 2378 lid_ctl->attrs[LID_RESUME_S5].show = sony_nc_lid_resume_show; 2379 lid_ctl->attrs[LID_RESUME_S5].store = sony_nc_lid_resume_store; 2380 2381 if (handle == 0x0119) { 2382 sysfs_attr_init(&lid_ctl->attrs[1].attr); 2383 lid_ctl->attrs[LID_RESUME_S4].attr.name = "lid_resume_S4"; 2384 lid_ctl->attrs[LID_RESUME_S4].attr.mode = S_IRUGO | S_IWUSR; 2385 lid_ctl->attrs[LID_RESUME_S4].show = sony_nc_lid_resume_show; 2386 lid_ctl->attrs[LID_RESUME_S4].store = sony_nc_lid_resume_store; 2387 2388 sysfs_attr_init(&lid_ctl->attrs[2].attr); 2389 lid_ctl->attrs[LID_RESUME_S3].attr.name = "lid_resume_S3"; 2390 lid_ctl->attrs[LID_RESUME_S3].attr.mode = S_IRUGO | S_IWUSR; 2391 lid_ctl->attrs[LID_RESUME_S3].show = sony_nc_lid_resume_show; 2392 lid_ctl->attrs[LID_RESUME_S3].store = sony_nc_lid_resume_store; 2393 } 2394 for (i = 0; i < LID_RESUME_MAX && 2395 lid_ctl->attrs[i].attr.name; i++) { 2396 result = device_create_file(&pd->dev, &lid_ctl->attrs[i]); 2397 if (result) 2398 goto liderror; 2399 } 2400 2401 return 0; 2402 2403 liderror: 2404 for (i--; i >= 0; i--) 2405 device_remove_file(&pd->dev, &lid_ctl->attrs[i]); 2406 2407 kfree(lid_ctl); 2408 lid_ctl = NULL; 2409 2410 return result; 2411 } 2412 2413 static void sony_nc_lid_resume_cleanup(struct platform_device *pd) 2414 { 2415 int i; 2416 2417 if (lid_ctl) { 2418 for (i = 0; i < LID_RESUME_MAX; i++) { 2419 if (!lid_ctl->attrs[i].attr.name) 2420 break; 2421 2422 device_remove_file(&pd->dev, &lid_ctl->attrs[i]); 2423 } 2424 2425 kfree(lid_ctl); 2426 lid_ctl = NULL; 2427 } 2428 } 2429 2430 /* GFX Switch position */ 2431 enum gfx_switch { 2432 SPEED, 2433 STAMINA, 2434 AUTO 2435 }; 2436 struct snc_gfx_switch_control { 2437 struct device_attribute attr; 2438 unsigned int handle; 2439 }; 2440 static struct snc_gfx_switch_control *gfxs_ctl; 2441 2442 /* returns 0 for speed, 1 for stamina */ 2443 static int __sony_nc_gfx_switch_status_get(void) 2444 { 2445 unsigned int result; 2446 2447 if (sony_call_snc_handle(gfxs_ctl->handle, 2448 gfxs_ctl->handle == 0x015B ? 0x0000 : 0x0100, 2449 &result)) 2450 return -EIO; 2451 2452 switch (gfxs_ctl->handle) { 2453 case 0x0146: 2454 /* 1: discrete GFX (speed) 2455 * 0: integrated GFX (stamina) 2456 */ 2457 return result & 0x1 ? SPEED : STAMINA; 2458 case 0x015B: 2459 /* 0: discrete GFX (speed) 2460 * 1: integrated GFX (stamina) 2461 */ 2462 return result & 0x1 ? STAMINA : SPEED; 2463 case 0x0128: 2464 /* it's a more elaborated bitmask, for now: 2465 * 2: integrated GFX (stamina) 2466 * 0: discrete GFX (speed) 2467 */ 2468 dprintk("GFX Status: 0x%x\n", result); 2469 return result & 0x80 ? AUTO : 2470 result & 0x02 ? STAMINA : SPEED; 2471 } 2472 return -EINVAL; 2473 } 2474 2475 static ssize_t sony_nc_gfx_switch_status_show(struct device *dev, 2476 struct device_attribute *attr, 2477 char *buffer) 2478 { 2479 int pos = __sony_nc_gfx_switch_status_get(); 2480 2481 if (pos < 0) 2482 return pos; 2483 2484 return sysfs_emit(buffer, "%s\n", 2485 pos == SPEED ? "speed" : 2486 pos == STAMINA ? "stamina" : 2487 pos == AUTO ? "auto" : "unknown"); 2488 } 2489 2490 static int sony_nc_gfx_switch_setup(struct platform_device *pd, 2491 unsigned int handle) 2492 { 2493 unsigned int result; 2494 2495 gfxs_ctl = kzalloc(sizeof(struct snc_gfx_switch_control), GFP_KERNEL); 2496 if (!gfxs_ctl) 2497 return -ENOMEM; 2498 2499 gfxs_ctl->handle = handle; 2500 2501 sysfs_attr_init(&gfxs_ctl->attr.attr); 2502 gfxs_ctl->attr.attr.name = "gfx_switch_status"; 2503 gfxs_ctl->attr.attr.mode = S_IRUGO; 2504 gfxs_ctl->attr.show = sony_nc_gfx_switch_status_show; 2505 2506 result = device_create_file(&pd->dev, &gfxs_ctl->attr); 2507 if (result) 2508 goto gfxerror; 2509 2510 return 0; 2511 2512 gfxerror: 2513 kfree(gfxs_ctl); 2514 gfxs_ctl = NULL; 2515 2516 return result; 2517 } 2518 2519 static void sony_nc_gfx_switch_cleanup(struct platform_device *pd) 2520 { 2521 if (gfxs_ctl) { 2522 device_remove_file(&pd->dev, &gfxs_ctl->attr); 2523 2524 kfree(gfxs_ctl); 2525 gfxs_ctl = NULL; 2526 } 2527 } 2528 2529 /* High speed charging function */ 2530 static struct device_attribute *hsc_handle; 2531 2532 static ssize_t sony_nc_highspeed_charging_store(struct device *dev, 2533 struct device_attribute *attr, 2534 const char *buffer, size_t count) 2535 { 2536 unsigned int result; 2537 unsigned long value; 2538 2539 if (count > 31) 2540 return -EINVAL; 2541 2542 if (kstrtoul(buffer, 10, &value) || value > 1) 2543 return -EINVAL; 2544 2545 if (sony_call_snc_handle(0x0131, value << 0x10 | 0x0200, &result)) 2546 return -EIO; 2547 2548 return count; 2549 } 2550 2551 static ssize_t sony_nc_highspeed_charging_show(struct device *dev, 2552 struct device_attribute *attr, char *buffer) 2553 { 2554 unsigned int result; 2555 2556 if (sony_call_snc_handle(0x0131, 0x0100, &result)) 2557 return -EIO; 2558 2559 return sysfs_emit(buffer, "%d\n", result & 0x01); 2560 } 2561 2562 static int sony_nc_highspeed_charging_setup(struct platform_device *pd) 2563 { 2564 unsigned int result; 2565 2566 if (sony_call_snc_handle(0x0131, 0x0000, &result) || !(result & 0x01)) { 2567 /* some models advertise the handle but have no implementation 2568 * for it 2569 */ 2570 pr_info("No High Speed Charging capability found\n"); 2571 return 0; 2572 } 2573 2574 hsc_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2575 if (!hsc_handle) 2576 return -ENOMEM; 2577 2578 sysfs_attr_init(&hsc_handle->attr); 2579 hsc_handle->attr.name = "battery_highspeed_charging"; 2580 hsc_handle->attr.mode = S_IRUGO | S_IWUSR; 2581 hsc_handle->show = sony_nc_highspeed_charging_show; 2582 hsc_handle->store = sony_nc_highspeed_charging_store; 2583 2584 result = device_create_file(&pd->dev, hsc_handle); 2585 if (result) { 2586 kfree(hsc_handle); 2587 hsc_handle = NULL; 2588 return result; 2589 } 2590 2591 return 0; 2592 } 2593 2594 static void sony_nc_highspeed_charging_cleanup(struct platform_device *pd) 2595 { 2596 if (hsc_handle) { 2597 device_remove_file(&pd->dev, hsc_handle); 2598 kfree(hsc_handle); 2599 hsc_handle = NULL; 2600 } 2601 } 2602 2603 /* low battery function */ 2604 static struct device_attribute *lowbatt_handle; 2605 2606 static ssize_t sony_nc_lowbatt_store(struct device *dev, 2607 struct device_attribute *attr, 2608 const char *buffer, size_t count) 2609 { 2610 unsigned int result; 2611 unsigned long value; 2612 2613 if (count > 31) 2614 return -EINVAL; 2615 2616 if (kstrtoul(buffer, 10, &value) || value > 1) 2617 return -EINVAL; 2618 2619 if (sony_call_snc_handle(0x0121, value << 8, &result)) 2620 return -EIO; 2621 2622 return count; 2623 } 2624 2625 static ssize_t sony_nc_lowbatt_show(struct device *dev, 2626 struct device_attribute *attr, char *buffer) 2627 { 2628 unsigned int result; 2629 2630 if (sony_call_snc_handle(0x0121, 0x0200, &result)) 2631 return -EIO; 2632 2633 return sysfs_emit(buffer, "%d\n", result & 1); 2634 } 2635 2636 static int sony_nc_lowbatt_setup(struct platform_device *pd) 2637 { 2638 unsigned int result; 2639 2640 lowbatt_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2641 if (!lowbatt_handle) 2642 return -ENOMEM; 2643 2644 sysfs_attr_init(&lowbatt_handle->attr); 2645 lowbatt_handle->attr.name = "lowbatt_hibernate"; 2646 lowbatt_handle->attr.mode = S_IRUGO | S_IWUSR; 2647 lowbatt_handle->show = sony_nc_lowbatt_show; 2648 lowbatt_handle->store = sony_nc_lowbatt_store; 2649 2650 result = device_create_file(&pd->dev, lowbatt_handle); 2651 if (result) { 2652 kfree(lowbatt_handle); 2653 lowbatt_handle = NULL; 2654 return result; 2655 } 2656 2657 return 0; 2658 } 2659 2660 static void sony_nc_lowbatt_cleanup(struct platform_device *pd) 2661 { 2662 if (lowbatt_handle) { 2663 device_remove_file(&pd->dev, lowbatt_handle); 2664 kfree(lowbatt_handle); 2665 lowbatt_handle = NULL; 2666 } 2667 } 2668 2669 /* fan speed function */ 2670 static struct device_attribute *fan_handle, *hsf_handle; 2671 2672 static ssize_t sony_nc_hsfan_store(struct device *dev, 2673 struct device_attribute *attr, 2674 const char *buffer, size_t count) 2675 { 2676 unsigned int result; 2677 unsigned long value; 2678 2679 if (count > 31) 2680 return -EINVAL; 2681 2682 if (kstrtoul(buffer, 10, &value) || value > 1) 2683 return -EINVAL; 2684 2685 if (sony_call_snc_handle(0x0149, value << 0x10 | 0x0200, &result)) 2686 return -EIO; 2687 2688 return count; 2689 } 2690 2691 static ssize_t sony_nc_hsfan_show(struct device *dev, 2692 struct device_attribute *attr, char *buffer) 2693 { 2694 unsigned int result; 2695 2696 if (sony_call_snc_handle(0x0149, 0x0100, &result)) 2697 return -EIO; 2698 2699 return sysfs_emit(buffer, "%d\n", result & 0x01); 2700 } 2701 2702 static ssize_t sony_nc_fanspeed_show(struct device *dev, 2703 struct device_attribute *attr, char *buffer) 2704 { 2705 unsigned int result; 2706 2707 if (sony_call_snc_handle(0x0149, 0x0300, &result)) 2708 return -EIO; 2709 2710 return sysfs_emit(buffer, "%d\n", result & 0xff); 2711 } 2712 2713 static int sony_nc_fanspeed_setup(struct platform_device *pd) 2714 { 2715 unsigned int result; 2716 2717 fan_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2718 if (!fan_handle) 2719 return -ENOMEM; 2720 2721 hsf_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2722 if (!hsf_handle) { 2723 result = -ENOMEM; 2724 goto out_hsf_handle_alloc; 2725 } 2726 2727 sysfs_attr_init(&fan_handle->attr); 2728 fan_handle->attr.name = "fanspeed"; 2729 fan_handle->attr.mode = S_IRUGO; 2730 fan_handle->show = sony_nc_fanspeed_show; 2731 fan_handle->store = NULL; 2732 2733 sysfs_attr_init(&hsf_handle->attr); 2734 hsf_handle->attr.name = "fan_forced"; 2735 hsf_handle->attr.mode = S_IRUGO | S_IWUSR; 2736 hsf_handle->show = sony_nc_hsfan_show; 2737 hsf_handle->store = sony_nc_hsfan_store; 2738 2739 result = device_create_file(&pd->dev, fan_handle); 2740 if (result) 2741 goto out_fan_handle; 2742 2743 result = device_create_file(&pd->dev, hsf_handle); 2744 if (result) 2745 goto out_hsf_handle; 2746 2747 return 0; 2748 2749 out_hsf_handle: 2750 device_remove_file(&pd->dev, fan_handle); 2751 2752 out_fan_handle: 2753 kfree(hsf_handle); 2754 hsf_handle = NULL; 2755 2756 out_hsf_handle_alloc: 2757 kfree(fan_handle); 2758 fan_handle = NULL; 2759 return result; 2760 } 2761 2762 static void sony_nc_fanspeed_cleanup(struct platform_device *pd) 2763 { 2764 if (fan_handle) { 2765 device_remove_file(&pd->dev, fan_handle); 2766 kfree(fan_handle); 2767 fan_handle = NULL; 2768 } 2769 if (hsf_handle) { 2770 device_remove_file(&pd->dev, hsf_handle); 2771 kfree(hsf_handle); 2772 hsf_handle = NULL; 2773 } 2774 } 2775 2776 /* USB charge function */ 2777 static struct device_attribute *uc_handle; 2778 2779 static ssize_t sony_nc_usb_charge_store(struct device *dev, 2780 struct device_attribute *attr, 2781 const char *buffer, size_t count) 2782 { 2783 unsigned int result; 2784 unsigned long value; 2785 2786 if (count > 31) 2787 return -EINVAL; 2788 2789 if (kstrtoul(buffer, 10, &value) || value > 1) 2790 return -EINVAL; 2791 2792 if (sony_call_snc_handle(0x0155, value << 0x10 | 0x0100, &result)) 2793 return -EIO; 2794 2795 return count; 2796 } 2797 2798 static ssize_t sony_nc_usb_charge_show(struct device *dev, 2799 struct device_attribute *attr, char *buffer) 2800 { 2801 unsigned int result; 2802 2803 if (sony_call_snc_handle(0x0155, 0x0000, &result)) 2804 return -EIO; 2805 2806 return sysfs_emit(buffer, "%d\n", result & 0x01); 2807 } 2808 2809 static int sony_nc_usb_charge_setup(struct platform_device *pd) 2810 { 2811 unsigned int result; 2812 2813 if (sony_call_snc_handle(0x0155, 0x0000, &result) || !(result & 0x01)) { 2814 /* some models advertise the handle but have no implementation 2815 * for it 2816 */ 2817 pr_info("No USB Charge capability found\n"); 2818 return 0; 2819 } 2820 2821 uc_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2822 if (!uc_handle) 2823 return -ENOMEM; 2824 2825 sysfs_attr_init(&uc_handle->attr); 2826 uc_handle->attr.name = "usb_charge"; 2827 uc_handle->attr.mode = S_IRUGO | S_IWUSR; 2828 uc_handle->show = sony_nc_usb_charge_show; 2829 uc_handle->store = sony_nc_usb_charge_store; 2830 2831 result = device_create_file(&pd->dev, uc_handle); 2832 if (result) { 2833 kfree(uc_handle); 2834 uc_handle = NULL; 2835 return result; 2836 } 2837 2838 return 0; 2839 } 2840 2841 static void sony_nc_usb_charge_cleanup(struct platform_device *pd) 2842 { 2843 if (uc_handle) { 2844 device_remove_file(&pd->dev, uc_handle); 2845 kfree(uc_handle); 2846 uc_handle = NULL; 2847 } 2848 } 2849 2850 /* Panel ID function */ 2851 static struct device_attribute *panel_handle; 2852 2853 static ssize_t sony_nc_panelid_show(struct device *dev, 2854 struct device_attribute *attr, char *buffer) 2855 { 2856 unsigned int result; 2857 2858 if (sony_call_snc_handle(0x011D, 0x0000, &result)) 2859 return -EIO; 2860 2861 return sysfs_emit(buffer, "%d\n", result); 2862 } 2863 2864 static int sony_nc_panelid_setup(struct platform_device *pd) 2865 { 2866 unsigned int result; 2867 2868 panel_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2869 if (!panel_handle) 2870 return -ENOMEM; 2871 2872 sysfs_attr_init(&panel_handle->attr); 2873 panel_handle->attr.name = "panel_id"; 2874 panel_handle->attr.mode = S_IRUGO; 2875 panel_handle->show = sony_nc_panelid_show; 2876 panel_handle->store = NULL; 2877 2878 result = device_create_file(&pd->dev, panel_handle); 2879 if (result) { 2880 kfree(panel_handle); 2881 panel_handle = NULL; 2882 return result; 2883 } 2884 2885 return 0; 2886 } 2887 2888 static void sony_nc_panelid_cleanup(struct platform_device *pd) 2889 { 2890 if (panel_handle) { 2891 device_remove_file(&pd->dev, panel_handle); 2892 kfree(panel_handle); 2893 panel_handle = NULL; 2894 } 2895 } 2896 2897 /* smart connect function */ 2898 static struct device_attribute *sc_handle; 2899 2900 static ssize_t sony_nc_smart_conn_store(struct device *dev, 2901 struct device_attribute *attr, 2902 const char *buffer, size_t count) 2903 { 2904 unsigned int result; 2905 unsigned long value; 2906 2907 if (count > 31) 2908 return -EINVAL; 2909 2910 if (kstrtoul(buffer, 10, &value) || value > 1) 2911 return -EINVAL; 2912 2913 if (sony_call_snc_handle(0x0168, value << 0x10, &result)) 2914 return -EIO; 2915 2916 return count; 2917 } 2918 2919 static int sony_nc_smart_conn_setup(struct platform_device *pd) 2920 { 2921 unsigned int result; 2922 2923 sc_handle = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); 2924 if (!sc_handle) 2925 return -ENOMEM; 2926 2927 sysfs_attr_init(&sc_handle->attr); 2928 sc_handle->attr.name = "smart_connect"; 2929 sc_handle->attr.mode = S_IWUSR; 2930 sc_handle->show = NULL; 2931 sc_handle->store = sony_nc_smart_conn_store; 2932 2933 result = device_create_file(&pd->dev, sc_handle); 2934 if (result) { 2935 kfree(sc_handle); 2936 sc_handle = NULL; 2937 return result; 2938 } 2939 2940 return 0; 2941 } 2942 2943 static void sony_nc_smart_conn_cleanup(struct platform_device *pd) 2944 { 2945 if (sc_handle) { 2946 device_remove_file(&pd->dev, sc_handle); 2947 kfree(sc_handle); 2948 sc_handle = NULL; 2949 } 2950 } 2951 2952 /* Touchpad enable/disable */ 2953 struct touchpad_control { 2954 struct device_attribute attr; 2955 int handle; 2956 }; 2957 static struct touchpad_control *tp_ctl; 2958 2959 static ssize_t sony_nc_touchpad_store(struct device *dev, 2960 struct device_attribute *attr, const char *buffer, size_t count) 2961 { 2962 unsigned int result; 2963 unsigned long value; 2964 2965 if (count > 31) 2966 return -EINVAL; 2967 2968 if (kstrtoul(buffer, 10, &value) || value > 1) 2969 return -EINVAL; 2970 2971 /* sysfs: 0 disabled, 1 enabled 2972 * EC: 0 enabled, 1 disabled 2973 */ 2974 if (sony_call_snc_handle(tp_ctl->handle, 2975 (!value << 0x10) | 0x100, &result)) 2976 return -EIO; 2977 2978 return count; 2979 } 2980 2981 static ssize_t sony_nc_touchpad_show(struct device *dev, 2982 struct device_attribute *attr, char *buffer) 2983 { 2984 unsigned int result; 2985 2986 if (sony_call_snc_handle(tp_ctl->handle, 0x000, &result)) 2987 return -EINVAL; 2988 2989 return sysfs_emit(buffer, "%d\n", !(result & 0x01)); 2990 } 2991 2992 static int sony_nc_touchpad_setup(struct platform_device *pd, 2993 unsigned int handle) 2994 { 2995 int ret = 0; 2996 2997 tp_ctl = kzalloc(sizeof(struct touchpad_control), GFP_KERNEL); 2998 if (!tp_ctl) 2999 return -ENOMEM; 3000 3001 tp_ctl->handle = handle; 3002 3003 sysfs_attr_init(&tp_ctl->attr.attr); 3004 tp_ctl->attr.attr.name = "touchpad"; 3005 tp_ctl->attr.attr.mode = S_IRUGO | S_IWUSR; 3006 tp_ctl->attr.show = sony_nc_touchpad_show; 3007 tp_ctl->attr.store = sony_nc_touchpad_store; 3008 3009 ret = device_create_file(&pd->dev, &tp_ctl->attr); 3010 if (ret) { 3011 kfree(tp_ctl); 3012 tp_ctl = NULL; 3013 } 3014 3015 return ret; 3016 } 3017 3018 static void sony_nc_touchpad_cleanup(struct platform_device *pd) 3019 { 3020 if (tp_ctl) { 3021 device_remove_file(&pd->dev, &tp_ctl->attr); 3022 kfree(tp_ctl); 3023 tp_ctl = NULL; 3024 } 3025 } 3026 3027 static void sony_nc_backlight_ng_read_limits(int handle, 3028 struct sony_backlight_props *props) 3029 { 3030 u64 offset; 3031 int i; 3032 int lvl_table_len = 0; 3033 u8 min = 0xff, max = 0x00; 3034 unsigned char buffer[32] = { 0 }; 3035 3036 props->handle = handle; 3037 props->offset = 0; 3038 props->maxlvl = 0xff; 3039 3040 offset = sony_find_snc_handle(handle); 3041 3042 /* try to read the boundaries from ACPI tables, if we fail the above 3043 * defaults should be reasonable 3044 */ 3045 i = sony_nc_buffer_call(sony_nc_acpi_handle, "SN06", &offset, buffer, 3046 32); 3047 if (i < 0) 3048 return; 3049 3050 switch (handle) { 3051 case 0x012f: 3052 case 0x0137: 3053 lvl_table_len = 9; 3054 break; 3055 case 0x143: 3056 case 0x14b: 3057 case 0x14c: 3058 lvl_table_len = 16; 3059 break; 3060 } 3061 3062 /* the buffer lists brightness levels available, brightness levels are 3063 * from position 0 to 8 in the array, other values are used by ALS 3064 * control. 3065 */ 3066 for (i = 0; i < lvl_table_len && i < ARRAY_SIZE(buffer); i++) { 3067 3068 dprintk("Brightness level: %d\n", buffer[i]); 3069 3070 if (!buffer[i]) 3071 break; 3072 3073 if (buffer[i] > max) 3074 max = buffer[i]; 3075 if (buffer[i] < min) 3076 min = buffer[i]; 3077 } 3078 props->offset = min; 3079 props->maxlvl = max; 3080 dprintk("Brightness levels: min=%d max=%d\n", props->offset, 3081 props->maxlvl); 3082 } 3083 3084 static void sony_nc_backlight_setup(void) 3085 { 3086 int max_brightness = 0; 3087 const struct backlight_ops *ops = NULL; 3088 struct backlight_properties props; 3089 3090 if (sony_find_snc_handle(0x12f) >= 0) { 3091 ops = &sony_backlight_ng_ops; 3092 sony_bl_props.cmd_base = 0x0100; 3093 sony_nc_backlight_ng_read_limits(0x12f, &sony_bl_props); 3094 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset; 3095 3096 } else if (sony_find_snc_handle(0x137) >= 0) { 3097 ops = &sony_backlight_ng_ops; 3098 sony_bl_props.cmd_base = 0x0100; 3099 sony_nc_backlight_ng_read_limits(0x137, &sony_bl_props); 3100 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset; 3101 3102 } else if (sony_find_snc_handle(0x143) >= 0) { 3103 ops = &sony_backlight_ng_ops; 3104 sony_bl_props.cmd_base = 0x3000; 3105 sony_nc_backlight_ng_read_limits(0x143, &sony_bl_props); 3106 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset; 3107 3108 } else if (sony_find_snc_handle(0x14b) >= 0) { 3109 ops = &sony_backlight_ng_ops; 3110 sony_bl_props.cmd_base = 0x3000; 3111 sony_nc_backlight_ng_read_limits(0x14b, &sony_bl_props); 3112 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset; 3113 3114 } else if (sony_find_snc_handle(0x14c) >= 0) { 3115 ops = &sony_backlight_ng_ops; 3116 sony_bl_props.cmd_base = 0x3000; 3117 sony_nc_backlight_ng_read_limits(0x14c, &sony_bl_props); 3118 max_brightness = sony_bl_props.maxlvl - sony_bl_props.offset; 3119 3120 } else if (acpi_has_method(sony_nc_acpi_handle, "GBRT")) { 3121 ops = &sony_backlight_ops; 3122 max_brightness = SONY_MAX_BRIGHTNESS - 1; 3123 3124 } else 3125 return; 3126 3127 memset(&props, 0, sizeof(struct backlight_properties)); 3128 props.type = BACKLIGHT_PLATFORM; 3129 props.max_brightness = max_brightness; 3130 sony_bl_props.dev = backlight_device_register("sony", NULL, 3131 &sony_bl_props, 3132 ops, &props); 3133 3134 if (IS_ERR(sony_bl_props.dev)) { 3135 pr_warn("unable to register backlight device\n"); 3136 sony_bl_props.dev = NULL; 3137 } else 3138 sony_bl_props.dev->props.brightness = 3139 ops->get_brightness(sony_bl_props.dev); 3140 } 3141 3142 static void sony_nc_backlight_cleanup(void) 3143 { 3144 backlight_device_unregister(sony_bl_props.dev); 3145 } 3146 3147 static int sony_nc_add(struct acpi_device *device) 3148 { 3149 acpi_status status; 3150 int result = 0; 3151 struct sony_nc_value *item; 3152 3153 sony_nc_acpi_device = device; 3154 strcpy(acpi_device_class(device), "sony/hotkey"); 3155 3156 sony_nc_acpi_handle = device->handle; 3157 3158 /* read device status */ 3159 result = acpi_bus_get_status(device); 3160 /* bail IFF the above call was successful and the device is not present */ 3161 if (!result && !device->status.present) { 3162 dprintk("Device not present\n"); 3163 result = -ENODEV; 3164 goto outwalk; 3165 } 3166 3167 result = sony_pf_add(); 3168 if (result) 3169 goto outpresent; 3170 3171 if (debug) { 3172 status = acpi_walk_namespace(ACPI_TYPE_METHOD, 3173 sony_nc_acpi_handle, 1, sony_walk_callback, 3174 NULL, NULL, NULL); 3175 if (ACPI_FAILURE(status)) { 3176 pr_warn("unable to walk acpi resources\n"); 3177 result = -ENODEV; 3178 goto outpresent; 3179 } 3180 } 3181 3182 result = sony_laptop_setup_input(device); 3183 if (result) { 3184 pr_err("Unable to create input devices\n"); 3185 goto outplatform; 3186 } 3187 3188 if (acpi_has_method(sony_nc_acpi_handle, "ECON")) { 3189 int arg = 1; 3190 if (sony_nc_int_call(sony_nc_acpi_handle, "ECON", &arg, NULL)) 3191 dprintk("ECON Method failed\n"); 3192 } 3193 3194 if (acpi_has_method(sony_nc_acpi_handle, "SN00")) { 3195 dprintk("Doing SNC setup\n"); 3196 /* retrieve the available handles */ 3197 result = sony_nc_handles_setup(sony_pf_device); 3198 if (!result) 3199 sony_nc_function_setup(device, sony_pf_device); 3200 } 3201 3202 if (acpi_video_get_backlight_type() == acpi_backlight_vendor) 3203 sony_nc_backlight_setup(); 3204 3205 /* create sony_pf sysfs attributes related to the SNC device */ 3206 for (item = sony_nc_values; item->name; ++item) { 3207 3208 if (!debug && item->debug) 3209 continue; 3210 3211 /* find the available acpiget as described in the DSDT */ 3212 for (; item->acpiget && *item->acpiget; ++item->acpiget) { 3213 if (acpi_has_method(sony_nc_acpi_handle, 3214 *item->acpiget)) { 3215 dprintk("Found %s getter: %s\n", 3216 item->name, *item->acpiget); 3217 item->devattr.attr.mode |= S_IRUGO; 3218 break; 3219 } 3220 } 3221 3222 /* find the available acpiset as described in the DSDT */ 3223 for (; item->acpiset && *item->acpiset; ++item->acpiset) { 3224 if (acpi_has_method(sony_nc_acpi_handle, 3225 *item->acpiset)) { 3226 dprintk("Found %s setter: %s\n", 3227 item->name, *item->acpiset); 3228 item->devattr.attr.mode |= S_IWUSR; 3229 break; 3230 } 3231 } 3232 3233 if (item->devattr.attr.mode != 0) { 3234 result = 3235 device_create_file(&sony_pf_device->dev, 3236 &item->devattr); 3237 if (result) 3238 goto out_sysfs; 3239 } 3240 } 3241 3242 pr_info("SNC setup done.\n"); 3243 return 0; 3244 3245 out_sysfs: 3246 for (item = sony_nc_values; item->name; ++item) { 3247 device_remove_file(&sony_pf_device->dev, &item->devattr); 3248 } 3249 sony_nc_backlight_cleanup(); 3250 sony_nc_function_cleanup(sony_pf_device); 3251 sony_nc_handles_cleanup(sony_pf_device); 3252 3253 outplatform: 3254 sony_laptop_remove_input(); 3255 3256 outpresent: 3257 sony_pf_remove(); 3258 3259 outwalk: 3260 sony_nc_rfkill_cleanup(); 3261 return result; 3262 } 3263 3264 static void sony_nc_remove(struct acpi_device *device) 3265 { 3266 struct sony_nc_value *item; 3267 3268 sony_nc_backlight_cleanup(); 3269 3270 sony_nc_acpi_device = NULL; 3271 3272 for (item = sony_nc_values; item->name; ++item) { 3273 device_remove_file(&sony_pf_device->dev, &item->devattr); 3274 } 3275 3276 sony_nc_function_cleanup(sony_pf_device); 3277 sony_nc_handles_cleanup(sony_pf_device); 3278 sony_pf_remove(); 3279 sony_laptop_remove_input(); 3280 dprintk(SONY_NC_DRIVER_NAME " removed.\n"); 3281 } 3282 3283 static const struct acpi_device_id sony_device_ids[] = { 3284 {SONY_NC_HID, 0}, 3285 {SONY_PIC_HID, 0}, 3286 {"", 0}, 3287 }; 3288 MODULE_DEVICE_TABLE(acpi, sony_device_ids); 3289 3290 static const struct acpi_device_id sony_nc_device_ids[] = { 3291 {SONY_NC_HID, 0}, 3292 {"", 0}, 3293 }; 3294 3295 static struct acpi_driver sony_nc_driver = { 3296 .name = SONY_NC_DRIVER_NAME, 3297 .class = SONY_NC_CLASS, 3298 .ids = sony_nc_device_ids, 3299 .owner = THIS_MODULE, 3300 .ops = { 3301 .add = sony_nc_add, 3302 .remove = sony_nc_remove, 3303 .notify = sony_nc_notify, 3304 }, 3305 .drv.pm = &sony_nc_pm, 3306 }; 3307 3308 /*********** SPIC (SNY6001) Device ***********/ 3309 3310 #define SONYPI_DEVICE_TYPE1 0x00000001 3311 #define SONYPI_DEVICE_TYPE2 0x00000002 3312 #define SONYPI_DEVICE_TYPE3 0x00000004 3313 3314 #define SONYPI_TYPE1_OFFSET 0x04 3315 #define SONYPI_TYPE2_OFFSET 0x12 3316 #define SONYPI_TYPE3_OFFSET 0x12 3317 3318 struct sony_pic_ioport { 3319 struct acpi_resource_io io1; 3320 struct acpi_resource_io io2; 3321 struct list_head list; 3322 }; 3323 3324 struct sony_pic_irq { 3325 struct acpi_resource_irq irq; 3326 struct list_head list; 3327 }; 3328 3329 struct sonypi_eventtypes { 3330 u8 data; 3331 unsigned long mask; 3332 struct sonypi_event *events; 3333 }; 3334 3335 struct sony_pic_dev { 3336 struct acpi_device *acpi_dev; 3337 struct sony_pic_irq *cur_irq; 3338 struct sony_pic_ioport *cur_ioport; 3339 struct list_head interrupts; 3340 struct list_head ioports; 3341 struct mutex lock; 3342 struct sonypi_eventtypes *event_types; 3343 int (*handle_irq)(const u8, const u8); 3344 int model; 3345 u16 evport_offset; 3346 u8 camera_power; 3347 u8 bluetooth_power; 3348 u8 wwan_power; 3349 }; 3350 3351 static struct sony_pic_dev spic_dev = { 3352 .interrupts = LIST_HEAD_INIT(spic_dev.interrupts), 3353 .ioports = LIST_HEAD_INIT(spic_dev.ioports), 3354 }; 3355 3356 static int spic_drv_registered; 3357 3358 /* Event masks */ 3359 #define SONYPI_JOGGER_MASK 0x00000001 3360 #define SONYPI_CAPTURE_MASK 0x00000002 3361 #define SONYPI_FNKEY_MASK 0x00000004 3362 #define SONYPI_BLUETOOTH_MASK 0x00000008 3363 #define SONYPI_PKEY_MASK 0x00000010 3364 #define SONYPI_BACK_MASK 0x00000020 3365 #define SONYPI_HELP_MASK 0x00000040 3366 #define SONYPI_LID_MASK 0x00000080 3367 #define SONYPI_ZOOM_MASK 0x00000100 3368 #define SONYPI_THUMBPHRASE_MASK 0x00000200 3369 #define SONYPI_MEYE_MASK 0x00000400 3370 #define SONYPI_MEMORYSTICK_MASK 0x00000800 3371 #define SONYPI_BATTERY_MASK 0x00001000 3372 #define SONYPI_WIRELESS_MASK 0x00002000 3373 3374 struct sonypi_event { 3375 u8 data; 3376 u8 event; 3377 }; 3378 3379 /* The set of possible button release events */ 3380 static struct sonypi_event sonypi_releaseev[] = { 3381 { 0x00, SONYPI_EVENT_ANYBUTTON_RELEASED }, 3382 { 0, 0 } 3383 }; 3384 3385 /* The set of possible jogger events */ 3386 static struct sonypi_event sonypi_joggerev[] = { 3387 { 0x1f, SONYPI_EVENT_JOGDIAL_UP }, 3388 { 0x01, SONYPI_EVENT_JOGDIAL_DOWN }, 3389 { 0x5f, SONYPI_EVENT_JOGDIAL_UP_PRESSED }, 3390 { 0x41, SONYPI_EVENT_JOGDIAL_DOWN_PRESSED }, 3391 { 0x1e, SONYPI_EVENT_JOGDIAL_FAST_UP }, 3392 { 0x02, SONYPI_EVENT_JOGDIAL_FAST_DOWN }, 3393 { 0x5e, SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED }, 3394 { 0x42, SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED }, 3395 { 0x1d, SONYPI_EVENT_JOGDIAL_VFAST_UP }, 3396 { 0x03, SONYPI_EVENT_JOGDIAL_VFAST_DOWN }, 3397 { 0x5d, SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED }, 3398 { 0x43, SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED }, 3399 { 0x40, SONYPI_EVENT_JOGDIAL_PRESSED }, 3400 { 0, 0 } 3401 }; 3402 3403 /* The set of possible capture button events */ 3404 static struct sonypi_event sonypi_captureev[] = { 3405 { 0x05, SONYPI_EVENT_CAPTURE_PARTIALPRESSED }, 3406 { 0x07, SONYPI_EVENT_CAPTURE_PRESSED }, 3407 { 0x40, SONYPI_EVENT_CAPTURE_PRESSED }, 3408 { 0x01, SONYPI_EVENT_CAPTURE_PARTIALRELEASED }, 3409 { 0, 0 } 3410 }; 3411 3412 /* The set of possible fnkeys events */ 3413 static struct sonypi_event sonypi_fnkeyev[] = { 3414 { 0x10, SONYPI_EVENT_FNKEY_ESC }, 3415 { 0x11, SONYPI_EVENT_FNKEY_F1 }, 3416 { 0x12, SONYPI_EVENT_FNKEY_F2 }, 3417 { 0x13, SONYPI_EVENT_FNKEY_F3 }, 3418 { 0x14, SONYPI_EVENT_FNKEY_F4 }, 3419 { 0x15, SONYPI_EVENT_FNKEY_F5 }, 3420 { 0x16, SONYPI_EVENT_FNKEY_F6 }, 3421 { 0x17, SONYPI_EVENT_FNKEY_F7 }, 3422 { 0x18, SONYPI_EVENT_FNKEY_F8 }, 3423 { 0x19, SONYPI_EVENT_FNKEY_F9 }, 3424 { 0x1a, SONYPI_EVENT_FNKEY_F10 }, 3425 { 0x1b, SONYPI_EVENT_FNKEY_F11 }, 3426 { 0x1c, SONYPI_EVENT_FNKEY_F12 }, 3427 { 0x1f, SONYPI_EVENT_FNKEY_RELEASED }, 3428 { 0x21, SONYPI_EVENT_FNKEY_1 }, 3429 { 0x22, SONYPI_EVENT_FNKEY_2 }, 3430 { 0x31, SONYPI_EVENT_FNKEY_D }, 3431 { 0x32, SONYPI_EVENT_FNKEY_E }, 3432 { 0x33, SONYPI_EVENT_FNKEY_F }, 3433 { 0x34, SONYPI_EVENT_FNKEY_S }, 3434 { 0x35, SONYPI_EVENT_FNKEY_B }, 3435 { 0x36, SONYPI_EVENT_FNKEY_ONLY }, 3436 { 0, 0 } 3437 }; 3438 3439 /* The set of possible program key events */ 3440 static struct sonypi_event sonypi_pkeyev[] = { 3441 { 0x01, SONYPI_EVENT_PKEY_P1 }, 3442 { 0x02, SONYPI_EVENT_PKEY_P2 }, 3443 { 0x04, SONYPI_EVENT_PKEY_P3 }, 3444 { 0x20, SONYPI_EVENT_PKEY_P1 }, 3445 { 0, 0 } 3446 }; 3447 3448 /* The set of possible bluetooth events */ 3449 static struct sonypi_event sonypi_blueev[] = { 3450 { 0x55, SONYPI_EVENT_BLUETOOTH_PRESSED }, 3451 { 0x59, SONYPI_EVENT_BLUETOOTH_ON }, 3452 { 0x5a, SONYPI_EVENT_BLUETOOTH_OFF }, 3453 { 0, 0 } 3454 }; 3455 3456 /* The set of possible wireless events */ 3457 static struct sonypi_event sonypi_wlessev[] = { 3458 { 0x59, SONYPI_EVENT_IGNORE }, 3459 { 0x5a, SONYPI_EVENT_IGNORE }, 3460 { 0, 0 } 3461 }; 3462 3463 /* The set of possible back button events */ 3464 static struct sonypi_event sonypi_backev[] = { 3465 { 0x20, SONYPI_EVENT_BACK_PRESSED }, 3466 { 0, 0 } 3467 }; 3468 3469 /* The set of possible help button events */ 3470 static struct sonypi_event sonypi_helpev[] = { 3471 { 0x3b, SONYPI_EVENT_HELP_PRESSED }, 3472 { 0, 0 } 3473 }; 3474 3475 3476 /* The set of possible lid events */ 3477 static struct sonypi_event sonypi_lidev[] = { 3478 { 0x51, SONYPI_EVENT_LID_CLOSED }, 3479 { 0x50, SONYPI_EVENT_LID_OPENED }, 3480 { 0, 0 } 3481 }; 3482 3483 /* The set of possible zoom events */ 3484 static struct sonypi_event sonypi_zoomev[] = { 3485 { 0x39, SONYPI_EVENT_ZOOM_PRESSED }, 3486 { 0x10, SONYPI_EVENT_ZOOM_IN_PRESSED }, 3487 { 0x20, SONYPI_EVENT_ZOOM_OUT_PRESSED }, 3488 { 0x04, SONYPI_EVENT_ZOOM_PRESSED }, 3489 { 0, 0 } 3490 }; 3491 3492 /* The set of possible thumbphrase events */ 3493 static struct sonypi_event sonypi_thumbphraseev[] = { 3494 { 0x3a, SONYPI_EVENT_THUMBPHRASE_PRESSED }, 3495 { 0, 0 } 3496 }; 3497 3498 /* The set of possible motioneye camera events */ 3499 static struct sonypi_event sonypi_meyeev[] = { 3500 { 0x00, SONYPI_EVENT_MEYE_FACE }, 3501 { 0x01, SONYPI_EVENT_MEYE_OPPOSITE }, 3502 { 0, 0 } 3503 }; 3504 3505 /* The set of possible memorystick events */ 3506 static struct sonypi_event sonypi_memorystickev[] = { 3507 { 0x53, SONYPI_EVENT_MEMORYSTICK_INSERT }, 3508 { 0x54, SONYPI_EVENT_MEMORYSTICK_EJECT }, 3509 { 0, 0 } 3510 }; 3511 3512 /* The set of possible battery events */ 3513 static struct sonypi_event sonypi_batteryev[] = { 3514 { 0x20, SONYPI_EVENT_BATTERY_INSERT }, 3515 { 0x30, SONYPI_EVENT_BATTERY_REMOVE }, 3516 { 0, 0 } 3517 }; 3518 3519 /* The set of possible volume events */ 3520 static struct sonypi_event sonypi_volumeev[] = { 3521 { 0x01, SONYPI_EVENT_VOLUME_INC_PRESSED }, 3522 { 0x02, SONYPI_EVENT_VOLUME_DEC_PRESSED }, 3523 { 0, 0 } 3524 }; 3525 3526 /* The set of possible brightness events */ 3527 static struct sonypi_event sonypi_brightnessev[] = { 3528 { 0x80, SONYPI_EVENT_BRIGHTNESS_PRESSED }, 3529 { 0, 0 } 3530 }; 3531 3532 static struct sonypi_eventtypes type1_events[] = { 3533 { 0, 0xffffffff, sonypi_releaseev }, 3534 { 0x70, SONYPI_MEYE_MASK, sonypi_meyeev }, 3535 { 0x30, SONYPI_LID_MASK, sonypi_lidev }, 3536 { 0x60, SONYPI_CAPTURE_MASK, sonypi_captureev }, 3537 { 0x10, SONYPI_JOGGER_MASK, sonypi_joggerev }, 3538 { 0x20, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, 3539 { 0x30, SONYPI_BLUETOOTH_MASK, sonypi_blueev }, 3540 { 0x40, SONYPI_PKEY_MASK, sonypi_pkeyev }, 3541 { 0x30, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, 3542 { 0x40, SONYPI_BATTERY_MASK, sonypi_batteryev }, 3543 { 0 }, 3544 }; 3545 static struct sonypi_eventtypes type2_events[] = { 3546 { 0, 0xffffffff, sonypi_releaseev }, 3547 { 0x38, SONYPI_LID_MASK, sonypi_lidev }, 3548 { 0x11, SONYPI_JOGGER_MASK, sonypi_joggerev }, 3549 { 0x61, SONYPI_CAPTURE_MASK, sonypi_captureev }, 3550 { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, 3551 { 0x31, SONYPI_BLUETOOTH_MASK, sonypi_blueev }, 3552 { 0x08, SONYPI_PKEY_MASK, sonypi_pkeyev }, 3553 { 0x11, SONYPI_BACK_MASK, sonypi_backev }, 3554 { 0x21, SONYPI_HELP_MASK, sonypi_helpev }, 3555 { 0x21, SONYPI_ZOOM_MASK, sonypi_zoomev }, 3556 { 0x20, SONYPI_THUMBPHRASE_MASK, sonypi_thumbphraseev }, 3557 { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, 3558 { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev }, 3559 { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev }, 3560 { 0 }, 3561 }; 3562 static struct sonypi_eventtypes type3_events[] = { 3563 { 0, 0xffffffff, sonypi_releaseev }, 3564 { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, 3565 { 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev }, 3566 { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, 3567 { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev }, 3568 { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev }, 3569 { 0x05, SONYPI_PKEY_MASK, sonypi_pkeyev }, 3570 { 0x05, SONYPI_ZOOM_MASK, sonypi_zoomev }, 3571 { 0x05, SONYPI_CAPTURE_MASK, sonypi_captureev }, 3572 { 0x05, SONYPI_PKEY_MASK, sonypi_volumeev }, 3573 { 0x05, SONYPI_PKEY_MASK, sonypi_brightnessev }, 3574 { 0 }, 3575 }; 3576 3577 /* low level spic calls */ 3578 #define ITERATIONS_LONG 10000 3579 #define ITERATIONS_SHORT 10 3580 #define wait_on_command(command, iterations) { \ 3581 unsigned int n = iterations; \ 3582 while (--n && (command)) \ 3583 udelay(1); \ 3584 if (!n) \ 3585 dprintk("command failed at %s : %s (line %d)\n", \ 3586 __FILE__, __func__, __LINE__); \ 3587 } 3588 3589 static u8 sony_pic_call1(u8 dev) 3590 { 3591 u8 v1, v2; 3592 3593 wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, 3594 ITERATIONS_LONG); 3595 outb(dev, spic_dev.cur_ioport->io1.minimum + 4); 3596 v1 = inb_p(spic_dev.cur_ioport->io1.minimum + 4); 3597 v2 = inb_p(spic_dev.cur_ioport->io1.minimum); 3598 dprintk("sony_pic_call1(0x%.2x): 0x%.4x\n", dev, (v2 << 8) | v1); 3599 return v2; 3600 } 3601 3602 static u8 sony_pic_call2(u8 dev, u8 fn) 3603 { 3604 u8 v1; 3605 3606 wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, 3607 ITERATIONS_LONG); 3608 outb(dev, spic_dev.cur_ioport->io1.minimum + 4); 3609 wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, 3610 ITERATIONS_LONG); 3611 outb(fn, spic_dev.cur_ioport->io1.minimum); 3612 v1 = inb_p(spic_dev.cur_ioport->io1.minimum); 3613 dprintk("sony_pic_call2(0x%.2x - 0x%.2x): 0x%.4x\n", dev, fn, v1); 3614 return v1; 3615 } 3616 3617 static u8 sony_pic_call3(u8 dev, u8 fn, u8 v) 3618 { 3619 u8 v1; 3620 3621 wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG); 3622 outb(dev, spic_dev.cur_ioport->io1.minimum + 4); 3623 wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG); 3624 outb(fn, spic_dev.cur_ioport->io1.minimum); 3625 wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG); 3626 outb(v, spic_dev.cur_ioport->io1.minimum); 3627 v1 = inb_p(spic_dev.cur_ioport->io1.minimum); 3628 dprintk("sony_pic_call3(0x%.2x - 0x%.2x - 0x%.2x): 0x%.4x\n", 3629 dev, fn, v, v1); 3630 return v1; 3631 } 3632 3633 /* 3634 * minidrivers for SPIC models 3635 */ 3636 static int type3_handle_irq(const u8 data_mask, const u8 ev) 3637 { 3638 /* 3639 * 0x31 could mean we have to take some extra action and wait for 3640 * the next irq for some Type3 models, it will generate a new 3641 * irq and we can read new data from the device: 3642 * - 0x5c and 0x5f requires 0xA0 3643 * - 0x61 requires 0xB3 3644 */ 3645 if (data_mask == 0x31) { 3646 if (ev == 0x5c || ev == 0x5f) 3647 sony_pic_call1(0xA0); 3648 else if (ev == 0x61) 3649 sony_pic_call1(0xB3); 3650 return 0; 3651 } 3652 return 1; 3653 } 3654 3655 static void sony_pic_detect_device_type(struct sony_pic_dev *dev) 3656 { 3657 struct pci_dev *pcidev; 3658 3659 pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, 3660 PCI_DEVICE_ID_INTEL_82371AB_3, NULL); 3661 if (pcidev) { 3662 dev->model = SONYPI_DEVICE_TYPE1; 3663 dev->evport_offset = SONYPI_TYPE1_OFFSET; 3664 dev->event_types = type1_events; 3665 goto out; 3666 } 3667 3668 pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, 3669 PCI_DEVICE_ID_INTEL_ICH6_1, NULL); 3670 if (pcidev) { 3671 dev->model = SONYPI_DEVICE_TYPE2; 3672 dev->evport_offset = SONYPI_TYPE2_OFFSET; 3673 dev->event_types = type2_events; 3674 goto out; 3675 } 3676 3677 pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, 3678 PCI_DEVICE_ID_INTEL_ICH7_1, NULL); 3679 if (pcidev) { 3680 dev->model = SONYPI_DEVICE_TYPE3; 3681 dev->handle_irq = type3_handle_irq; 3682 dev->evport_offset = SONYPI_TYPE3_OFFSET; 3683 dev->event_types = type3_events; 3684 goto out; 3685 } 3686 3687 pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, 3688 PCI_DEVICE_ID_INTEL_ICH8_4, NULL); 3689 if (pcidev) { 3690 dev->model = SONYPI_DEVICE_TYPE3; 3691 dev->handle_irq = type3_handle_irq; 3692 dev->evport_offset = SONYPI_TYPE3_OFFSET; 3693 dev->event_types = type3_events; 3694 goto out; 3695 } 3696 3697 pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, 3698 PCI_DEVICE_ID_INTEL_ICH9_1, NULL); 3699 if (pcidev) { 3700 dev->model = SONYPI_DEVICE_TYPE3; 3701 dev->handle_irq = type3_handle_irq; 3702 dev->evport_offset = SONYPI_TYPE3_OFFSET; 3703 dev->event_types = type3_events; 3704 goto out; 3705 } 3706 3707 /* default */ 3708 dev->model = SONYPI_DEVICE_TYPE2; 3709 dev->evport_offset = SONYPI_TYPE2_OFFSET; 3710 dev->event_types = type2_events; 3711 3712 out: 3713 pci_dev_put(pcidev); 3714 3715 pr_info("detected Type%d model\n", 3716 dev->model == SONYPI_DEVICE_TYPE1 ? 1 : 3717 dev->model == SONYPI_DEVICE_TYPE2 ? 2 : 3); 3718 } 3719 3720 /* camera tests and poweron/poweroff */ 3721 #define SONYPI_CAMERA_PICTURE 5 3722 #define SONYPI_CAMERA_CONTROL 0x10 3723 3724 #define SONYPI_CAMERA_BRIGHTNESS 0 3725 #define SONYPI_CAMERA_CONTRAST 1 3726 #define SONYPI_CAMERA_HUE 2 3727 #define SONYPI_CAMERA_COLOR 3 3728 #define SONYPI_CAMERA_SHARPNESS 4 3729 3730 #define SONYPI_CAMERA_EXPOSURE_MASK 0xC 3731 #define SONYPI_CAMERA_WHITE_BALANCE_MASK 0x3 3732 #define SONYPI_CAMERA_PICTURE_MODE_MASK 0x30 3733 #define SONYPI_CAMERA_MUTE_MASK 0x40 3734 3735 /* the rest don't need a loop until not 0xff */ 3736 #define SONYPI_CAMERA_AGC 6 3737 #define SONYPI_CAMERA_AGC_MASK 0x30 3738 #define SONYPI_CAMERA_SHUTTER_MASK 0x7 3739 3740 #define SONYPI_CAMERA_SHUTDOWN_REQUEST 7 3741 #define SONYPI_CAMERA_CONTROL 0x10 3742 3743 #define SONYPI_CAMERA_STATUS 7 3744 #define SONYPI_CAMERA_STATUS_READY 0x2 3745 #define SONYPI_CAMERA_STATUS_POSITION 0x4 3746 3747 #define SONYPI_DIRECTION_BACKWARDS 0x4 3748 3749 #define SONYPI_CAMERA_REVISION 8 3750 #define SONYPI_CAMERA_ROMVERSION 9 3751 3752 static int __sony_pic_camera_ready(void) 3753 { 3754 u8 v; 3755 3756 v = sony_pic_call2(0x8f, SONYPI_CAMERA_STATUS); 3757 return (v != 0xff && (v & SONYPI_CAMERA_STATUS_READY)); 3758 } 3759 3760 static int __sony_pic_camera_off(void) 3761 { 3762 if (!camera) { 3763 pr_warn("camera control not enabled\n"); 3764 return -ENODEV; 3765 } 3766 3767 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, 3768 SONYPI_CAMERA_MUTE_MASK), 3769 ITERATIONS_SHORT); 3770 3771 if (spic_dev.camera_power) { 3772 sony_pic_call2(0x91, 0); 3773 spic_dev.camera_power = 0; 3774 } 3775 return 0; 3776 } 3777 3778 static int __sony_pic_camera_on(void) 3779 { 3780 int i, j, x; 3781 3782 if (!camera) { 3783 pr_warn("camera control not enabled\n"); 3784 return -ENODEV; 3785 } 3786 3787 if (spic_dev.camera_power) 3788 return 0; 3789 3790 for (j = 5; j > 0; j--) { 3791 3792 for (x = 0; x < 100 && sony_pic_call2(0x91, 0x1); x++) 3793 msleep(10); 3794 sony_pic_call1(0x93); 3795 3796 for (i = 400; i > 0; i--) { 3797 if (__sony_pic_camera_ready()) 3798 break; 3799 msleep(10); 3800 } 3801 if (i) 3802 break; 3803 } 3804 3805 if (j == 0) { 3806 pr_warn("failed to power on camera\n"); 3807 return -ENODEV; 3808 } 3809 3810 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTROL, 3811 0x5a), 3812 ITERATIONS_SHORT); 3813 3814 spic_dev.camera_power = 1; 3815 return 0; 3816 } 3817 3818 /* External camera command (exported to the motion eye v4l driver) */ 3819 int sony_pic_camera_command(int command, u8 value) 3820 { 3821 if (!camera) 3822 return -EIO; 3823 3824 mutex_lock(&spic_dev.lock); 3825 3826 switch (command) { 3827 case SONY_PIC_COMMAND_SETCAMERA: 3828 if (value) 3829 __sony_pic_camera_on(); 3830 else 3831 __sony_pic_camera_off(); 3832 break; 3833 case SONY_PIC_COMMAND_SETCAMERABRIGHTNESS: 3834 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_BRIGHTNESS, value), 3835 ITERATIONS_SHORT); 3836 break; 3837 case SONY_PIC_COMMAND_SETCAMERACONTRAST: 3838 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTRAST, value), 3839 ITERATIONS_SHORT); 3840 break; 3841 case SONY_PIC_COMMAND_SETCAMERAHUE: 3842 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_HUE, value), 3843 ITERATIONS_SHORT); 3844 break; 3845 case SONY_PIC_COMMAND_SETCAMERACOLOR: 3846 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_COLOR, value), 3847 ITERATIONS_SHORT); 3848 break; 3849 case SONY_PIC_COMMAND_SETCAMERASHARPNESS: 3850 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_SHARPNESS, value), 3851 ITERATIONS_SHORT); 3852 break; 3853 case SONY_PIC_COMMAND_SETCAMERAPICTURE: 3854 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, value), 3855 ITERATIONS_SHORT); 3856 break; 3857 case SONY_PIC_COMMAND_SETCAMERAAGC: 3858 wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_AGC, value), 3859 ITERATIONS_SHORT); 3860 break; 3861 default: 3862 pr_err("sony_pic_camera_command invalid: %d\n", command); 3863 break; 3864 } 3865 mutex_unlock(&spic_dev.lock); 3866 return 0; 3867 } 3868 EXPORT_SYMBOL(sony_pic_camera_command); 3869 3870 /* gprs/edge modem (SZ460N and SZ210P), thanks to Joshua Wise */ 3871 static void __sony_pic_set_wwanpower(u8 state) 3872 { 3873 state = !!state; 3874 if (spic_dev.wwan_power == state) 3875 return; 3876 sony_pic_call2(0xB0, state); 3877 sony_pic_call1(0x82); 3878 spic_dev.wwan_power = state; 3879 } 3880 3881 static ssize_t sony_pic_wwanpower_store(struct device *dev, 3882 struct device_attribute *attr, 3883 const char *buffer, size_t count) 3884 { 3885 unsigned long value; 3886 if (count > 31) 3887 return -EINVAL; 3888 3889 if (kstrtoul(buffer, 10, &value)) 3890 return -EINVAL; 3891 3892 mutex_lock(&spic_dev.lock); 3893 __sony_pic_set_wwanpower(value); 3894 mutex_unlock(&spic_dev.lock); 3895 3896 return count; 3897 } 3898 3899 static ssize_t sony_pic_wwanpower_show(struct device *dev, 3900 struct device_attribute *attr, char *buffer) 3901 { 3902 ssize_t count; 3903 mutex_lock(&spic_dev.lock); 3904 count = sysfs_emit(buffer, "%d\n", spic_dev.wwan_power); 3905 mutex_unlock(&spic_dev.lock); 3906 return count; 3907 } 3908 3909 /* bluetooth subsystem power state */ 3910 static void __sony_pic_set_bluetoothpower(u8 state) 3911 { 3912 state = !!state; 3913 if (spic_dev.bluetooth_power == state) 3914 return; 3915 sony_pic_call2(0x96, state); 3916 sony_pic_call1(0x82); 3917 spic_dev.bluetooth_power = state; 3918 } 3919 3920 static ssize_t sony_pic_bluetoothpower_store(struct device *dev, 3921 struct device_attribute *attr, 3922 const char *buffer, size_t count) 3923 { 3924 unsigned long value; 3925 if (count > 31) 3926 return -EINVAL; 3927 3928 if (kstrtoul(buffer, 10, &value)) 3929 return -EINVAL; 3930 3931 mutex_lock(&spic_dev.lock); 3932 __sony_pic_set_bluetoothpower(value); 3933 mutex_unlock(&spic_dev.lock); 3934 3935 return count; 3936 } 3937 3938 static ssize_t sony_pic_bluetoothpower_show(struct device *dev, 3939 struct device_attribute *attr, char *buffer) 3940 { 3941 ssize_t count = 0; 3942 mutex_lock(&spic_dev.lock); 3943 count = sysfs_emit(buffer, "%d\n", spic_dev.bluetooth_power); 3944 mutex_unlock(&spic_dev.lock); 3945 return count; 3946 } 3947 3948 /* fan speed */ 3949 /* FAN0 information (reverse engineered from ACPI tables) */ 3950 #define SONY_PIC_FAN0_STATUS 0x93 3951 static int sony_pic_set_fanspeed(unsigned long value) 3952 { 3953 return ec_write(SONY_PIC_FAN0_STATUS, value); 3954 } 3955 3956 static int sony_pic_get_fanspeed(u8 *value) 3957 { 3958 return ec_read(SONY_PIC_FAN0_STATUS, value); 3959 } 3960 3961 static ssize_t sony_pic_fanspeed_store(struct device *dev, 3962 struct device_attribute *attr, 3963 const char *buffer, size_t count) 3964 { 3965 unsigned long value; 3966 if (count > 31) 3967 return -EINVAL; 3968 3969 if (kstrtoul(buffer, 10, &value)) 3970 return -EINVAL; 3971 3972 if (sony_pic_set_fanspeed(value)) 3973 return -EIO; 3974 3975 return count; 3976 } 3977 3978 static ssize_t sony_pic_fanspeed_show(struct device *dev, 3979 struct device_attribute *attr, char *buffer) 3980 { 3981 u8 value = 0; 3982 if (sony_pic_get_fanspeed(&value)) 3983 return -EIO; 3984 3985 return sysfs_emit(buffer, "%d\n", value); 3986 } 3987 3988 #define SPIC_ATTR(_name, _mode) \ 3989 struct device_attribute spic_attr_##_name = __ATTR(_name, \ 3990 _mode, sony_pic_## _name ##_show, \ 3991 sony_pic_## _name ##_store) 3992 3993 static SPIC_ATTR(bluetoothpower, 0644); 3994 static SPIC_ATTR(wwanpower, 0644); 3995 static SPIC_ATTR(fanspeed, 0644); 3996 3997 static struct attribute *spic_attributes[] = { 3998 &spic_attr_bluetoothpower.attr, 3999 &spic_attr_wwanpower.attr, 4000 &spic_attr_fanspeed.attr, 4001 NULL 4002 }; 4003 4004 static const struct attribute_group spic_attribute_group = { 4005 .attrs = spic_attributes 4006 }; 4007 4008 /******** SONYPI compatibility **********/ 4009 #ifdef CONFIG_SONYPI_COMPAT 4010 4011 /* battery / brightness / temperature addresses */ 4012 #define SONYPI_BAT_FLAGS 0x81 4013 #define SONYPI_LCD_LIGHT 0x96 4014 #define SONYPI_BAT1_PCTRM 0xa0 4015 #define SONYPI_BAT1_LEFT 0xa2 4016 #define SONYPI_BAT1_MAXRT 0xa4 4017 #define SONYPI_BAT2_PCTRM 0xa8 4018 #define SONYPI_BAT2_LEFT 0xaa 4019 #define SONYPI_BAT2_MAXRT 0xac 4020 #define SONYPI_BAT1_MAXTK 0xb0 4021 #define SONYPI_BAT1_FULL 0xb2 4022 #define SONYPI_BAT2_MAXTK 0xb8 4023 #define SONYPI_BAT2_FULL 0xba 4024 #define SONYPI_TEMP_STATUS 0xC1 4025 4026 struct sonypi_compat_s { 4027 struct fasync_struct *fifo_async; 4028 struct kfifo fifo; 4029 spinlock_t fifo_lock; 4030 wait_queue_head_t fifo_proc_list; 4031 atomic_t open_count; 4032 }; 4033 static struct sonypi_compat_s sonypi_compat = { 4034 .open_count = ATOMIC_INIT(0), 4035 }; 4036 4037 static int sonypi_misc_fasync(int fd, struct file *filp, int on) 4038 { 4039 return fasync_helper(fd, filp, on, &sonypi_compat.fifo_async); 4040 } 4041 4042 static int sonypi_misc_release(struct inode *inode, struct file *file) 4043 { 4044 atomic_dec(&sonypi_compat.open_count); 4045 return 0; 4046 } 4047 4048 static int sonypi_misc_open(struct inode *inode, struct file *file) 4049 { 4050 /* Flush input queue on first open */ 4051 unsigned long flags; 4052 4053 spin_lock_irqsave(&sonypi_compat.fifo_lock, flags); 4054 4055 if (atomic_inc_return(&sonypi_compat.open_count) == 1) 4056 kfifo_reset(&sonypi_compat.fifo); 4057 4058 spin_unlock_irqrestore(&sonypi_compat.fifo_lock, flags); 4059 4060 return 0; 4061 } 4062 4063 static ssize_t sonypi_misc_read(struct file *file, char __user *buf, 4064 size_t count, loff_t *pos) 4065 { 4066 ssize_t ret; 4067 unsigned char c; 4068 4069 if ((kfifo_len(&sonypi_compat.fifo) == 0) && 4070 (file->f_flags & O_NONBLOCK)) 4071 return -EAGAIN; 4072 4073 ret = wait_event_interruptible(sonypi_compat.fifo_proc_list, 4074 kfifo_len(&sonypi_compat.fifo) != 0); 4075 if (ret) 4076 return ret; 4077 4078 while (ret < count && 4079 (kfifo_out_locked(&sonypi_compat.fifo, &c, sizeof(c), 4080 &sonypi_compat.fifo_lock) == sizeof(c))) { 4081 if (put_user(c, buf++)) 4082 return -EFAULT; 4083 ret++; 4084 } 4085 4086 if (ret > 0) { 4087 struct inode *inode = file_inode(file); 4088 inode->i_atime = current_time(inode); 4089 } 4090 4091 return ret; 4092 } 4093 4094 static __poll_t sonypi_misc_poll(struct file *file, poll_table *wait) 4095 { 4096 poll_wait(file, &sonypi_compat.fifo_proc_list, wait); 4097 if (kfifo_len(&sonypi_compat.fifo)) 4098 return EPOLLIN | EPOLLRDNORM; 4099 return 0; 4100 } 4101 4102 static int ec_read16(u8 addr, u16 *value) 4103 { 4104 u8 val_lb, val_hb; 4105 if (ec_read(addr, &val_lb)) 4106 return -1; 4107 if (ec_read(addr + 1, &val_hb)) 4108 return -1; 4109 *value = val_lb | (val_hb << 8); 4110 return 0; 4111 } 4112 4113 static long sonypi_misc_ioctl(struct file *fp, unsigned int cmd, 4114 unsigned long arg) 4115 { 4116 int ret = 0; 4117 void __user *argp = (void __user *)arg; 4118 u8 val8; 4119 u16 val16; 4120 int value; 4121 4122 mutex_lock(&spic_dev.lock); 4123 switch (cmd) { 4124 case SONYPI_IOCGBRT: 4125 if (sony_bl_props.dev == NULL) { 4126 ret = -EIO; 4127 break; 4128 } 4129 if (sony_nc_int_call(sony_nc_acpi_handle, "GBRT", NULL, 4130 &value)) { 4131 ret = -EIO; 4132 break; 4133 } 4134 val8 = ((value & 0xff) - 1) << 5; 4135 if (copy_to_user(argp, &val8, sizeof(val8))) 4136 ret = -EFAULT; 4137 break; 4138 case SONYPI_IOCSBRT: 4139 if (sony_bl_props.dev == NULL) { 4140 ret = -EIO; 4141 break; 4142 } 4143 if (copy_from_user(&val8, argp, sizeof(val8))) { 4144 ret = -EFAULT; 4145 break; 4146 } 4147 value = (val8 >> 5) + 1; 4148 if (sony_nc_int_call(sony_nc_acpi_handle, "SBRT", &value, 4149 NULL)) { 4150 ret = -EIO; 4151 break; 4152 } 4153 /* sync the backlight device status */ 4154 sony_bl_props.dev->props.brightness = 4155 sony_backlight_get_brightness(sony_bl_props.dev); 4156 break; 4157 case SONYPI_IOCGBAT1CAP: 4158 if (ec_read16(SONYPI_BAT1_FULL, &val16)) { 4159 ret = -EIO; 4160 break; 4161 } 4162 if (copy_to_user(argp, &val16, sizeof(val16))) 4163 ret = -EFAULT; 4164 break; 4165 case SONYPI_IOCGBAT1REM: 4166 if (ec_read16(SONYPI_BAT1_LEFT, &val16)) { 4167 ret = -EIO; 4168 break; 4169 } 4170 if (copy_to_user(argp, &val16, sizeof(val16))) 4171 ret = -EFAULT; 4172 break; 4173 case SONYPI_IOCGBAT2CAP: 4174 if (ec_read16(SONYPI_BAT2_FULL, &val16)) { 4175 ret = -EIO; 4176 break; 4177 } 4178 if (copy_to_user(argp, &val16, sizeof(val16))) 4179 ret = -EFAULT; 4180 break; 4181 case SONYPI_IOCGBAT2REM: 4182 if (ec_read16(SONYPI_BAT2_LEFT, &val16)) { 4183 ret = -EIO; 4184 break; 4185 } 4186 if (copy_to_user(argp, &val16, sizeof(val16))) 4187 ret = -EFAULT; 4188 break; 4189 case SONYPI_IOCGBATFLAGS: 4190 if (ec_read(SONYPI_BAT_FLAGS, &val8)) { 4191 ret = -EIO; 4192 break; 4193 } 4194 val8 &= 0x07; 4195 if (copy_to_user(argp, &val8, sizeof(val8))) 4196 ret = -EFAULT; 4197 break; 4198 case SONYPI_IOCGBLUE: 4199 val8 = spic_dev.bluetooth_power; 4200 if (copy_to_user(argp, &val8, sizeof(val8))) 4201 ret = -EFAULT; 4202 break; 4203 case SONYPI_IOCSBLUE: 4204 if (copy_from_user(&val8, argp, sizeof(val8))) { 4205 ret = -EFAULT; 4206 break; 4207 } 4208 __sony_pic_set_bluetoothpower(val8); 4209 break; 4210 /* FAN Controls */ 4211 case SONYPI_IOCGFAN: 4212 if (sony_pic_get_fanspeed(&val8)) { 4213 ret = -EIO; 4214 break; 4215 } 4216 if (copy_to_user(argp, &val8, sizeof(val8))) 4217 ret = -EFAULT; 4218 break; 4219 case SONYPI_IOCSFAN: 4220 if (copy_from_user(&val8, argp, sizeof(val8))) { 4221 ret = -EFAULT; 4222 break; 4223 } 4224 if (sony_pic_set_fanspeed(val8)) 4225 ret = -EIO; 4226 break; 4227 /* GET Temperature (useful under APM) */ 4228 case SONYPI_IOCGTEMP: 4229 if (ec_read(SONYPI_TEMP_STATUS, &val8)) { 4230 ret = -EIO; 4231 break; 4232 } 4233 if (copy_to_user(argp, &val8, sizeof(val8))) 4234 ret = -EFAULT; 4235 break; 4236 default: 4237 ret = -EINVAL; 4238 } 4239 mutex_unlock(&spic_dev.lock); 4240 return ret; 4241 } 4242 4243 static const struct file_operations sonypi_misc_fops = { 4244 .owner = THIS_MODULE, 4245 .read = sonypi_misc_read, 4246 .poll = sonypi_misc_poll, 4247 .open = sonypi_misc_open, 4248 .release = sonypi_misc_release, 4249 .fasync = sonypi_misc_fasync, 4250 .unlocked_ioctl = sonypi_misc_ioctl, 4251 .llseek = noop_llseek, 4252 }; 4253 4254 static struct miscdevice sonypi_misc_device = { 4255 .minor = MISC_DYNAMIC_MINOR, 4256 .name = "sonypi", 4257 .fops = &sonypi_misc_fops, 4258 }; 4259 4260 static void sonypi_compat_report_event(u8 event) 4261 { 4262 kfifo_in_locked(&sonypi_compat.fifo, (unsigned char *)&event, 4263 sizeof(event), &sonypi_compat.fifo_lock); 4264 kill_fasync(&sonypi_compat.fifo_async, SIGIO, POLL_IN); 4265 wake_up_interruptible(&sonypi_compat.fifo_proc_list); 4266 } 4267 4268 static int sonypi_compat_init(void) 4269 { 4270 int error; 4271 4272 spin_lock_init(&sonypi_compat.fifo_lock); 4273 error = 4274 kfifo_alloc(&sonypi_compat.fifo, SONY_LAPTOP_BUF_SIZE, GFP_KERNEL); 4275 if (error) { 4276 pr_err("kfifo_alloc failed\n"); 4277 return error; 4278 } 4279 4280 init_waitqueue_head(&sonypi_compat.fifo_proc_list); 4281 4282 if (minor != -1) 4283 sonypi_misc_device.minor = minor; 4284 error = misc_register(&sonypi_misc_device); 4285 if (error) { 4286 pr_err("misc_register failed\n"); 4287 goto err_free_kfifo; 4288 } 4289 if (minor == -1) 4290 pr_info("device allocated minor is %d\n", 4291 sonypi_misc_device.minor); 4292 4293 return 0; 4294 4295 err_free_kfifo: 4296 kfifo_free(&sonypi_compat.fifo); 4297 return error; 4298 } 4299 4300 static void sonypi_compat_exit(void) 4301 { 4302 misc_deregister(&sonypi_misc_device); 4303 kfifo_free(&sonypi_compat.fifo); 4304 } 4305 #else 4306 static int sonypi_compat_init(void) { return 0; } 4307 static void sonypi_compat_exit(void) { } 4308 static void sonypi_compat_report_event(u8 event) { } 4309 #endif /* CONFIG_SONYPI_COMPAT */ 4310 4311 /* 4312 * ACPI callbacks 4313 */ 4314 static acpi_status 4315 sony_pic_read_possible_resource(struct acpi_resource *resource, void *context) 4316 { 4317 u32 i; 4318 struct sony_pic_dev *dev = (struct sony_pic_dev *)context; 4319 4320 switch (resource->type) { 4321 case ACPI_RESOURCE_TYPE_START_DEPENDENT: 4322 { 4323 /* start IO enumeration */ 4324 struct sony_pic_ioport *ioport = kzalloc(sizeof(*ioport), GFP_KERNEL); 4325 if (!ioport) 4326 return AE_ERROR; 4327 4328 list_add(&ioport->list, &dev->ioports); 4329 return AE_OK; 4330 } 4331 4332 case ACPI_RESOURCE_TYPE_END_DEPENDENT: 4333 /* end IO enumeration */ 4334 return AE_OK; 4335 4336 case ACPI_RESOURCE_TYPE_IRQ: 4337 { 4338 struct acpi_resource_irq *p = &resource->data.irq; 4339 struct sony_pic_irq *interrupt = NULL; 4340 if (!p->interrupt_count) { 4341 /* 4342 * IRQ descriptors may have no IRQ# bits set, 4343 * particularly those those w/ _STA disabled 4344 */ 4345 dprintk("Blank IRQ resource\n"); 4346 return AE_OK; 4347 } 4348 for (i = 0; i < p->interrupt_count; i++) { 4349 if (!p->interrupts[i]) { 4350 pr_warn("Invalid IRQ %d\n", 4351 p->interrupts[i]); 4352 continue; 4353 } 4354 interrupt = kzalloc(sizeof(*interrupt), 4355 GFP_KERNEL); 4356 if (!interrupt) 4357 return AE_ERROR; 4358 4359 list_add(&interrupt->list, &dev->interrupts); 4360 interrupt->irq.triggering = p->triggering; 4361 interrupt->irq.polarity = p->polarity; 4362 interrupt->irq.shareable = p->shareable; 4363 interrupt->irq.interrupt_count = 1; 4364 interrupt->irq.interrupts[0] = p->interrupts[i]; 4365 } 4366 return AE_OK; 4367 } 4368 case ACPI_RESOURCE_TYPE_IO: 4369 { 4370 struct acpi_resource_io *io = &resource->data.io; 4371 struct sony_pic_ioport *ioport = 4372 list_first_entry(&dev->ioports, struct sony_pic_ioport, list); 4373 if (!ioport->io1.minimum) { 4374 memcpy(&ioport->io1, io, sizeof(*io)); 4375 dprintk("IO1 at 0x%.4x (0x%.2x)\n", ioport->io1.minimum, 4376 ioport->io1.address_length); 4377 } 4378 else if (!ioport->io2.minimum) { 4379 memcpy(&ioport->io2, io, sizeof(*io)); 4380 dprintk("IO2 at 0x%.4x (0x%.2x)\n", ioport->io2.minimum, 4381 ioport->io2.address_length); 4382 } 4383 else { 4384 pr_err("Unknown SPIC Type, more than 2 IO Ports\n"); 4385 return AE_ERROR; 4386 } 4387 return AE_OK; 4388 } 4389 4390 case ACPI_RESOURCE_TYPE_END_TAG: 4391 return AE_OK; 4392 4393 default: 4394 dprintk("Resource %d isn't an IRQ nor an IO port\n", 4395 resource->type); 4396 return AE_CTRL_TERMINATE; 4397 4398 } 4399 } 4400 4401 static int sony_pic_possible_resources(struct acpi_device *device) 4402 { 4403 int result = 0; 4404 acpi_status status = AE_OK; 4405 4406 if (!device) 4407 return -EINVAL; 4408 4409 /* get device status */ 4410 /* see acpi_pci_link_get_current acpi_pci_link_get_possible */ 4411 dprintk("Evaluating _STA\n"); 4412 result = acpi_bus_get_status(device); 4413 if (result) { 4414 pr_warn("Unable to read status\n"); 4415 goto end; 4416 } 4417 4418 if (!device->status.enabled) 4419 dprintk("Device disabled\n"); 4420 else 4421 dprintk("Device enabled\n"); 4422 4423 /* 4424 * Query and parse 'method' 4425 */ 4426 dprintk("Evaluating %s\n", METHOD_NAME__PRS); 4427 status = acpi_walk_resources(device->handle, METHOD_NAME__PRS, 4428 sony_pic_read_possible_resource, &spic_dev); 4429 if (ACPI_FAILURE(status)) { 4430 pr_warn("Failure evaluating %s\n", METHOD_NAME__PRS); 4431 result = -ENODEV; 4432 } 4433 end: 4434 return result; 4435 } 4436 4437 /* 4438 * Disable the spic device by calling its _DIS method 4439 */ 4440 static int sony_pic_disable(struct acpi_device *device) 4441 { 4442 acpi_status ret = acpi_evaluate_object(device->handle, "_DIS", NULL, 4443 NULL); 4444 4445 if (ACPI_FAILURE(ret) && ret != AE_NOT_FOUND) 4446 return -ENXIO; 4447 4448 dprintk("Device disabled\n"); 4449 return 0; 4450 } 4451 4452 4453 /* 4454 * Based on drivers/acpi/pci_link.c:acpi_pci_link_set 4455 * 4456 * Call _SRS to set current resources 4457 */ 4458 static int sony_pic_enable(struct acpi_device *device, 4459 struct sony_pic_ioport *ioport, struct sony_pic_irq *irq) 4460 { 4461 acpi_status status; 4462 int result = 0; 4463 /* Type 1 resource layout is: 4464 * IO 4465 * IO 4466 * IRQNoFlags 4467 * End 4468 * 4469 * Type 2 and 3 resource layout is: 4470 * IO 4471 * IRQNoFlags 4472 * End 4473 */ 4474 struct { 4475 struct acpi_resource res1; 4476 struct acpi_resource res2; 4477 struct acpi_resource res3; 4478 struct acpi_resource res4; 4479 } *resource; 4480 struct acpi_buffer buffer = { 0, NULL }; 4481 4482 if (!ioport || !irq) 4483 return -EINVAL; 4484 4485 /* init acpi_buffer */ 4486 resource = kzalloc(sizeof(*resource) + 1, GFP_KERNEL); 4487 if (!resource) 4488 return -ENOMEM; 4489 4490 buffer.length = sizeof(*resource) + 1; 4491 buffer.pointer = resource; 4492 4493 /* setup Type 1 resources */ 4494 if (spic_dev.model == SONYPI_DEVICE_TYPE1) { 4495 4496 /* setup io resources */ 4497 resource->res1.type = ACPI_RESOURCE_TYPE_IO; 4498 resource->res1.length = sizeof(struct acpi_resource); 4499 memcpy(&resource->res1.data.io, &ioport->io1, 4500 sizeof(struct acpi_resource_io)); 4501 4502 resource->res2.type = ACPI_RESOURCE_TYPE_IO; 4503 resource->res2.length = sizeof(struct acpi_resource); 4504 memcpy(&resource->res2.data.io, &ioport->io2, 4505 sizeof(struct acpi_resource_io)); 4506 4507 /* setup irq resource */ 4508 resource->res3.type = ACPI_RESOURCE_TYPE_IRQ; 4509 resource->res3.length = sizeof(struct acpi_resource); 4510 memcpy(&resource->res3.data.irq, &irq->irq, 4511 sizeof(struct acpi_resource_irq)); 4512 /* we requested a shared irq */ 4513 resource->res3.data.irq.shareable = ACPI_SHARED; 4514 4515 resource->res4.type = ACPI_RESOURCE_TYPE_END_TAG; 4516 resource->res4.length = sizeof(struct acpi_resource); 4517 } 4518 /* setup Type 2/3 resources */ 4519 else { 4520 /* setup io resource */ 4521 resource->res1.type = ACPI_RESOURCE_TYPE_IO; 4522 resource->res1.length = sizeof(struct acpi_resource); 4523 memcpy(&resource->res1.data.io, &ioport->io1, 4524 sizeof(struct acpi_resource_io)); 4525 4526 /* setup irq resource */ 4527 resource->res2.type = ACPI_RESOURCE_TYPE_IRQ; 4528 resource->res2.length = sizeof(struct acpi_resource); 4529 memcpy(&resource->res2.data.irq, &irq->irq, 4530 sizeof(struct acpi_resource_irq)); 4531 /* we requested a shared irq */ 4532 resource->res2.data.irq.shareable = ACPI_SHARED; 4533 4534 resource->res3.type = ACPI_RESOURCE_TYPE_END_TAG; 4535 resource->res3.length = sizeof(struct acpi_resource); 4536 } 4537 4538 /* Attempt to set the resource */ 4539 dprintk("Evaluating _SRS\n"); 4540 status = acpi_set_current_resources(device->handle, &buffer); 4541 4542 /* check for total failure */ 4543 if (ACPI_FAILURE(status)) { 4544 pr_err("Error evaluating _SRS\n"); 4545 result = -ENODEV; 4546 goto end; 4547 } 4548 4549 /* Necessary device initializations calls (from sonypi) */ 4550 sony_pic_call1(0x82); 4551 sony_pic_call2(0x81, 0xff); 4552 sony_pic_call1(compat ? 0x92 : 0x82); 4553 4554 end: 4555 kfree(resource); 4556 return result; 4557 } 4558 4559 /***************** 4560 * 4561 * ISR: some event is available 4562 * 4563 *****************/ 4564 static irqreturn_t sony_pic_irq(int irq, void *dev_id) 4565 { 4566 int i, j; 4567 u8 ev = 0; 4568 u8 data_mask = 0; 4569 u8 device_event = 0; 4570 4571 struct sony_pic_dev *dev = (struct sony_pic_dev *) dev_id; 4572 4573 ev = inb_p(dev->cur_ioport->io1.minimum); 4574 if (dev->cur_ioport->io2.minimum) 4575 data_mask = inb_p(dev->cur_ioport->io2.minimum); 4576 else 4577 data_mask = inb_p(dev->cur_ioport->io1.minimum + 4578 dev->evport_offset); 4579 4580 dprintk("event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n", 4581 ev, data_mask, dev->cur_ioport->io1.minimum, 4582 dev->evport_offset); 4583 4584 if (ev == 0x00 || ev == 0xff) 4585 return IRQ_HANDLED; 4586 4587 for (i = 0; dev->event_types[i].mask; i++) { 4588 4589 if ((data_mask & dev->event_types[i].data) != 4590 dev->event_types[i].data) 4591 continue; 4592 4593 if (!(mask & dev->event_types[i].mask)) 4594 continue; 4595 4596 for (j = 0; dev->event_types[i].events[j].event; j++) { 4597 if (ev == dev->event_types[i].events[j].data) { 4598 device_event = 4599 dev->event_types[i].events[j].event; 4600 /* some events may require ignoring */ 4601 if (!device_event) 4602 return IRQ_HANDLED; 4603 goto found; 4604 } 4605 } 4606 } 4607 /* Still not able to decode the event try to pass 4608 * it over to the minidriver 4609 */ 4610 if (dev->handle_irq && dev->handle_irq(data_mask, ev) == 0) 4611 return IRQ_HANDLED; 4612 4613 dprintk("unknown event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n", 4614 ev, data_mask, dev->cur_ioport->io1.minimum, 4615 dev->evport_offset); 4616 return IRQ_HANDLED; 4617 4618 found: 4619 sony_laptop_report_input_event(device_event); 4620 sonypi_compat_report_event(device_event); 4621 return IRQ_HANDLED; 4622 } 4623 4624 /***************** 4625 * 4626 * ACPI driver 4627 * 4628 *****************/ 4629 static void sony_pic_remove(struct acpi_device *device) 4630 { 4631 struct sony_pic_ioport *io, *tmp_io; 4632 struct sony_pic_irq *irq, *tmp_irq; 4633 4634 if (sony_pic_disable(device)) { 4635 pr_err("Couldn't disable device\n"); 4636 return; 4637 } 4638 4639 free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev); 4640 release_region(spic_dev.cur_ioport->io1.minimum, 4641 spic_dev.cur_ioport->io1.address_length); 4642 if (spic_dev.cur_ioport->io2.minimum) 4643 release_region(spic_dev.cur_ioport->io2.minimum, 4644 spic_dev.cur_ioport->io2.address_length); 4645 4646 sonypi_compat_exit(); 4647 4648 sony_laptop_remove_input(); 4649 4650 /* pf attrs */ 4651 sysfs_remove_group(&sony_pf_device->dev.kobj, &spic_attribute_group); 4652 sony_pf_remove(); 4653 4654 list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) { 4655 list_del(&io->list); 4656 kfree(io); 4657 } 4658 list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) { 4659 list_del(&irq->list); 4660 kfree(irq); 4661 } 4662 spic_dev.cur_ioport = NULL; 4663 spic_dev.cur_irq = NULL; 4664 4665 dprintk(SONY_PIC_DRIVER_NAME " removed.\n"); 4666 } 4667 4668 static int sony_pic_add(struct acpi_device *device) 4669 { 4670 int result; 4671 struct sony_pic_ioport *io, *tmp_io; 4672 struct sony_pic_irq *irq, *tmp_irq; 4673 4674 spic_dev.acpi_dev = device; 4675 strcpy(acpi_device_class(device), "sony/hotkey"); 4676 sony_pic_detect_device_type(&spic_dev); 4677 mutex_init(&spic_dev.lock); 4678 4679 /* read _PRS resources */ 4680 result = sony_pic_possible_resources(device); 4681 if (result) { 4682 pr_err("Unable to read possible resources\n"); 4683 goto err_free_resources; 4684 } 4685 4686 /* setup input devices and helper fifo */ 4687 result = sony_laptop_setup_input(device); 4688 if (result) { 4689 pr_err("Unable to create input devices\n"); 4690 goto err_free_resources; 4691 } 4692 4693 result = sonypi_compat_init(); 4694 if (result) 4695 goto err_remove_input; 4696 4697 /* request io port */ 4698 list_for_each_entry_reverse(io, &spic_dev.ioports, list) { 4699 if (request_region(io->io1.minimum, io->io1.address_length, 4700 "Sony Programmable I/O Device")) { 4701 dprintk("I/O port1: 0x%.4x (0x%.4x) + 0x%.2x\n", 4702 io->io1.minimum, io->io1.maximum, 4703 io->io1.address_length); 4704 /* Type 1 have 2 ioports */ 4705 if (io->io2.minimum) { 4706 if (request_region(io->io2.minimum, 4707 io->io2.address_length, 4708 "Sony Programmable I/O Device")) { 4709 dprintk("I/O port2: 0x%.4x (0x%.4x) + 0x%.2x\n", 4710 io->io2.minimum, io->io2.maximum, 4711 io->io2.address_length); 4712 spic_dev.cur_ioport = io; 4713 break; 4714 } 4715 else { 4716 dprintk("Unable to get I/O port2: " 4717 "0x%.4x (0x%.4x) + 0x%.2x\n", 4718 io->io2.minimum, io->io2.maximum, 4719 io->io2.address_length); 4720 release_region(io->io1.minimum, 4721 io->io1.address_length); 4722 } 4723 } 4724 else { 4725 spic_dev.cur_ioport = io; 4726 break; 4727 } 4728 } 4729 } 4730 if (!spic_dev.cur_ioport) { 4731 pr_err("Failed to request_region\n"); 4732 result = -ENODEV; 4733 goto err_remove_compat; 4734 } 4735 4736 /* request IRQ */ 4737 list_for_each_entry_reverse(irq, &spic_dev.interrupts, list) { 4738 if (!request_irq(irq->irq.interrupts[0], sony_pic_irq, 4739 0, "sony-laptop", &spic_dev)) { 4740 dprintk("IRQ: %d - triggering: %d - " 4741 "polarity: %d - shr: %d\n", 4742 irq->irq.interrupts[0], 4743 irq->irq.triggering, 4744 irq->irq.polarity, 4745 irq->irq.shareable); 4746 spic_dev.cur_irq = irq; 4747 break; 4748 } 4749 } 4750 if (!spic_dev.cur_irq) { 4751 pr_err("Failed to request_irq\n"); 4752 result = -ENODEV; 4753 goto err_release_region; 4754 } 4755 4756 /* set resource status _SRS */ 4757 result = sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq); 4758 if (result) { 4759 pr_err("Couldn't enable device\n"); 4760 goto err_free_irq; 4761 } 4762 4763 spic_dev.bluetooth_power = -1; 4764 /* create device attributes */ 4765 result = sony_pf_add(); 4766 if (result) 4767 goto err_disable_device; 4768 4769 result = sysfs_create_group(&sony_pf_device->dev.kobj, &spic_attribute_group); 4770 if (result) 4771 goto err_remove_pf; 4772 4773 pr_info("SPIC setup done.\n"); 4774 return 0; 4775 4776 err_remove_pf: 4777 sony_pf_remove(); 4778 4779 err_disable_device: 4780 sony_pic_disable(device); 4781 4782 err_free_irq: 4783 free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev); 4784 4785 err_release_region: 4786 release_region(spic_dev.cur_ioport->io1.minimum, 4787 spic_dev.cur_ioport->io1.address_length); 4788 if (spic_dev.cur_ioport->io2.minimum) 4789 release_region(spic_dev.cur_ioport->io2.minimum, 4790 spic_dev.cur_ioport->io2.address_length); 4791 4792 err_remove_compat: 4793 sonypi_compat_exit(); 4794 4795 err_remove_input: 4796 sony_laptop_remove_input(); 4797 4798 err_free_resources: 4799 list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) { 4800 list_del(&io->list); 4801 kfree(io); 4802 } 4803 list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) { 4804 list_del(&irq->list); 4805 kfree(irq); 4806 } 4807 spic_dev.cur_ioport = NULL; 4808 spic_dev.cur_irq = NULL; 4809 4810 return result; 4811 } 4812 4813 #ifdef CONFIG_PM_SLEEP 4814 static int sony_pic_suspend(struct device *dev) 4815 { 4816 if (sony_pic_disable(to_acpi_device(dev))) 4817 return -ENXIO; 4818 return 0; 4819 } 4820 4821 static int sony_pic_resume(struct device *dev) 4822 { 4823 sony_pic_enable(to_acpi_device(dev), 4824 spic_dev.cur_ioport, spic_dev.cur_irq); 4825 return 0; 4826 } 4827 #endif 4828 4829 static SIMPLE_DEV_PM_OPS(sony_pic_pm, sony_pic_suspend, sony_pic_resume); 4830 4831 static const struct acpi_device_id sony_pic_device_ids[] = { 4832 {SONY_PIC_HID, 0}, 4833 {"", 0}, 4834 }; 4835 4836 static struct acpi_driver sony_pic_driver = { 4837 .name = SONY_PIC_DRIVER_NAME, 4838 .class = SONY_PIC_CLASS, 4839 .ids = sony_pic_device_ids, 4840 .owner = THIS_MODULE, 4841 .ops = { 4842 .add = sony_pic_add, 4843 .remove = sony_pic_remove, 4844 }, 4845 .drv.pm = &sony_pic_pm, 4846 }; 4847 4848 static const struct dmi_system_id sonypi_dmi_table[] __initconst = { 4849 { 4850 .ident = "Sony Vaio", 4851 .matches = { 4852 DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), 4853 DMI_MATCH(DMI_PRODUCT_NAME, "PCG-"), 4854 }, 4855 }, 4856 { 4857 .ident = "Sony Vaio", 4858 .matches = { 4859 DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), 4860 DMI_MATCH(DMI_PRODUCT_NAME, "VGN-"), 4861 }, 4862 }, 4863 { } 4864 }; 4865 4866 static int __init sony_laptop_init(void) 4867 { 4868 int result; 4869 4870 if (!no_spic && dmi_check_system(sonypi_dmi_table)) { 4871 result = acpi_bus_register_driver(&sony_pic_driver); 4872 if (result) { 4873 pr_err("Unable to register SPIC driver\n"); 4874 goto out; 4875 } 4876 spic_drv_registered = 1; 4877 } 4878 4879 result = acpi_bus_register_driver(&sony_nc_driver); 4880 if (result) { 4881 pr_err("Unable to register SNC driver\n"); 4882 goto out_unregister_pic; 4883 } 4884 4885 return 0; 4886 4887 out_unregister_pic: 4888 if (spic_drv_registered) 4889 acpi_bus_unregister_driver(&sony_pic_driver); 4890 out: 4891 return result; 4892 } 4893 4894 static void __exit sony_laptop_exit(void) 4895 { 4896 acpi_bus_unregister_driver(&sony_nc_driver); 4897 if (spic_drv_registered) 4898 acpi_bus_unregister_driver(&sony_pic_driver); 4899 } 4900 4901 module_init(sony_laptop_init); 4902 module_exit(sony_laptop_exit); 4903