1 /* 2 * asus-laptop.c - Asus Laptop Support 3 * 4 * 5 * Copyright (C) 2002-2005 Julien Lerouge, 2003-2006 Karol Kozimor 6 * Copyright (C) 2006-2007 Corentin Chary 7 * Copyright (C) 2011 Wind River Systems 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License as published by 11 * the Free Software Foundation; either version 2 of the License, or 12 * (at your option) any later version. 13 * 14 * This program is distributed in the hope that it will be useful, 15 * but WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17 * GNU General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 22 * 23 * 24 * The development page for this driver is located at 25 * http://sourceforge.net/projects/acpi4asus/ 26 * 27 * Credits: 28 * Pontus Fuchs - Helper functions, cleanup 29 * Johann Wiesner - Small compile fixes 30 * John Belmonte - ACPI code for Toshiba laptop was a good starting point. 31 * Eric Burghard - LED display support for W1N 32 * Josh Green - Light Sens support 33 * Thomas Tuttle - His first patch for led support was very helpful 34 * Sam Lin - GPS support 35 */ 36 37 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 38 39 #include <linux/kernel.h> 40 #include <linux/module.h> 41 #include <linux/init.h> 42 #include <linux/types.h> 43 #include <linux/err.h> 44 #include <linux/proc_fs.h> 45 #include <linux/backlight.h> 46 #include <linux/fb.h> 47 #include <linux/leds.h> 48 #include <linux/platform_device.h> 49 #include <linux/uaccess.h> 50 #include <linux/input.h> 51 #include <linux/input/sparse-keymap.h> 52 #include <linux/input-polldev.h> 53 #include <linux/rfkill.h> 54 #include <linux/slab.h> 55 #include <linux/dmi.h> 56 #include <linux/acpi.h> 57 58 #define ASUS_LAPTOP_VERSION "0.42" 59 60 #define ASUS_LAPTOP_NAME "Asus Laptop Support" 61 #define ASUS_LAPTOP_CLASS "hotkey" 62 #define ASUS_LAPTOP_DEVICE_NAME "Hotkey" 63 #define ASUS_LAPTOP_FILE KBUILD_MODNAME 64 #define ASUS_LAPTOP_PREFIX "\\_SB.ATKD." 65 66 MODULE_AUTHOR("Julien Lerouge, Karol Kozimor, Corentin Chary"); 67 MODULE_DESCRIPTION(ASUS_LAPTOP_NAME); 68 MODULE_LICENSE("GPL"); 69 70 /* 71 * WAPF defines the behavior of the Fn+Fx wlan key 72 * The significance of values is yet to be found, but 73 * most of the time: 74 * Bit | Bluetooth | WLAN 75 * 0 | Hardware | Hardware 76 * 1 | Hardware | Software 77 * 4 | Software | Software 78 */ 79 static uint wapf = 1; 80 module_param(wapf, uint, 0444); 81 MODULE_PARM_DESC(wapf, "WAPF value"); 82 83 static char *wled_type = "unknown"; 84 static char *bled_type = "unknown"; 85 86 module_param(wled_type, charp, 0444); 87 MODULE_PARM_DESC(wled_type, "Set the wled type on boot " 88 "(unknown, led or rfkill). " 89 "default is unknown"); 90 91 module_param(bled_type, charp, 0444); 92 MODULE_PARM_DESC(bled_type, "Set the bled type on boot " 93 "(unknown, led or rfkill). " 94 "default is unknown"); 95 96 static int wlan_status = 1; 97 static int bluetooth_status = 1; 98 static int wimax_status = -1; 99 static int wwan_status = -1; 100 static int als_status; 101 102 module_param(wlan_status, int, 0444); 103 MODULE_PARM_DESC(wlan_status, "Set the wireless status on boot " 104 "(0 = disabled, 1 = enabled, -1 = don't do anything). " 105 "default is -1"); 106 107 module_param(bluetooth_status, int, 0444); 108 MODULE_PARM_DESC(bluetooth_status, "Set the wireless status on boot " 109 "(0 = disabled, 1 = enabled, -1 = don't do anything). " 110 "default is -1"); 111 112 module_param(wimax_status, int, 0444); 113 MODULE_PARM_DESC(wimax_status, "Set the wireless status on boot " 114 "(0 = disabled, 1 = enabled, -1 = don't do anything). " 115 "default is -1"); 116 117 module_param(wwan_status, int, 0444); 118 MODULE_PARM_DESC(wwan_status, "Set the wireless status on boot " 119 "(0 = disabled, 1 = enabled, -1 = don't do anything). " 120 "default is -1"); 121 122 module_param(als_status, int, 0444); 123 MODULE_PARM_DESC(als_status, "Set the ALS status on boot " 124 "(0 = disabled, 1 = enabled). " 125 "default is 0"); 126 127 /* 128 * Some events we use, same for all Asus 129 */ 130 #define ATKD_BRNUP_MIN 0x10 131 #define ATKD_BRNUP_MAX 0x1f 132 #define ATKD_BRNDOWN_MIN 0x20 133 #define ATKD_BRNDOWN_MAX 0x2f 134 #define ATKD_BRNDOWN 0x20 135 #define ATKD_BRNUP 0x2f 136 #define ATKD_LCD_ON 0x33 137 #define ATKD_LCD_OFF 0x34 138 139 /* 140 * Known bits returned by \_SB.ATKD.HWRS 141 */ 142 #define WL_HWRS 0x80 143 #define BT_HWRS 0x100 144 145 /* 146 * Flags for hotk status 147 * WL_ON and BT_ON are also used for wireless_status() 148 */ 149 #define WL_RSTS 0x01 /* internal Wifi */ 150 #define BT_RSTS 0x02 /* internal Bluetooth */ 151 #define WM_RSTS 0x08 /* internal wimax */ 152 #define WW_RSTS 0x20 /* internal wwan */ 153 154 /* WLED and BLED type */ 155 #define TYPE_UNKNOWN 0 156 #define TYPE_LED 1 157 #define TYPE_RFKILL 2 158 159 /* LED */ 160 #define METHOD_MLED "MLED" 161 #define METHOD_TLED "TLED" 162 #define METHOD_RLED "RLED" /* W1JC */ 163 #define METHOD_PLED "PLED" /* A7J */ 164 #define METHOD_GLED "GLED" /* G1, G2 (probably) */ 165 166 /* LEDD */ 167 #define METHOD_LEDD "SLCM" 168 169 /* 170 * Bluetooth and WLAN 171 * WLED and BLED are not handled like other XLED, because in some dsdt 172 * they also control the WLAN/Bluetooth device. 173 */ 174 #define METHOD_WLAN "WLED" 175 #define METHOD_BLUETOOTH "BLED" 176 177 /* WWAN and WIMAX */ 178 #define METHOD_WWAN "GSMC" 179 #define METHOD_WIMAX "WMXC" 180 181 #define METHOD_WL_STATUS "RSTS" 182 183 /* Brightness */ 184 #define METHOD_BRIGHTNESS_SET "SPLV" 185 #define METHOD_BRIGHTNESS_GET "GPLV" 186 187 /* Display */ 188 #define METHOD_SWITCH_DISPLAY "SDSP" 189 190 #define METHOD_ALS_CONTROL "ALSC" /* Z71A Z71V */ 191 #define METHOD_ALS_LEVEL "ALSL" /* Z71A Z71V */ 192 193 /* GPS */ 194 /* R2H use different handle for GPS on/off */ 195 #define METHOD_GPS_ON "SDON" 196 #define METHOD_GPS_OFF "SDOF" 197 #define METHOD_GPS_STATUS "GPST" 198 199 /* Keyboard light */ 200 #define METHOD_KBD_LIGHT_SET "SLKB" 201 #define METHOD_KBD_LIGHT_GET "GLKB" 202 203 /* For Pegatron Lucid tablet */ 204 #define DEVICE_NAME_PEGA "Lucid" 205 206 #define METHOD_PEGA_ENABLE "ENPR" 207 #define METHOD_PEGA_DISABLE "DAPR" 208 #define PEGA_WLAN 0x00 209 #define PEGA_BLUETOOTH 0x01 210 #define PEGA_WWAN 0x02 211 #define PEGA_ALS 0x04 212 #define PEGA_ALS_POWER 0x05 213 214 #define METHOD_PEGA_READ "RDLN" 215 #define PEGA_READ_ALS_H 0x02 216 #define PEGA_READ_ALS_L 0x03 217 218 #define PEGA_ACCEL_NAME "pega_accel" 219 #define PEGA_ACCEL_DESC "Pegatron Lucid Tablet Accelerometer" 220 #define METHOD_XLRX "XLRX" 221 #define METHOD_XLRY "XLRY" 222 #define METHOD_XLRZ "XLRZ" 223 #define PEGA_ACC_CLAMP 512 /* 1G accel is reported as ~256, so clamp to 2G */ 224 #define PEGA_ACC_RETRIES 3 225 226 /* 227 * Define a specific led structure to keep the main structure clean 228 */ 229 struct asus_led { 230 int wk; 231 struct work_struct work; 232 struct led_classdev led; 233 struct asus_laptop *asus; 234 const char *method; 235 }; 236 237 /* 238 * Same thing for rfkill 239 */ 240 struct asus_rfkill { 241 /* type of control. Maps to PEGA_* values or *_RSTS */ 242 int control_id; 243 struct rfkill *rfkill; 244 struct asus_laptop *asus; 245 }; 246 247 /* 248 * This is the main structure, we can use it to store anything interesting 249 * about the hotk device 250 */ 251 struct asus_laptop { 252 char *name; /* laptop name */ 253 254 struct acpi_table_header *dsdt_info; 255 struct platform_device *platform_device; 256 struct acpi_device *device; /* the device we are in */ 257 struct backlight_device *backlight_device; 258 259 struct input_dev *inputdev; 260 struct key_entry *keymap; 261 struct input_polled_dev *pega_accel_poll; 262 263 struct asus_led wled; 264 struct asus_led bled; 265 struct asus_led mled; 266 struct asus_led tled; 267 struct asus_led rled; 268 struct asus_led pled; 269 struct asus_led gled; 270 struct asus_led kled; 271 struct workqueue_struct *led_workqueue; 272 273 int wled_type; 274 int bled_type; 275 int wireless_status; 276 bool have_rsts; 277 bool is_pega_lucid; 278 bool pega_acc_live; 279 int pega_acc_x; 280 int pega_acc_y; 281 int pega_acc_z; 282 283 struct asus_rfkill wlan; 284 struct asus_rfkill bluetooth; 285 struct asus_rfkill wwan; 286 struct asus_rfkill wimax; 287 struct asus_rfkill gps; 288 289 acpi_handle handle; /* the handle of the hotk device */ 290 u32 ledd_status; /* status of the LED display */ 291 u8 light_level; /* light sensor level */ 292 u8 light_switch; /* light sensor switch value */ 293 u16 event_count[128]; /* count for each event TODO make this better */ 294 }; 295 296 static const struct key_entry asus_keymap[] = { 297 /* Lenovo SL Specific keycodes */ 298 {KE_KEY, 0x02, { KEY_SCREENLOCK } }, 299 {KE_KEY, 0x05, { KEY_WLAN } }, 300 {KE_KEY, 0x08, { KEY_F13 } }, 301 {KE_KEY, 0x09, { KEY_PROG2 } }, /* Dock */ 302 {KE_KEY, 0x17, { KEY_ZOOM } }, 303 {KE_KEY, 0x1f, { KEY_BATTERY } }, 304 /* End of Lenovo SL Specific keycodes */ 305 {KE_KEY, ATKD_BRNDOWN, { KEY_BRIGHTNESSDOWN } }, 306 {KE_KEY, ATKD_BRNUP, { KEY_BRIGHTNESSUP } }, 307 {KE_KEY, 0x30, { KEY_VOLUMEUP } }, 308 {KE_KEY, 0x31, { KEY_VOLUMEDOWN } }, 309 {KE_KEY, 0x32, { KEY_MUTE } }, 310 {KE_KEY, 0x33, { KEY_DISPLAYTOGGLE } }, /* LCD on */ 311 {KE_KEY, 0x34, { KEY_DISPLAY_OFF } }, /* LCD off */ 312 {KE_KEY, 0x40, { KEY_PREVIOUSSONG } }, 313 {KE_KEY, 0x41, { KEY_NEXTSONG } }, 314 {KE_KEY, 0x43, { KEY_STOPCD } }, /* Stop/Eject */ 315 {KE_KEY, 0x45, { KEY_PLAYPAUSE } }, 316 {KE_KEY, 0x4c, { KEY_MEDIA } }, /* WMP Key */ 317 {KE_KEY, 0x50, { KEY_EMAIL } }, 318 {KE_KEY, 0x51, { KEY_WWW } }, 319 {KE_KEY, 0x55, { KEY_CALC } }, 320 {KE_IGNORE, 0x57, }, /* Battery mode */ 321 {KE_IGNORE, 0x58, }, /* AC mode */ 322 {KE_KEY, 0x5C, { KEY_SCREENLOCK } }, /* Screenlock */ 323 {KE_KEY, 0x5D, { KEY_WLAN } }, /* WLAN Toggle */ 324 {KE_KEY, 0x5E, { KEY_WLAN } }, /* WLAN Enable */ 325 {KE_KEY, 0x5F, { KEY_WLAN } }, /* WLAN Disable */ 326 {KE_KEY, 0x60, { KEY_TOUCHPAD_ON } }, 327 {KE_KEY, 0x61, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD only */ 328 {KE_KEY, 0x62, { KEY_SWITCHVIDEOMODE } }, /* SDSP CRT only */ 329 {KE_KEY, 0x63, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + CRT */ 330 {KE_KEY, 0x64, { KEY_SWITCHVIDEOMODE } }, /* SDSP TV */ 331 {KE_KEY, 0x65, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + TV */ 332 {KE_KEY, 0x66, { KEY_SWITCHVIDEOMODE } }, /* SDSP CRT + TV */ 333 {KE_KEY, 0x67, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + CRT + TV */ 334 {KE_KEY, 0x6B, { KEY_TOUCHPAD_TOGGLE } }, /* Lock Touchpad */ 335 {KE_KEY, 0x6C, { KEY_SLEEP } }, /* Suspend */ 336 {KE_KEY, 0x6D, { KEY_SLEEP } }, /* Hibernate */ 337 {KE_IGNORE, 0x6E, }, /* Low Battery notification */ 338 {KE_KEY, 0x7D, { KEY_BLUETOOTH } }, /* Bluetooth Enable */ 339 {KE_KEY, 0x7E, { KEY_BLUETOOTH } }, /* Bluetooth Disable */ 340 {KE_KEY, 0x82, { KEY_CAMERA } }, 341 {KE_KEY, 0x88, { KEY_RFKILL } }, /* Radio Toggle Key */ 342 {KE_KEY, 0x8A, { KEY_PROG1 } }, /* Color enhancement mode */ 343 {KE_KEY, 0x8C, { KEY_SWITCHVIDEOMODE } }, /* SDSP DVI only */ 344 {KE_KEY, 0x8D, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + DVI */ 345 {KE_KEY, 0x8E, { KEY_SWITCHVIDEOMODE } }, /* SDSP CRT + DVI */ 346 {KE_KEY, 0x8F, { KEY_SWITCHVIDEOMODE } }, /* SDSP TV + DVI */ 347 {KE_KEY, 0x90, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + CRT + DVI */ 348 {KE_KEY, 0x91, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + TV + DVI */ 349 {KE_KEY, 0x92, { KEY_SWITCHVIDEOMODE } }, /* SDSP CRT + TV + DVI */ 350 {KE_KEY, 0x93, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + CRT + TV + DVI */ 351 {KE_KEY, 0x95, { KEY_MEDIA } }, 352 {KE_KEY, 0x99, { KEY_PHONE } }, 353 {KE_KEY, 0xA0, { KEY_SWITCHVIDEOMODE } }, /* SDSP HDMI only */ 354 {KE_KEY, 0xA1, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + HDMI */ 355 {KE_KEY, 0xA2, { KEY_SWITCHVIDEOMODE } }, /* SDSP CRT + HDMI */ 356 {KE_KEY, 0xA3, { KEY_SWITCHVIDEOMODE } }, /* SDSP TV + HDMI */ 357 {KE_KEY, 0xA4, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + CRT + HDMI */ 358 {KE_KEY, 0xA5, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + TV + HDMI */ 359 {KE_KEY, 0xA6, { KEY_SWITCHVIDEOMODE } }, /* SDSP CRT + TV + HDMI */ 360 {KE_KEY, 0xA7, { KEY_SWITCHVIDEOMODE } }, /* SDSP LCD + CRT + TV + HDMI */ 361 {KE_KEY, 0xB5, { KEY_CALC } }, 362 {KE_KEY, 0xC4, { KEY_KBDILLUMUP } }, 363 {KE_KEY, 0xC5, { KEY_KBDILLUMDOWN } }, 364 {KE_END, 0}, 365 }; 366 367 368 /* 369 * This function evaluates an ACPI method, given an int as parameter, the 370 * method is searched within the scope of the handle, can be NULL. The output 371 * of the method is written is output, which can also be NULL 372 * 373 * returns 0 if write is successful, -1 else. 374 */ 375 static int write_acpi_int_ret(acpi_handle handle, const char *method, int val, 376 struct acpi_buffer *output) 377 { 378 struct acpi_object_list params; /* list of input parameters (an int) */ 379 union acpi_object in_obj; /* the only param we use */ 380 acpi_status status; 381 382 if (!handle) 383 return -1; 384 385 params.count = 1; 386 params.pointer = &in_obj; 387 in_obj.type = ACPI_TYPE_INTEGER; 388 in_obj.integer.value = val; 389 390 status = acpi_evaluate_object(handle, (char *)method, ¶ms, output); 391 if (status == AE_OK) 392 return 0; 393 else 394 return -1; 395 } 396 397 static int write_acpi_int(acpi_handle handle, const char *method, int val) 398 { 399 return write_acpi_int_ret(handle, method, val, NULL); 400 } 401 402 static int acpi_check_handle(acpi_handle handle, const char *method, 403 acpi_handle *ret) 404 { 405 acpi_status status; 406 407 if (method == NULL) 408 return -ENODEV; 409 410 if (ret) 411 status = acpi_get_handle(handle, (char *)method, 412 ret); 413 else { 414 acpi_handle dummy; 415 416 status = acpi_get_handle(handle, (char *)method, 417 &dummy); 418 } 419 420 if (status != AE_OK) { 421 if (ret) 422 pr_warn("Error finding %s\n", method); 423 return -ENODEV; 424 } 425 return 0; 426 } 427 428 static bool asus_check_pega_lucid(struct asus_laptop *asus) 429 { 430 return !strcmp(asus->name, DEVICE_NAME_PEGA) && 431 !acpi_check_handle(asus->handle, METHOD_PEGA_ENABLE, NULL) && 432 !acpi_check_handle(asus->handle, METHOD_PEGA_DISABLE, NULL) && 433 !acpi_check_handle(asus->handle, METHOD_PEGA_READ, NULL); 434 } 435 436 static int asus_pega_lucid_set(struct asus_laptop *asus, int unit, bool enable) 437 { 438 char *method = enable ? METHOD_PEGA_ENABLE : METHOD_PEGA_DISABLE; 439 return write_acpi_int(asus->handle, method, unit); 440 } 441 442 static int pega_acc_axis(struct asus_laptop *asus, int curr, char *method) 443 { 444 int i, delta; 445 unsigned long long val; 446 for (i = 0; i < PEGA_ACC_RETRIES; i++) { 447 acpi_evaluate_integer(asus->handle, method, NULL, &val); 448 449 /* The output is noisy. From reading the ASL 450 * dissassembly, timeout errors are returned with 1's 451 * in the high word, and the lack of locking around 452 * thei hi/lo byte reads means that a transition 453 * between (for example) -1 and 0 could be read as 454 * 0xff00 or 0x00ff. */ 455 delta = abs(curr - (short)val); 456 if (delta < 128 && !(val & ~0xffff)) 457 break; 458 } 459 return clamp_val((short)val, -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP); 460 } 461 462 static void pega_accel_poll(struct input_polled_dev *ipd) 463 { 464 struct device *parent = ipd->input->dev.parent; 465 struct asus_laptop *asus = dev_get_drvdata(parent); 466 467 /* In some cases, the very first call to poll causes a 468 * recursive fault under the polldev worker. This is 469 * apparently related to very early userspace access to the 470 * device, and perhaps a firmware bug. Fake the first report. */ 471 if (!asus->pega_acc_live) { 472 asus->pega_acc_live = true; 473 input_report_abs(ipd->input, ABS_X, 0); 474 input_report_abs(ipd->input, ABS_Y, 0); 475 input_report_abs(ipd->input, ABS_Z, 0); 476 input_sync(ipd->input); 477 return; 478 } 479 480 asus->pega_acc_x = pega_acc_axis(asus, asus->pega_acc_x, METHOD_XLRX); 481 asus->pega_acc_y = pega_acc_axis(asus, asus->pega_acc_y, METHOD_XLRY); 482 asus->pega_acc_z = pega_acc_axis(asus, asus->pega_acc_z, METHOD_XLRZ); 483 484 /* Note transform, convert to "right/up/out" in the native 485 * landscape orientation (i.e. the vector is the direction of 486 * "real up" in the device's cartiesian coordinates). */ 487 input_report_abs(ipd->input, ABS_X, -asus->pega_acc_x); 488 input_report_abs(ipd->input, ABS_Y, -asus->pega_acc_y); 489 input_report_abs(ipd->input, ABS_Z, asus->pega_acc_z); 490 input_sync(ipd->input); 491 } 492 493 static void pega_accel_exit(struct asus_laptop *asus) 494 { 495 if (asus->pega_accel_poll) { 496 input_unregister_polled_device(asus->pega_accel_poll); 497 input_free_polled_device(asus->pega_accel_poll); 498 } 499 asus->pega_accel_poll = NULL; 500 } 501 502 static int pega_accel_init(struct asus_laptop *asus) 503 { 504 int err; 505 struct input_polled_dev *ipd; 506 507 if (!asus->is_pega_lucid) 508 return -ENODEV; 509 510 if (acpi_check_handle(asus->handle, METHOD_XLRX, NULL) || 511 acpi_check_handle(asus->handle, METHOD_XLRY, NULL) || 512 acpi_check_handle(asus->handle, METHOD_XLRZ, NULL)) 513 return -ENODEV; 514 515 ipd = input_allocate_polled_device(); 516 if (!ipd) 517 return -ENOMEM; 518 519 ipd->poll = pega_accel_poll; 520 ipd->poll_interval = 125; 521 ipd->poll_interval_min = 50; 522 ipd->poll_interval_max = 2000; 523 524 ipd->input->name = PEGA_ACCEL_DESC; 525 ipd->input->phys = PEGA_ACCEL_NAME "/input0"; 526 ipd->input->dev.parent = &asus->platform_device->dev; 527 ipd->input->id.bustype = BUS_HOST; 528 529 set_bit(EV_ABS, ipd->input->evbit); 530 input_set_abs_params(ipd->input, ABS_X, 531 -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP, 0, 0); 532 input_set_abs_params(ipd->input, ABS_Y, 533 -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP, 0, 0); 534 input_set_abs_params(ipd->input, ABS_Z, 535 -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP, 0, 0); 536 537 err = input_register_polled_device(ipd); 538 if (err) 539 goto exit; 540 541 asus->pega_accel_poll = ipd; 542 return 0; 543 544 exit: 545 input_free_polled_device(ipd); 546 return err; 547 } 548 549 /* Generic LED function */ 550 static int asus_led_set(struct asus_laptop *asus, const char *method, 551 int value) 552 { 553 if (!strcmp(method, METHOD_MLED)) 554 value = !value; 555 else if (!strcmp(method, METHOD_GLED)) 556 value = !value + 1; 557 else 558 value = !!value; 559 560 return write_acpi_int(asus->handle, method, value); 561 } 562 563 /* 564 * LEDs 565 */ 566 /* /sys/class/led handlers */ 567 static void asus_led_cdev_set(struct led_classdev *led_cdev, 568 enum led_brightness value) 569 { 570 struct asus_led *led = container_of(led_cdev, struct asus_led, led); 571 struct asus_laptop *asus = led->asus; 572 573 led->wk = !!value; 574 queue_work(asus->led_workqueue, &led->work); 575 } 576 577 static void asus_led_cdev_update(struct work_struct *work) 578 { 579 struct asus_led *led = container_of(work, struct asus_led, work); 580 struct asus_laptop *asus = led->asus; 581 582 asus_led_set(asus, led->method, led->wk); 583 } 584 585 static enum led_brightness asus_led_cdev_get(struct led_classdev *led_cdev) 586 { 587 return led_cdev->brightness; 588 } 589 590 /* 591 * Keyboard backlight (also a LED) 592 */ 593 static int asus_kled_lvl(struct asus_laptop *asus) 594 { 595 unsigned long long kblv; 596 struct acpi_object_list params; 597 union acpi_object in_obj; 598 acpi_status rv; 599 600 params.count = 1; 601 params.pointer = &in_obj; 602 in_obj.type = ACPI_TYPE_INTEGER; 603 in_obj.integer.value = 2; 604 605 rv = acpi_evaluate_integer(asus->handle, METHOD_KBD_LIGHT_GET, 606 ¶ms, &kblv); 607 if (ACPI_FAILURE(rv)) { 608 pr_warn("Error reading kled level\n"); 609 return -ENODEV; 610 } 611 return kblv; 612 } 613 614 static int asus_kled_set(struct asus_laptop *asus, int kblv) 615 { 616 if (kblv > 0) 617 kblv = (1 << 7) | (kblv & 0x7F); 618 else 619 kblv = 0; 620 621 if (write_acpi_int(asus->handle, METHOD_KBD_LIGHT_SET, kblv)) { 622 pr_warn("Keyboard LED display write failed\n"); 623 return -EINVAL; 624 } 625 return 0; 626 } 627 628 static void asus_kled_cdev_set(struct led_classdev *led_cdev, 629 enum led_brightness value) 630 { 631 struct asus_led *led = container_of(led_cdev, struct asus_led, led); 632 struct asus_laptop *asus = led->asus; 633 634 led->wk = value; 635 queue_work(asus->led_workqueue, &led->work); 636 } 637 638 static void asus_kled_cdev_update(struct work_struct *work) 639 { 640 struct asus_led *led = container_of(work, struct asus_led, work); 641 struct asus_laptop *asus = led->asus; 642 643 asus_kled_set(asus, led->wk); 644 } 645 646 static enum led_brightness asus_kled_cdev_get(struct led_classdev *led_cdev) 647 { 648 struct asus_led *led = container_of(led_cdev, struct asus_led, led); 649 struct asus_laptop *asus = led->asus; 650 651 return asus_kled_lvl(asus); 652 } 653 654 static void asus_led_exit(struct asus_laptop *asus) 655 { 656 if (!IS_ERR_OR_NULL(asus->wled.led.dev)) 657 led_classdev_unregister(&asus->wled.led); 658 if (!IS_ERR_OR_NULL(asus->bled.led.dev)) 659 led_classdev_unregister(&asus->bled.led); 660 if (!IS_ERR_OR_NULL(asus->mled.led.dev)) 661 led_classdev_unregister(&asus->mled.led); 662 if (!IS_ERR_OR_NULL(asus->tled.led.dev)) 663 led_classdev_unregister(&asus->tled.led); 664 if (!IS_ERR_OR_NULL(asus->pled.led.dev)) 665 led_classdev_unregister(&asus->pled.led); 666 if (!IS_ERR_OR_NULL(asus->rled.led.dev)) 667 led_classdev_unregister(&asus->rled.led); 668 if (!IS_ERR_OR_NULL(asus->gled.led.dev)) 669 led_classdev_unregister(&asus->gled.led); 670 if (!IS_ERR_OR_NULL(asus->kled.led.dev)) 671 led_classdev_unregister(&asus->kled.led); 672 if (asus->led_workqueue) { 673 destroy_workqueue(asus->led_workqueue); 674 asus->led_workqueue = NULL; 675 } 676 } 677 678 /* Ugly macro, need to fix that later */ 679 static int asus_led_register(struct asus_laptop *asus, 680 struct asus_led *led, 681 const char *name, const char *method) 682 { 683 struct led_classdev *led_cdev = &led->led; 684 685 if (!method || acpi_check_handle(asus->handle, method, NULL)) 686 return 0; /* Led not present */ 687 688 led->asus = asus; 689 led->method = method; 690 691 INIT_WORK(&led->work, asus_led_cdev_update); 692 led_cdev->name = name; 693 led_cdev->brightness_set = asus_led_cdev_set; 694 led_cdev->brightness_get = asus_led_cdev_get; 695 led_cdev->max_brightness = 1; 696 return led_classdev_register(&asus->platform_device->dev, led_cdev); 697 } 698 699 static int asus_led_init(struct asus_laptop *asus) 700 { 701 int r = 0; 702 703 /* 704 * The Pegatron Lucid has no physical leds, but all methods are 705 * available in the DSDT... 706 */ 707 if (asus->is_pega_lucid) 708 return 0; 709 710 /* 711 * Functions that actually update the LED's are called from a 712 * workqueue. By doing this as separate work rather than when the LED 713 * subsystem asks, we avoid messing with the Asus ACPI stuff during a 714 * potentially bad time, such as a timer interrupt. 715 */ 716 asus->led_workqueue = create_singlethread_workqueue("led_workqueue"); 717 if (!asus->led_workqueue) 718 return -ENOMEM; 719 720 if (asus->wled_type == TYPE_LED) 721 r = asus_led_register(asus, &asus->wled, "asus::wlan", 722 METHOD_WLAN); 723 if (r) 724 goto error; 725 if (asus->bled_type == TYPE_LED) 726 r = asus_led_register(asus, &asus->bled, "asus::bluetooth", 727 METHOD_BLUETOOTH); 728 if (r) 729 goto error; 730 r = asus_led_register(asus, &asus->mled, "asus::mail", METHOD_MLED); 731 if (r) 732 goto error; 733 r = asus_led_register(asus, &asus->tled, "asus::touchpad", METHOD_TLED); 734 if (r) 735 goto error; 736 r = asus_led_register(asus, &asus->rled, "asus::record", METHOD_RLED); 737 if (r) 738 goto error; 739 r = asus_led_register(asus, &asus->pled, "asus::phone", METHOD_PLED); 740 if (r) 741 goto error; 742 r = asus_led_register(asus, &asus->gled, "asus::gaming", METHOD_GLED); 743 if (r) 744 goto error; 745 if (!acpi_check_handle(asus->handle, METHOD_KBD_LIGHT_SET, NULL) && 746 !acpi_check_handle(asus->handle, METHOD_KBD_LIGHT_GET, NULL)) { 747 struct asus_led *led = &asus->kled; 748 struct led_classdev *cdev = &led->led; 749 750 led->asus = asus; 751 752 INIT_WORK(&led->work, asus_kled_cdev_update); 753 cdev->name = "asus::kbd_backlight"; 754 cdev->brightness_set = asus_kled_cdev_set; 755 cdev->brightness_get = asus_kled_cdev_get; 756 cdev->max_brightness = 3; 757 r = led_classdev_register(&asus->platform_device->dev, cdev); 758 } 759 error: 760 if (r) 761 asus_led_exit(asus); 762 return r; 763 } 764 765 /* 766 * Backlight device 767 */ 768 static int asus_read_brightness(struct backlight_device *bd) 769 { 770 struct asus_laptop *asus = bl_get_data(bd); 771 unsigned long long value; 772 acpi_status rv = AE_OK; 773 774 rv = acpi_evaluate_integer(asus->handle, METHOD_BRIGHTNESS_GET, 775 NULL, &value); 776 if (ACPI_FAILURE(rv)) 777 pr_warn("Error reading brightness\n"); 778 779 return value; 780 } 781 782 static int asus_set_brightness(struct backlight_device *bd, int value) 783 { 784 struct asus_laptop *asus = bl_get_data(bd); 785 786 if (write_acpi_int(asus->handle, METHOD_BRIGHTNESS_SET, value)) { 787 pr_warn("Error changing brightness\n"); 788 return -EIO; 789 } 790 return 0; 791 } 792 793 static int update_bl_status(struct backlight_device *bd) 794 { 795 int value = bd->props.brightness; 796 797 return asus_set_brightness(bd, value); 798 } 799 800 static const struct backlight_ops asusbl_ops = { 801 .get_brightness = asus_read_brightness, 802 .update_status = update_bl_status, 803 }; 804 805 static int asus_backlight_notify(struct asus_laptop *asus) 806 { 807 struct backlight_device *bd = asus->backlight_device; 808 int old = bd->props.brightness; 809 810 backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY); 811 812 return old; 813 } 814 815 static int asus_backlight_init(struct asus_laptop *asus) 816 { 817 struct backlight_device *bd; 818 struct backlight_properties props; 819 820 if (acpi_check_handle(asus->handle, METHOD_BRIGHTNESS_GET, NULL) || 821 acpi_check_handle(asus->handle, METHOD_BRIGHTNESS_SET, NULL)) 822 return 0; 823 824 memset(&props, 0, sizeof(struct backlight_properties)); 825 props.max_brightness = 15; 826 props.type = BACKLIGHT_PLATFORM; 827 828 bd = backlight_device_register(ASUS_LAPTOP_FILE, 829 &asus->platform_device->dev, asus, 830 &asusbl_ops, &props); 831 if (IS_ERR(bd)) { 832 pr_err("Could not register asus backlight device\n"); 833 asus->backlight_device = NULL; 834 return PTR_ERR(bd); 835 } 836 837 asus->backlight_device = bd; 838 bd->props.brightness = asus_read_brightness(bd); 839 bd->props.power = FB_BLANK_UNBLANK; 840 backlight_update_status(bd); 841 return 0; 842 } 843 844 static void asus_backlight_exit(struct asus_laptop *asus) 845 { 846 backlight_device_unregister(asus->backlight_device); 847 asus->backlight_device = NULL; 848 } 849 850 /* 851 * Platform device handlers 852 */ 853 854 /* 855 * We write our info in page, we begin at offset off and cannot write more 856 * than count bytes. We set eof to 1 if we handle those 2 values. We return the 857 * number of bytes written in page 858 */ 859 static ssize_t show_infos(struct device *dev, 860 struct device_attribute *attr, char *page) 861 { 862 struct asus_laptop *asus = dev_get_drvdata(dev); 863 int len = 0; 864 unsigned long long temp; 865 char buf[16]; /* enough for all info */ 866 acpi_status rv = AE_OK; 867 868 /* 869 * We use the easy way, we don't care of off and count, 870 * so we don't set eof to 1 871 */ 872 873 len += sprintf(page, ASUS_LAPTOP_NAME " " ASUS_LAPTOP_VERSION "\n"); 874 len += sprintf(page + len, "Model reference : %s\n", asus->name); 875 /* 876 * The SFUN method probably allows the original driver to get the list 877 * of features supported by a given model. For now, 0x0100 or 0x0800 878 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card. 879 * The significance of others is yet to be found. 880 */ 881 rv = acpi_evaluate_integer(asus->handle, "SFUN", NULL, &temp); 882 if (!ACPI_FAILURE(rv)) 883 len += sprintf(page + len, "SFUN value : %#x\n", 884 (uint) temp); 885 /* 886 * The HWRS method return informations about the hardware. 887 * 0x80 bit is for WLAN, 0x100 for Bluetooth. 888 * 0x40 for WWAN, 0x10 for WIMAX. 889 * The significance of others is yet to be found. 890 * We don't currently use this for device detection, and it 891 * takes several seconds to run on some systems. 892 */ 893 rv = acpi_evaluate_integer(asus->handle, "HWRS", NULL, &temp); 894 if (!ACPI_FAILURE(rv)) 895 len += sprintf(page + len, "HWRS value : %#x\n", 896 (uint) temp); 897 /* 898 * Another value for userspace: the ASYM method returns 0x02 for 899 * battery low and 0x04 for battery critical, its readings tend to be 900 * more accurate than those provided by _BST. 901 * Note: since not all the laptops provide this method, errors are 902 * silently ignored. 903 */ 904 rv = acpi_evaluate_integer(asus->handle, "ASYM", NULL, &temp); 905 if (!ACPI_FAILURE(rv)) 906 len += sprintf(page + len, "ASYM value : %#x\n", 907 (uint) temp); 908 if (asus->dsdt_info) { 909 snprintf(buf, 16, "%d", asus->dsdt_info->length); 910 len += sprintf(page + len, "DSDT length : %s\n", buf); 911 snprintf(buf, 16, "%d", asus->dsdt_info->checksum); 912 len += sprintf(page + len, "DSDT checksum : %s\n", buf); 913 snprintf(buf, 16, "%d", asus->dsdt_info->revision); 914 len += sprintf(page + len, "DSDT revision : %s\n", buf); 915 snprintf(buf, 7, "%s", asus->dsdt_info->oem_id); 916 len += sprintf(page + len, "OEM id : %s\n", buf); 917 snprintf(buf, 9, "%s", asus->dsdt_info->oem_table_id); 918 len += sprintf(page + len, "OEM table id : %s\n", buf); 919 snprintf(buf, 16, "%x", asus->dsdt_info->oem_revision); 920 len += sprintf(page + len, "OEM revision : 0x%s\n", buf); 921 snprintf(buf, 5, "%s", asus->dsdt_info->asl_compiler_id); 922 len += sprintf(page + len, "ASL comp vendor id : %s\n", buf); 923 snprintf(buf, 16, "%x", asus->dsdt_info->asl_compiler_revision); 924 len += sprintf(page + len, "ASL comp revision : 0x%s\n", buf); 925 } 926 927 return len; 928 } 929 930 static int parse_arg(const char *buf, unsigned long count, int *val) 931 { 932 if (!count) 933 return 0; 934 if (count > 31) 935 return -EINVAL; 936 if (sscanf(buf, "%i", val) != 1) 937 return -EINVAL; 938 return count; 939 } 940 941 static ssize_t sysfs_acpi_set(struct asus_laptop *asus, 942 const char *buf, size_t count, 943 const char *method) 944 { 945 int rv, value; 946 int out = 0; 947 948 rv = parse_arg(buf, count, &value); 949 if (rv > 0) 950 out = value ? 1 : 0; 951 952 if (write_acpi_int(asus->handle, method, value)) 953 return -ENODEV; 954 return rv; 955 } 956 957 /* 958 * LEDD display 959 */ 960 static ssize_t show_ledd(struct device *dev, 961 struct device_attribute *attr, char *buf) 962 { 963 struct asus_laptop *asus = dev_get_drvdata(dev); 964 965 return sprintf(buf, "0x%08x\n", asus->ledd_status); 966 } 967 968 static ssize_t store_ledd(struct device *dev, struct device_attribute *attr, 969 const char *buf, size_t count) 970 { 971 struct asus_laptop *asus = dev_get_drvdata(dev); 972 int rv, value; 973 974 rv = parse_arg(buf, count, &value); 975 if (rv > 0) { 976 if (write_acpi_int(asus->handle, METHOD_LEDD, value)) { 977 pr_warn("LED display write failed\n"); 978 return -ENODEV; 979 } 980 asus->ledd_status = (u32) value; 981 } 982 return rv; 983 } 984 985 /* 986 * Wireless 987 */ 988 static int asus_wireless_status(struct asus_laptop *asus, int mask) 989 { 990 unsigned long long status; 991 acpi_status rv = AE_OK; 992 993 if (!asus->have_rsts) 994 return (asus->wireless_status & mask) ? 1 : 0; 995 996 rv = acpi_evaluate_integer(asus->handle, METHOD_WL_STATUS, 997 NULL, &status); 998 if (ACPI_FAILURE(rv)) { 999 pr_warn("Error reading Wireless status\n"); 1000 return -EINVAL; 1001 } 1002 return !!(status & mask); 1003 } 1004 1005 /* 1006 * WLAN 1007 */ 1008 static int asus_wlan_set(struct asus_laptop *asus, int status) 1009 { 1010 if (write_acpi_int(asus->handle, METHOD_WLAN, !!status)) { 1011 pr_warn("Error setting wlan status to %d\n", status); 1012 return -EIO; 1013 } 1014 return 0; 1015 } 1016 1017 static ssize_t show_wlan(struct device *dev, 1018 struct device_attribute *attr, char *buf) 1019 { 1020 struct asus_laptop *asus = dev_get_drvdata(dev); 1021 1022 return sprintf(buf, "%d\n", asus_wireless_status(asus, WL_RSTS)); 1023 } 1024 1025 static ssize_t store_wlan(struct device *dev, struct device_attribute *attr, 1026 const char *buf, size_t count) 1027 { 1028 struct asus_laptop *asus = dev_get_drvdata(dev); 1029 1030 return sysfs_acpi_set(asus, buf, count, METHOD_WLAN); 1031 } 1032 1033 /*e 1034 * Bluetooth 1035 */ 1036 static int asus_bluetooth_set(struct asus_laptop *asus, int status) 1037 { 1038 if (write_acpi_int(asus->handle, METHOD_BLUETOOTH, !!status)) { 1039 pr_warn("Error setting bluetooth status to %d\n", status); 1040 return -EIO; 1041 } 1042 return 0; 1043 } 1044 1045 static ssize_t show_bluetooth(struct device *dev, 1046 struct device_attribute *attr, char *buf) 1047 { 1048 struct asus_laptop *asus = dev_get_drvdata(dev); 1049 1050 return sprintf(buf, "%d\n", asus_wireless_status(asus, BT_RSTS)); 1051 } 1052 1053 static ssize_t store_bluetooth(struct device *dev, 1054 struct device_attribute *attr, const char *buf, 1055 size_t count) 1056 { 1057 struct asus_laptop *asus = dev_get_drvdata(dev); 1058 1059 return sysfs_acpi_set(asus, buf, count, METHOD_BLUETOOTH); 1060 } 1061 1062 /* 1063 * Wimax 1064 */ 1065 static int asus_wimax_set(struct asus_laptop *asus, int status) 1066 { 1067 if (write_acpi_int(asus->handle, METHOD_WIMAX, !!status)) { 1068 pr_warn("Error setting wimax status to %d\n", status); 1069 return -EIO; 1070 } 1071 return 0; 1072 } 1073 1074 static ssize_t show_wimax(struct device *dev, 1075 struct device_attribute *attr, char *buf) 1076 { 1077 struct asus_laptop *asus = dev_get_drvdata(dev); 1078 1079 return sprintf(buf, "%d\n", asus_wireless_status(asus, WM_RSTS)); 1080 } 1081 1082 static ssize_t store_wimax(struct device *dev, 1083 struct device_attribute *attr, const char *buf, 1084 size_t count) 1085 { 1086 struct asus_laptop *asus = dev_get_drvdata(dev); 1087 1088 return sysfs_acpi_set(asus, buf, count, METHOD_WIMAX); 1089 } 1090 1091 /* 1092 * Wwan 1093 */ 1094 static int asus_wwan_set(struct asus_laptop *asus, int status) 1095 { 1096 if (write_acpi_int(asus->handle, METHOD_WWAN, !!status)) { 1097 pr_warn("Error setting wwan status to %d\n", status); 1098 return -EIO; 1099 } 1100 return 0; 1101 } 1102 1103 static ssize_t show_wwan(struct device *dev, 1104 struct device_attribute *attr, char *buf) 1105 { 1106 struct asus_laptop *asus = dev_get_drvdata(dev); 1107 1108 return sprintf(buf, "%d\n", asus_wireless_status(asus, WW_RSTS)); 1109 } 1110 1111 static ssize_t store_wwan(struct device *dev, 1112 struct device_attribute *attr, const char *buf, 1113 size_t count) 1114 { 1115 struct asus_laptop *asus = dev_get_drvdata(dev); 1116 1117 return sysfs_acpi_set(asus, buf, count, METHOD_WWAN); 1118 } 1119 1120 /* 1121 * Display 1122 */ 1123 static void asus_set_display(struct asus_laptop *asus, int value) 1124 { 1125 /* no sanity check needed for now */ 1126 if (write_acpi_int(asus->handle, METHOD_SWITCH_DISPLAY, value)) 1127 pr_warn("Error setting display\n"); 1128 return; 1129 } 1130 1131 /* 1132 * Experimental support for display switching. As of now: 1 should activate 1133 * the LCD output, 2 should do for CRT, 4 for TV-Out and 8 for DVI. 1134 * Any combination (bitwise) of these will suffice. I never actually tested 4 1135 * displays hooked up simultaneously, so be warned. See the acpi4asus README 1136 * for more info. 1137 */ 1138 static ssize_t store_disp(struct device *dev, struct device_attribute *attr, 1139 const char *buf, size_t count) 1140 { 1141 struct asus_laptop *asus = dev_get_drvdata(dev); 1142 int rv, value; 1143 1144 rv = parse_arg(buf, count, &value); 1145 if (rv > 0) 1146 asus_set_display(asus, value); 1147 return rv; 1148 } 1149 1150 /* 1151 * Light Sens 1152 */ 1153 static void asus_als_switch(struct asus_laptop *asus, int value) 1154 { 1155 int ret; 1156 1157 if (asus->is_pega_lucid) { 1158 ret = asus_pega_lucid_set(asus, PEGA_ALS, value); 1159 if (!ret) 1160 ret = asus_pega_lucid_set(asus, PEGA_ALS_POWER, value); 1161 } else { 1162 ret = write_acpi_int(asus->handle, METHOD_ALS_CONTROL, value); 1163 } 1164 if (ret) 1165 pr_warning("Error setting light sensor switch\n"); 1166 1167 asus->light_switch = value; 1168 } 1169 1170 static ssize_t show_lssw(struct device *dev, 1171 struct device_attribute *attr, char *buf) 1172 { 1173 struct asus_laptop *asus = dev_get_drvdata(dev); 1174 1175 return sprintf(buf, "%d\n", asus->light_switch); 1176 } 1177 1178 static ssize_t store_lssw(struct device *dev, struct device_attribute *attr, 1179 const char *buf, size_t count) 1180 { 1181 struct asus_laptop *asus = dev_get_drvdata(dev); 1182 int rv, value; 1183 1184 rv = parse_arg(buf, count, &value); 1185 if (rv > 0) 1186 asus_als_switch(asus, value ? 1 : 0); 1187 1188 return rv; 1189 } 1190 1191 static void asus_als_level(struct asus_laptop *asus, int value) 1192 { 1193 if (write_acpi_int(asus->handle, METHOD_ALS_LEVEL, value)) 1194 pr_warn("Error setting light sensor level\n"); 1195 asus->light_level = value; 1196 } 1197 1198 static ssize_t show_lslvl(struct device *dev, 1199 struct device_attribute *attr, char *buf) 1200 { 1201 struct asus_laptop *asus = dev_get_drvdata(dev); 1202 1203 return sprintf(buf, "%d\n", asus->light_level); 1204 } 1205 1206 static ssize_t store_lslvl(struct device *dev, struct device_attribute *attr, 1207 const char *buf, size_t count) 1208 { 1209 struct asus_laptop *asus = dev_get_drvdata(dev); 1210 int rv, value; 1211 1212 rv = parse_arg(buf, count, &value); 1213 if (rv > 0) { 1214 value = (0 < value) ? ((15 < value) ? 15 : value) : 0; 1215 /* 0 <= value <= 15 */ 1216 asus_als_level(asus, value); 1217 } 1218 1219 return rv; 1220 } 1221 1222 static int pega_int_read(struct asus_laptop *asus, int arg, int *result) 1223 { 1224 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; 1225 int err = write_acpi_int_ret(asus->handle, METHOD_PEGA_READ, arg, 1226 &buffer); 1227 if (!err) { 1228 union acpi_object *obj = buffer.pointer; 1229 if (obj && obj->type == ACPI_TYPE_INTEGER) 1230 *result = obj->integer.value; 1231 else 1232 err = -EIO; 1233 } 1234 return err; 1235 } 1236 1237 static ssize_t show_lsvalue(struct device *dev, 1238 struct device_attribute *attr, char *buf) 1239 { 1240 struct asus_laptop *asus = dev_get_drvdata(dev); 1241 int err, hi, lo; 1242 1243 err = pega_int_read(asus, PEGA_READ_ALS_H, &hi); 1244 if (!err) 1245 err = pega_int_read(asus, PEGA_READ_ALS_L, &lo); 1246 if (!err) 1247 return sprintf(buf, "%d\n", 10 * hi + lo); 1248 return err; 1249 } 1250 1251 /* 1252 * GPS 1253 */ 1254 static int asus_gps_status(struct asus_laptop *asus) 1255 { 1256 unsigned long long status; 1257 acpi_status rv = AE_OK; 1258 1259 rv = acpi_evaluate_integer(asus->handle, METHOD_GPS_STATUS, 1260 NULL, &status); 1261 if (ACPI_FAILURE(rv)) { 1262 pr_warn("Error reading GPS status\n"); 1263 return -ENODEV; 1264 } 1265 return !!status; 1266 } 1267 1268 static int asus_gps_switch(struct asus_laptop *asus, int status) 1269 { 1270 const char *meth = status ? METHOD_GPS_ON : METHOD_GPS_OFF; 1271 1272 if (write_acpi_int(asus->handle, meth, 0x02)) 1273 return -ENODEV; 1274 return 0; 1275 } 1276 1277 static ssize_t show_gps(struct device *dev, 1278 struct device_attribute *attr, char *buf) 1279 { 1280 struct asus_laptop *asus = dev_get_drvdata(dev); 1281 1282 return sprintf(buf, "%d\n", asus_gps_status(asus)); 1283 } 1284 1285 static ssize_t store_gps(struct device *dev, struct device_attribute *attr, 1286 const char *buf, size_t count) 1287 { 1288 struct asus_laptop *asus = dev_get_drvdata(dev); 1289 int rv, value; 1290 int ret; 1291 1292 rv = parse_arg(buf, count, &value); 1293 if (rv <= 0) 1294 return -EINVAL; 1295 ret = asus_gps_switch(asus, !!value); 1296 if (ret) 1297 return ret; 1298 rfkill_set_sw_state(asus->gps.rfkill, !value); 1299 return rv; 1300 } 1301 1302 /* 1303 * rfkill 1304 */ 1305 static int asus_gps_rfkill_set(void *data, bool blocked) 1306 { 1307 struct asus_laptop *asus = data; 1308 1309 return asus_gps_switch(asus, !blocked); 1310 } 1311 1312 static const struct rfkill_ops asus_gps_rfkill_ops = { 1313 .set_block = asus_gps_rfkill_set, 1314 }; 1315 1316 static int asus_rfkill_set(void *data, bool blocked) 1317 { 1318 struct asus_rfkill *rfk = data; 1319 struct asus_laptop *asus = rfk->asus; 1320 1321 if (rfk->control_id == WL_RSTS) 1322 return asus_wlan_set(asus, !blocked); 1323 else if (rfk->control_id == BT_RSTS) 1324 return asus_bluetooth_set(asus, !blocked); 1325 else if (rfk->control_id == WM_RSTS) 1326 return asus_wimax_set(asus, !blocked); 1327 else if (rfk->control_id == WW_RSTS) 1328 return asus_wwan_set(asus, !blocked); 1329 1330 return -EINVAL; 1331 } 1332 1333 static const struct rfkill_ops asus_rfkill_ops = { 1334 .set_block = asus_rfkill_set, 1335 }; 1336 1337 static void asus_rfkill_terminate(struct asus_rfkill *rfk) 1338 { 1339 if (!rfk->rfkill) 1340 return ; 1341 1342 rfkill_unregister(rfk->rfkill); 1343 rfkill_destroy(rfk->rfkill); 1344 rfk->rfkill = NULL; 1345 } 1346 1347 static void asus_rfkill_exit(struct asus_laptop *asus) 1348 { 1349 asus_rfkill_terminate(&asus->wwan); 1350 asus_rfkill_terminate(&asus->bluetooth); 1351 asus_rfkill_terminate(&asus->wlan); 1352 asus_rfkill_terminate(&asus->gps); 1353 } 1354 1355 static int asus_rfkill_setup(struct asus_laptop *asus, struct asus_rfkill *rfk, 1356 const char *name, int control_id, int type, 1357 const struct rfkill_ops *ops) 1358 { 1359 int result; 1360 1361 rfk->control_id = control_id; 1362 rfk->asus = asus; 1363 rfk->rfkill = rfkill_alloc(name, &asus->platform_device->dev, 1364 type, ops, rfk); 1365 if (!rfk->rfkill) 1366 return -EINVAL; 1367 1368 result = rfkill_register(rfk->rfkill); 1369 if (result) { 1370 rfkill_destroy(rfk->rfkill); 1371 rfk->rfkill = NULL; 1372 } 1373 1374 return result; 1375 } 1376 1377 static int asus_rfkill_init(struct asus_laptop *asus) 1378 { 1379 int result = 0; 1380 1381 if (asus->is_pega_lucid) 1382 return -ENODEV; 1383 1384 if (!acpi_check_handle(asus->handle, METHOD_GPS_ON, NULL) && 1385 !acpi_check_handle(asus->handle, METHOD_GPS_OFF, NULL) && 1386 !acpi_check_handle(asus->handle, METHOD_GPS_STATUS, NULL)) 1387 result = asus_rfkill_setup(asus, &asus->gps, "asus-gps", 1388 -1, RFKILL_TYPE_GPS, 1389 &asus_gps_rfkill_ops); 1390 if (result) 1391 goto exit; 1392 1393 1394 if (!acpi_check_handle(asus->handle, METHOD_WLAN, NULL) && 1395 asus->wled_type == TYPE_RFKILL) 1396 result = asus_rfkill_setup(asus, &asus->wlan, "asus-wlan", 1397 WL_RSTS, RFKILL_TYPE_WLAN, 1398 &asus_rfkill_ops); 1399 if (result) 1400 goto exit; 1401 1402 if (!acpi_check_handle(asus->handle, METHOD_BLUETOOTH, NULL) && 1403 asus->bled_type == TYPE_RFKILL) 1404 result = asus_rfkill_setup(asus, &asus->bluetooth, 1405 "asus-bluetooth", BT_RSTS, 1406 RFKILL_TYPE_BLUETOOTH, 1407 &asus_rfkill_ops); 1408 if (result) 1409 goto exit; 1410 1411 if (!acpi_check_handle(asus->handle, METHOD_WWAN, NULL)) 1412 result = asus_rfkill_setup(asus, &asus->wwan, "asus-wwan", 1413 WW_RSTS, RFKILL_TYPE_WWAN, 1414 &asus_rfkill_ops); 1415 if (result) 1416 goto exit; 1417 1418 if (!acpi_check_handle(asus->handle, METHOD_WIMAX, NULL)) 1419 result = asus_rfkill_setup(asus, &asus->wimax, "asus-wimax", 1420 WM_RSTS, RFKILL_TYPE_WIMAX, 1421 &asus_rfkill_ops); 1422 if (result) 1423 goto exit; 1424 1425 exit: 1426 if (result) 1427 asus_rfkill_exit(asus); 1428 1429 return result; 1430 } 1431 1432 static int pega_rfkill_set(void *data, bool blocked) 1433 { 1434 struct asus_rfkill *rfk = data; 1435 1436 int ret = asus_pega_lucid_set(rfk->asus, rfk->control_id, !blocked); 1437 return ret; 1438 } 1439 1440 static const struct rfkill_ops pega_rfkill_ops = { 1441 .set_block = pega_rfkill_set, 1442 }; 1443 1444 static int pega_rfkill_setup(struct asus_laptop *asus, struct asus_rfkill *rfk, 1445 const char *name, int controlid, int rfkill_type) 1446 { 1447 return asus_rfkill_setup(asus, rfk, name, controlid, rfkill_type, 1448 &pega_rfkill_ops); 1449 } 1450 1451 static int pega_rfkill_init(struct asus_laptop *asus) 1452 { 1453 int ret = 0; 1454 1455 if(!asus->is_pega_lucid) 1456 return -ENODEV; 1457 1458 ret = pega_rfkill_setup(asus, &asus->wlan, "pega-wlan", 1459 PEGA_WLAN, RFKILL_TYPE_WLAN); 1460 if(ret) 1461 goto exit; 1462 1463 ret = pega_rfkill_setup(asus, &asus->bluetooth, "pega-bt", 1464 PEGA_BLUETOOTH, RFKILL_TYPE_BLUETOOTH); 1465 if(ret) 1466 goto exit; 1467 1468 ret = pega_rfkill_setup(asus, &asus->wwan, "pega-wwan", 1469 PEGA_WWAN, RFKILL_TYPE_WWAN); 1470 1471 exit: 1472 if (ret) 1473 asus_rfkill_exit(asus); 1474 1475 return ret; 1476 } 1477 1478 /* 1479 * Input device (i.e. hotkeys) 1480 */ 1481 static void asus_input_notify(struct asus_laptop *asus, int event) 1482 { 1483 if (!asus->inputdev) 1484 return ; 1485 if (!sparse_keymap_report_event(asus->inputdev, event, 1, true)) 1486 pr_info("Unknown key %x pressed\n", event); 1487 } 1488 1489 static int asus_input_init(struct asus_laptop *asus) 1490 { 1491 struct input_dev *input; 1492 int error; 1493 1494 input = input_allocate_device(); 1495 if (!input) 1496 return -ENOMEM; 1497 1498 input->name = "Asus Laptop extra buttons"; 1499 input->phys = ASUS_LAPTOP_FILE "/input0"; 1500 input->id.bustype = BUS_HOST; 1501 input->dev.parent = &asus->platform_device->dev; 1502 1503 error = sparse_keymap_setup(input, asus_keymap, NULL); 1504 if (error) { 1505 pr_err("Unable to setup input device keymap\n"); 1506 goto err_free_dev; 1507 } 1508 error = input_register_device(input); 1509 if (error) { 1510 pr_warn("Unable to register input device\n"); 1511 goto err_free_keymap; 1512 } 1513 1514 asus->inputdev = input; 1515 return 0; 1516 1517 err_free_keymap: 1518 sparse_keymap_free(input); 1519 err_free_dev: 1520 input_free_device(input); 1521 return error; 1522 } 1523 1524 static void asus_input_exit(struct asus_laptop *asus) 1525 { 1526 if (asus->inputdev) { 1527 sparse_keymap_free(asus->inputdev); 1528 input_unregister_device(asus->inputdev); 1529 } 1530 asus->inputdev = NULL; 1531 } 1532 1533 /* 1534 * ACPI driver 1535 */ 1536 static void asus_acpi_notify(struct acpi_device *device, u32 event) 1537 { 1538 struct asus_laptop *asus = acpi_driver_data(device); 1539 u16 count; 1540 1541 /* TODO Find a better way to handle events count. */ 1542 count = asus->event_count[event % 128]++; 1543 acpi_bus_generate_netlink_event(asus->device->pnp.device_class, 1544 dev_name(&asus->device->dev), event, 1545 count); 1546 1547 if (event >= ATKD_BRNUP_MIN && event <= ATKD_BRNUP_MAX) 1548 event = ATKD_BRNUP; 1549 else if (event >= ATKD_BRNDOWN_MIN && 1550 event <= ATKD_BRNDOWN_MAX) 1551 event = ATKD_BRNDOWN; 1552 1553 /* Brightness events are special */ 1554 if (event == ATKD_BRNDOWN || event == ATKD_BRNUP) { 1555 if (asus->backlight_device != NULL) { 1556 /* Update the backlight device. */ 1557 asus_backlight_notify(asus); 1558 return ; 1559 } 1560 } 1561 1562 /* Accelerometer "coarse orientation change" event */ 1563 if (asus->pega_accel_poll && event == 0xEA) { 1564 kobject_uevent(&asus->pega_accel_poll->input->dev.kobj, 1565 KOBJ_CHANGE); 1566 return ; 1567 } 1568 1569 asus_input_notify(asus, event); 1570 } 1571 1572 static DEVICE_ATTR(infos, S_IRUGO, show_infos, NULL); 1573 static DEVICE_ATTR(wlan, S_IRUGO | S_IWUSR, show_wlan, store_wlan); 1574 static DEVICE_ATTR(bluetooth, S_IRUGO | S_IWUSR, 1575 show_bluetooth, store_bluetooth); 1576 static DEVICE_ATTR(wimax, S_IRUGO | S_IWUSR, show_wimax, store_wimax); 1577 static DEVICE_ATTR(wwan, S_IRUGO | S_IWUSR, show_wwan, store_wwan); 1578 static DEVICE_ATTR(display, S_IWUSR, NULL, store_disp); 1579 static DEVICE_ATTR(ledd, S_IRUGO | S_IWUSR, show_ledd, store_ledd); 1580 static DEVICE_ATTR(ls_value, S_IRUGO, show_lsvalue, NULL); 1581 static DEVICE_ATTR(ls_level, S_IRUGO | S_IWUSR, show_lslvl, store_lslvl); 1582 static DEVICE_ATTR(ls_switch, S_IRUGO | S_IWUSR, show_lssw, store_lssw); 1583 static DEVICE_ATTR(gps, S_IRUGO | S_IWUSR, show_gps, store_gps); 1584 1585 static struct attribute *asus_attributes[] = { 1586 &dev_attr_infos.attr, 1587 &dev_attr_wlan.attr, 1588 &dev_attr_bluetooth.attr, 1589 &dev_attr_wimax.attr, 1590 &dev_attr_wwan.attr, 1591 &dev_attr_display.attr, 1592 &dev_attr_ledd.attr, 1593 &dev_attr_ls_value.attr, 1594 &dev_attr_ls_level.attr, 1595 &dev_attr_ls_switch.attr, 1596 &dev_attr_gps.attr, 1597 NULL 1598 }; 1599 1600 static umode_t asus_sysfs_is_visible(struct kobject *kobj, 1601 struct attribute *attr, 1602 int idx) 1603 { 1604 struct device *dev = container_of(kobj, struct device, kobj); 1605 struct platform_device *pdev = to_platform_device(dev); 1606 struct asus_laptop *asus = platform_get_drvdata(pdev); 1607 acpi_handle handle = asus->handle; 1608 bool supported; 1609 1610 if (asus->is_pega_lucid) { 1611 /* no ls_level interface on the Lucid */ 1612 if (attr == &dev_attr_ls_switch.attr) 1613 supported = true; 1614 else if (attr == &dev_attr_ls_level.attr) 1615 supported = false; 1616 else 1617 goto normal; 1618 1619 return supported ? attr->mode : 0; 1620 } 1621 1622 normal: 1623 if (attr == &dev_attr_wlan.attr) { 1624 supported = !acpi_check_handle(handle, METHOD_WLAN, NULL); 1625 1626 } else if (attr == &dev_attr_bluetooth.attr) { 1627 supported = !acpi_check_handle(handle, METHOD_BLUETOOTH, NULL); 1628 1629 } else if (attr == &dev_attr_display.attr) { 1630 supported = !acpi_check_handle(handle, METHOD_SWITCH_DISPLAY, NULL); 1631 1632 } else if (attr == &dev_attr_wimax.attr) { 1633 supported = 1634 !acpi_check_handle(asus->handle, METHOD_WIMAX, NULL); 1635 1636 } else if (attr == &dev_attr_wwan.attr) { 1637 supported = !acpi_check_handle(asus->handle, METHOD_WWAN, NULL); 1638 1639 } else if (attr == &dev_attr_ledd.attr) { 1640 supported = !acpi_check_handle(handle, METHOD_LEDD, NULL); 1641 1642 } else if (attr == &dev_attr_ls_switch.attr || 1643 attr == &dev_attr_ls_level.attr) { 1644 supported = !acpi_check_handle(handle, METHOD_ALS_CONTROL, NULL) && 1645 !acpi_check_handle(handle, METHOD_ALS_LEVEL, NULL); 1646 } else if (attr == &dev_attr_ls_value.attr) { 1647 supported = asus->is_pega_lucid; 1648 } else if (attr == &dev_attr_gps.attr) { 1649 supported = !acpi_check_handle(handle, METHOD_GPS_ON, NULL) && 1650 !acpi_check_handle(handle, METHOD_GPS_OFF, NULL) && 1651 !acpi_check_handle(handle, METHOD_GPS_STATUS, NULL); 1652 } else { 1653 supported = true; 1654 } 1655 1656 return supported ? attr->mode : 0; 1657 } 1658 1659 1660 static const struct attribute_group asus_attr_group = { 1661 .is_visible = asus_sysfs_is_visible, 1662 .attrs = asus_attributes, 1663 }; 1664 1665 static int asus_platform_init(struct asus_laptop *asus) 1666 { 1667 int result; 1668 1669 asus->platform_device = platform_device_alloc(ASUS_LAPTOP_FILE, -1); 1670 if (!asus->platform_device) 1671 return -ENOMEM; 1672 platform_set_drvdata(asus->platform_device, asus); 1673 1674 result = platform_device_add(asus->platform_device); 1675 if (result) 1676 goto fail_platform_device; 1677 1678 result = sysfs_create_group(&asus->platform_device->dev.kobj, 1679 &asus_attr_group); 1680 if (result) 1681 goto fail_sysfs; 1682 1683 return 0; 1684 1685 fail_sysfs: 1686 platform_device_del(asus->platform_device); 1687 fail_platform_device: 1688 platform_device_put(asus->platform_device); 1689 return result; 1690 } 1691 1692 static void asus_platform_exit(struct asus_laptop *asus) 1693 { 1694 sysfs_remove_group(&asus->platform_device->dev.kobj, &asus_attr_group); 1695 platform_device_unregister(asus->platform_device); 1696 } 1697 1698 static struct platform_driver platform_driver = { 1699 .driver = { 1700 .name = ASUS_LAPTOP_FILE, 1701 }, 1702 }; 1703 1704 /* 1705 * This function is used to initialize the context with right values. In this 1706 * method, we can make all the detection we want, and modify the asus_laptop 1707 * struct 1708 */ 1709 static int asus_laptop_get_info(struct asus_laptop *asus) 1710 { 1711 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; 1712 union acpi_object *model = NULL; 1713 unsigned long long bsts_result; 1714 char *string = NULL; 1715 acpi_status status; 1716 1717 /* 1718 * Get DSDT headers early enough to allow for differentiating between 1719 * models, but late enough to allow acpi_bus_register_driver() to fail 1720 * before doing anything ACPI-specific. Should we encounter a machine, 1721 * which needs special handling (i.e. its hotkey device has a different 1722 * HID), this bit will be moved. 1723 */ 1724 status = acpi_get_table(ACPI_SIG_DSDT, 1, &asus->dsdt_info); 1725 if (ACPI_FAILURE(status)) 1726 pr_warn("Couldn't get the DSDT table header\n"); 1727 1728 /* We have to write 0 on init this far for all ASUS models */ 1729 if (write_acpi_int_ret(asus->handle, "INIT", 0, &buffer)) { 1730 pr_err("Hotkey initialization failed\n"); 1731 return -ENODEV; 1732 } 1733 1734 /* This needs to be called for some laptops to init properly */ 1735 status = 1736 acpi_evaluate_integer(asus->handle, "BSTS", NULL, &bsts_result); 1737 if (ACPI_FAILURE(status)) 1738 pr_warn("Error calling BSTS\n"); 1739 else if (bsts_result) 1740 pr_notice("BSTS called, 0x%02x returned\n", 1741 (uint) bsts_result); 1742 1743 /* This too ... */ 1744 if (write_acpi_int(asus->handle, "CWAP", wapf)) 1745 pr_err("Error calling CWAP(%d)\n", wapf); 1746 /* 1747 * Try to match the object returned by INIT to the specific model. 1748 * Handle every possible object (or the lack of thereof) the DSDT 1749 * writers might throw at us. When in trouble, we pass NULL to 1750 * asus_model_match() and try something completely different. 1751 */ 1752 if (buffer.pointer) { 1753 model = buffer.pointer; 1754 switch (model->type) { 1755 case ACPI_TYPE_STRING: 1756 string = model->string.pointer; 1757 break; 1758 case ACPI_TYPE_BUFFER: 1759 string = model->buffer.pointer; 1760 break; 1761 default: 1762 string = ""; 1763 break; 1764 } 1765 } 1766 asus->name = kstrdup(string, GFP_KERNEL); 1767 if (!asus->name) { 1768 kfree(buffer.pointer); 1769 return -ENOMEM; 1770 } 1771 1772 if (string) 1773 pr_notice(" %s model detected\n", string); 1774 1775 if (!acpi_check_handle(asus->handle, METHOD_WL_STATUS, NULL)) 1776 asus->have_rsts = true; 1777 1778 kfree(model); 1779 1780 return AE_OK; 1781 } 1782 1783 static int asus_acpi_init(struct asus_laptop *asus) 1784 { 1785 int result = 0; 1786 1787 result = acpi_bus_get_status(asus->device); 1788 if (result) 1789 return result; 1790 if (!asus->device->status.present) { 1791 pr_err("Hotkey device not present, aborting\n"); 1792 return -ENODEV; 1793 } 1794 1795 result = asus_laptop_get_info(asus); 1796 if (result) 1797 return result; 1798 1799 if (!strcmp(bled_type, "led")) 1800 asus->bled_type = TYPE_LED; 1801 else if (!strcmp(bled_type, "rfkill")) 1802 asus->bled_type = TYPE_RFKILL; 1803 1804 if (!strcmp(wled_type, "led")) 1805 asus->wled_type = TYPE_LED; 1806 else if (!strcmp(wled_type, "rfkill")) 1807 asus->wled_type = TYPE_RFKILL; 1808 1809 if (bluetooth_status >= 0) 1810 asus_bluetooth_set(asus, !!bluetooth_status); 1811 1812 if (wlan_status >= 0) 1813 asus_wlan_set(asus, !!wlan_status); 1814 1815 if (wimax_status >= 0) 1816 asus_wimax_set(asus, !!wimax_status); 1817 1818 if (wwan_status >= 0) 1819 asus_wwan_set(asus, !!wwan_status); 1820 1821 /* Keyboard Backlight is on by default */ 1822 if (!acpi_check_handle(asus->handle, METHOD_KBD_LIGHT_SET, NULL)) 1823 asus_kled_set(asus, 1); 1824 1825 /* LED display is off by default */ 1826 asus->ledd_status = 0xFFF; 1827 1828 /* Set initial values of light sensor and level */ 1829 asus->light_switch = !!als_status; 1830 asus->light_level = 5; /* level 5 for sensor sensitivity */ 1831 1832 if (asus->is_pega_lucid) { 1833 asus_als_switch(asus, asus->light_switch); 1834 } else if (!acpi_check_handle(asus->handle, METHOD_ALS_CONTROL, NULL) && 1835 !acpi_check_handle(asus->handle, METHOD_ALS_LEVEL, NULL)) { 1836 asus_als_switch(asus, asus->light_switch); 1837 asus_als_level(asus, asus->light_level); 1838 } 1839 1840 return result; 1841 } 1842 1843 static void asus_dmi_check(void) 1844 { 1845 const char *model; 1846 1847 model = dmi_get_system_info(DMI_PRODUCT_NAME); 1848 if (!model) 1849 return; 1850 1851 /* On L1400B WLED control the sound card, don't mess with it ... */ 1852 if (strncmp(model, "L1400B", 6) == 0) { 1853 wlan_status = -1; 1854 } 1855 } 1856 1857 static bool asus_device_present; 1858 1859 static int asus_acpi_add(struct acpi_device *device) 1860 { 1861 struct asus_laptop *asus; 1862 int result; 1863 1864 pr_notice("Asus Laptop Support version %s\n", 1865 ASUS_LAPTOP_VERSION); 1866 asus = kzalloc(sizeof(struct asus_laptop), GFP_KERNEL); 1867 if (!asus) 1868 return -ENOMEM; 1869 asus->handle = device->handle; 1870 strcpy(acpi_device_name(device), ASUS_LAPTOP_DEVICE_NAME); 1871 strcpy(acpi_device_class(device), ASUS_LAPTOP_CLASS); 1872 device->driver_data = asus; 1873 asus->device = device; 1874 1875 asus_dmi_check(); 1876 1877 result = asus_acpi_init(asus); 1878 if (result) 1879 goto fail_platform; 1880 1881 /* 1882 * Need platform type detection first, then the platform 1883 * device. It is used as a parent for the sub-devices below. 1884 */ 1885 asus->is_pega_lucid = asus_check_pega_lucid(asus); 1886 result = asus_platform_init(asus); 1887 if (result) 1888 goto fail_platform; 1889 1890 if (!acpi_video_backlight_support()) { 1891 result = asus_backlight_init(asus); 1892 if (result) 1893 goto fail_backlight; 1894 } else 1895 pr_info("Backlight controlled by ACPI video driver\n"); 1896 1897 result = asus_input_init(asus); 1898 if (result) 1899 goto fail_input; 1900 1901 result = asus_led_init(asus); 1902 if (result) 1903 goto fail_led; 1904 1905 result = asus_rfkill_init(asus); 1906 if (result && result != -ENODEV) 1907 goto fail_rfkill; 1908 1909 result = pega_accel_init(asus); 1910 if (result && result != -ENODEV) 1911 goto fail_pega_accel; 1912 1913 result = pega_rfkill_init(asus); 1914 if (result && result != -ENODEV) 1915 goto fail_pega_rfkill; 1916 1917 asus_device_present = true; 1918 return 0; 1919 1920 fail_pega_rfkill: 1921 pega_accel_exit(asus); 1922 fail_pega_accel: 1923 asus_rfkill_exit(asus); 1924 fail_rfkill: 1925 asus_led_exit(asus); 1926 fail_led: 1927 asus_input_exit(asus); 1928 fail_input: 1929 asus_backlight_exit(asus); 1930 fail_backlight: 1931 asus_platform_exit(asus); 1932 fail_platform: 1933 kfree(asus); 1934 1935 return result; 1936 } 1937 1938 static int asus_acpi_remove(struct acpi_device *device) 1939 { 1940 struct asus_laptop *asus = acpi_driver_data(device); 1941 1942 asus_backlight_exit(asus); 1943 asus_rfkill_exit(asus); 1944 asus_led_exit(asus); 1945 asus_input_exit(asus); 1946 pega_accel_exit(asus); 1947 asus_platform_exit(asus); 1948 1949 kfree(asus->name); 1950 kfree(asus); 1951 return 0; 1952 } 1953 1954 static const struct acpi_device_id asus_device_ids[] = { 1955 {"ATK0100", 0}, 1956 {"ATK0101", 0}, 1957 {"", 0}, 1958 }; 1959 MODULE_DEVICE_TABLE(acpi, asus_device_ids); 1960 1961 static struct acpi_driver asus_acpi_driver = { 1962 .name = ASUS_LAPTOP_NAME, 1963 .class = ASUS_LAPTOP_CLASS, 1964 .owner = THIS_MODULE, 1965 .ids = asus_device_ids, 1966 .flags = ACPI_DRIVER_ALL_NOTIFY_EVENTS, 1967 .ops = { 1968 .add = asus_acpi_add, 1969 .remove = asus_acpi_remove, 1970 .notify = asus_acpi_notify, 1971 }, 1972 }; 1973 1974 static int __init asus_laptop_init(void) 1975 { 1976 int result; 1977 1978 result = platform_driver_register(&platform_driver); 1979 if (result < 0) 1980 return result; 1981 1982 result = acpi_bus_register_driver(&asus_acpi_driver); 1983 if (result < 0) 1984 goto fail_acpi_driver; 1985 if (!asus_device_present) { 1986 result = -ENODEV; 1987 goto fail_no_device; 1988 } 1989 return 0; 1990 1991 fail_no_device: 1992 acpi_bus_unregister_driver(&asus_acpi_driver); 1993 fail_acpi_driver: 1994 platform_driver_unregister(&platform_driver); 1995 return result; 1996 } 1997 1998 static void __exit asus_laptop_exit(void) 1999 { 2000 acpi_bus_unregister_driver(&asus_acpi_driver); 2001 platform_driver_unregister(&platform_driver); 2002 } 2003 2004 module_init(asus_laptop_init); 2005 module_exit(asus_laptop_exit); 2006