?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 4.1.16
[linux/fpc-iii.git] / drivers / platform / x86 / eeepc-laptop.c
blob844c2096bde9244c3daaf504892f2bbcefad3db0
1 /*
2 * eeepc-laptop.c - Asus Eee PC extras
3 *
4 * Based on asus_acpi.c as patched for the Eee PC by Asus:
5 * ftp://ftp.asus.com/pub/ASUS/EeePC/701/ASUS_ACPI_071126.rar
6 * Based on eee.c from eeepc-linux
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
18
19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
20
21 #include <linux/kernel.h>
22 #include <linux/module.h>
23 #include <linux/init.h>
24 #include <linux/types.h>
25 #include <linux/platform_device.h>
26 #include <linux/backlight.h>
27 #include <linux/fb.h>
28 #include <linux/hwmon.h>
29 #include <linux/hwmon-sysfs.h>
30 #include <linux/slab.h>
31 #include <linux/acpi.h>
32 #include <linux/uaccess.h>
33 #include <linux/input.h>
34 #include <linux/input/sparse-keymap.h>
35 #include <linux/rfkill.h>
36 #include <linux/pci.h>
37 #include <linux/pci_hotplug.h>
38 #include <linux/leds.h>
39 #include <linux/dmi.h>
40
41 #define EEEPC_LAPTOP_VERSION "0.1"
42 #define EEEPC_LAPTOP_NAME "Eee PC Hotkey Driver"
43 #define EEEPC_LAPTOP_FILE "eeepc"
44
45 #define EEEPC_ACPI_CLASS "hotkey"
46 #define EEEPC_ACPI_DEVICE_NAME "Hotkey"
47 #define EEEPC_ACPI_HID "ASUS010"
48
49 MODULE_AUTHOR("Corentin Chary, Eric Cooper");
50 MODULE_DESCRIPTION(EEEPC_LAPTOP_NAME);
51 MODULE_LICENSE("GPL");
52
53 static bool hotplug_disabled;
54
55 module_param(hotplug_disabled, bool, 0444);
56 MODULE_PARM_DESC(hotplug_disabled,
57 "Disable hotplug for wireless device. "
58 "If your laptop need that, please report to "
59 "acpi4asus-user@lists.sourceforge.net.");
60
61 /*
62 * Definitions for Asus EeePC
63 */
64 #define NOTIFY_BRN_MIN 0x20
65 #define NOTIFY_BRN_MAX 0x2f
66
67 enum {
68 DISABLE_ASL_WLAN = 0x0001,
69 DISABLE_ASL_BLUETOOTH = 0x0002,
70 DISABLE_ASL_IRDA = 0x0004,
71 DISABLE_ASL_CAMERA = 0x0008,
72 DISABLE_ASL_TV = 0x0010,
73 DISABLE_ASL_GPS = 0x0020,
74 DISABLE_ASL_DISPLAYSWITCH = 0x0040,
75 DISABLE_ASL_MODEM = 0x0080,
76 DISABLE_ASL_CARDREADER = 0x0100,
77 DISABLE_ASL_3G = 0x0200,
78 DISABLE_ASL_WIMAX = 0x0400,
79 DISABLE_ASL_HWCF = 0x0800
80 };
81
82 enum {
83 CM_ASL_WLAN = 0,
84 CM_ASL_BLUETOOTH,
85 CM_ASL_IRDA,
86 CM_ASL_1394,
87 CM_ASL_CAMERA,
88 CM_ASL_TV,
89 CM_ASL_GPS,
90 CM_ASL_DVDROM,
91 CM_ASL_DISPLAYSWITCH,
92 CM_ASL_PANELBRIGHT,
93 CM_ASL_BIOSFLASH,
94 CM_ASL_ACPIFLASH,
95 CM_ASL_CPUFV,
96 CM_ASL_CPUTEMPERATURE,
97 CM_ASL_FANCPU,
98 CM_ASL_FANCHASSIS,
99 CM_ASL_USBPORT1,
100 CM_ASL_USBPORT2,
101 CM_ASL_USBPORT3,
102 CM_ASL_MODEM,
103 CM_ASL_CARDREADER,
104 CM_ASL_3G,
105 CM_ASL_WIMAX,
106 CM_ASL_HWCF,
107 CM_ASL_LID,
108 CM_ASL_TYPE,
109 CM_ASL_PANELPOWER, /*P901*/
110 CM_ASL_TPD
111 };
112
113 static const char *cm_getv[] = {
114 "WLDG", "BTHG", NULL, NULL,
115 "CAMG", NULL, NULL, NULL,
116 NULL, "PBLG", NULL, NULL,
117 "CFVG", NULL, NULL, NULL,
118 "USBG", NULL, NULL, "MODG",
119 "CRDG", "M3GG", "WIMG", "HWCF",
120 "LIDG", "TYPE", "PBPG", "TPDG"
121 };
122
123 static const char *cm_setv[] = {
124 "WLDS", "BTHS", NULL, NULL,
125 "CAMS", NULL, NULL, NULL,
126 "SDSP", "PBLS", "HDPS", NULL,
127 "CFVS", NULL, NULL, NULL,
128 "USBG", NULL, NULL, "MODS",
129 "CRDS", "M3GS", "WIMS", NULL,
130 NULL, NULL, "PBPS", "TPDS"
131 };
132
133 static const struct key_entry eeepc_keymap[] = {
134 { KE_KEY, 0x10, { KEY_WLAN } },
135 { KE_KEY, 0x11, { KEY_WLAN } },
136 { KE_KEY, 0x12, { KEY_PROG1 } },
137 { KE_KEY, 0x13, { KEY_MUTE } },
138 { KE_KEY, 0x14, { KEY_VOLUMEDOWN } },
139 { KE_KEY, 0x15, { KEY_VOLUMEUP } },
140 { KE_KEY, 0x16, { KEY_DISPLAY_OFF } },
141 { KE_KEY, 0x1a, { KEY_COFFEE } },
142 { KE_KEY, 0x1b, { KEY_ZOOM } },
143 { KE_KEY, 0x1c, { KEY_PROG2 } },
144 { KE_KEY, 0x1d, { KEY_PROG3 } },
145 { KE_KEY, NOTIFY_BRN_MIN, { KEY_BRIGHTNESSDOWN } },
146 { KE_KEY, NOTIFY_BRN_MAX, { KEY_BRIGHTNESSUP } },
147 { KE_KEY, 0x30, { KEY_SWITCHVIDEOMODE } },
148 { KE_KEY, 0x31, { KEY_SWITCHVIDEOMODE } },
149 { KE_KEY, 0x32, { KEY_SWITCHVIDEOMODE } },
150 { KE_KEY, 0x37, { KEY_F13 } }, /* Disable Touchpad */
151 { KE_KEY, 0x38, { KEY_F14 } },
152 { KE_END, 0 },
153 };
154
155 /*
156 * This is the main structure, we can use it to store useful information
157 */
158 struct eeepc_laptop {
159 acpi_handle handle; /* the handle of the acpi device */
160 u32 cm_supported; /* the control methods supported
161 by this BIOS */
162 bool cpufv_disabled;
163 bool hotplug_disabled;
164 u16 event_count[128]; /* count for each event */
165
166 struct platform_device *platform_device;
167 struct acpi_device *device; /* the device we are in */
168 struct backlight_device *backlight_device;
169
170 struct input_dev *inputdev;
171
172 struct rfkill *wlan_rfkill;
173 struct rfkill *bluetooth_rfkill;
174 struct rfkill *wwan3g_rfkill;
175 struct rfkill *wimax_rfkill;
176
177 struct hotplug_slot *hotplug_slot;
178 struct mutex hotplug_lock;
179
180 struct led_classdev tpd_led;
181 int tpd_led_wk;
182 struct workqueue_struct *led_workqueue;
183 struct work_struct tpd_led_work;
184 };
185
186 /*
187 * ACPI Helpers
188 */
189 static int write_acpi_int(acpi_handle handle, const char *method, int val)
190 {
191 acpi_status status;
192
193 status = acpi_execute_simple_method(handle, (char *)method, val);
194
195 return (status == AE_OK ? 0 : -1);
196 }
197
198 static int read_acpi_int(acpi_handle handle, const char *method, int *val)
199 {
200 acpi_status status;
201 unsigned long long result;
202
203 status = acpi_evaluate_integer(handle, (char *)method, NULL, &result);
204 if (ACPI_FAILURE(status)) {
205 *val = -1;
206 return -1;
207 } else {
208 *val = result;
209 return 0;
210 }
211 }
212
213 static int set_acpi(struct eeepc_laptop *eeepc, int cm, int value)
214 {
215 const char *method = cm_setv[cm];
216
217 if (method == NULL)
218 return -ENODEV;
219 if ((eeepc->cm_supported & (0x1 << cm)) == 0)
220 return -ENODEV;
221
222 if (write_acpi_int(eeepc->handle, method, value))
223 pr_warn("Error writing %s\n", method);
224 return 0;
225 }
226
227 static int get_acpi(struct eeepc_laptop *eeepc, int cm)
228 {
229 const char *method = cm_getv[cm];
230 int value;
231
232 if (method == NULL)
233 return -ENODEV;
234 if ((eeepc->cm_supported & (0x1 << cm)) == 0)
235 return -ENODEV;
236
237 if (read_acpi_int(eeepc->handle, method, &value))
238 pr_warn("Error reading %s\n", method);
239 return value;
240 }
241
242 static int acpi_setter_handle(struct eeepc_laptop *eeepc, int cm,
243 acpi_handle *handle)
244 {
245 const char *method = cm_setv[cm];
246 acpi_status status;
247
248 if (method == NULL)
249 return -ENODEV;
250 if ((eeepc->cm_supported & (0x1 << cm)) == 0)
251 return -ENODEV;
252
253 status = acpi_get_handle(eeepc->handle, (char *)method,
254 handle);
255 if (status != AE_OK) {
256 pr_warn("Error finding %s\n", method);
257 return -ENODEV;
258 }
259 return 0;
260 }
261
262
263 /*
264 * Sys helpers
265 */
266 static int parse_arg(const char *buf, int *val)
267 {
268 if (sscanf(buf, "%i", val) != 1)
269 return -EINVAL;
270 return 0;
271 }
272
273 static ssize_t store_sys_acpi(struct device *dev, int cm,
274 const char *buf, size_t count)
275 {
276 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
277 int rv, value;
278
279 rv = parse_arg(buf, &value);
280 if (rv < 0)
281 return rv;
282 rv = set_acpi(eeepc, cm, value);
283 if (rv < 0)
284 return -EIO;
285 return count;
286 }
287
288 static ssize_t show_sys_acpi(struct device *dev, int cm, char *buf)
289 {
290 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
291 int value = get_acpi(eeepc, cm);
292
293 if (value < 0)
294 return -EIO;
295 return sprintf(buf, "%d\n", value);
296 }
297
298 #define EEEPC_ACPI_SHOW_FUNC(_name, _cm) \
299 static ssize_t _name##_show(struct device *dev, \
300 struct device_attribute *attr, \
301 char *buf) \
302 { \
303 return show_sys_acpi(dev, _cm, buf); \
304 }
305
306 #define EEEPC_ACPI_STORE_FUNC(_name, _cm) \
307 static ssize_t _name##_store(struct device *dev, \
308 struct device_attribute *attr, \
309 const char *buf, size_t count) \
310 { \
311 return store_sys_acpi(dev, _cm, buf, count); \
312 }
313
314 #define EEEPC_CREATE_DEVICE_ATTR_RW(_name, _cm) \
315 EEEPC_ACPI_SHOW_FUNC(_name, _cm) \
316 EEEPC_ACPI_STORE_FUNC(_name, _cm) \
317 static DEVICE_ATTR_RW(_name)
318
319 #define EEEPC_CREATE_DEVICE_ATTR_WO(_name, _cm) \
320 EEEPC_ACPI_STORE_FUNC(_name, _cm) \
321 static DEVICE_ATTR_WO(_name)
322
323 EEEPC_CREATE_DEVICE_ATTR_RW(camera, CM_ASL_CAMERA);
324 EEEPC_CREATE_DEVICE_ATTR_RW(cardr, CM_ASL_CARDREADER);
325 EEEPC_CREATE_DEVICE_ATTR_WO(disp, CM_ASL_DISPLAYSWITCH);
326
327 struct eeepc_cpufv {
328 int num;
329 int cur;
330 };
331
332 static int get_cpufv(struct eeepc_laptop *eeepc, struct eeepc_cpufv *c)
333 {
334 c->cur = get_acpi(eeepc, CM_ASL_CPUFV);
335 if (c->cur < 0)
336 return -ENODEV;
337
338 c->num = (c->cur >> 8) & 0xff;
339 c->cur &= 0xff;
340 if (c->num == 0 || c->num > 12)
341 return -ENODEV;
342 return 0;
343 }
344
345 static ssize_t available_cpufv_show(struct device *dev,
346 struct device_attribute *attr,
347 char *buf)
348 {
349 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
350 struct eeepc_cpufv c;
351 int i;
352 ssize_t len = 0;
353
354 if (get_cpufv(eeepc, &c))
355 return -ENODEV;
356 for (i = 0; i < c.num; i++)
357 len += sprintf(buf + len, "%d ", i);
358 len += sprintf(buf + len, "\n");
359 return len;
360 }
361
362 static ssize_t cpufv_show(struct device *dev,
363 struct device_attribute *attr,
364 char *buf)
365 {
366 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
367 struct eeepc_cpufv c;
368
369 if (get_cpufv(eeepc, &c))
370 return -ENODEV;
371 return sprintf(buf, "%#x\n", (c.num << 8) | c.cur);
372 }
373
374 static ssize_t cpufv_store(struct device *dev,
375 struct device_attribute *attr,
376 const char *buf, size_t count)
377 {
378 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
379 struct eeepc_cpufv c;
380 int rv, value;
381
382 if (eeepc->cpufv_disabled)
383 return -EPERM;
384 if (get_cpufv(eeepc, &c))
385 return -ENODEV;
386 rv = parse_arg(buf, &value);
387 if (rv < 0)
388 return rv;
389 if (value < 0 || value >= c.num)
390 return -EINVAL;
391 rv = set_acpi(eeepc, CM_ASL_CPUFV, value);
392 if (rv)
393 return rv;
394 return count;
395 }
396
397 static ssize_t cpufv_disabled_show(struct device *dev,
398 struct device_attribute *attr,
399 char *buf)
400 {
401 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
402
403 return sprintf(buf, "%d\n", eeepc->cpufv_disabled);
404 }
405
406 static ssize_t cpufv_disabled_store(struct device *dev,
407 struct device_attribute *attr,
408 const char *buf, size_t count)
409 {
410 struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
411 int rv, value;
412
413 rv = parse_arg(buf, &value);
414 if (rv < 0)
415 return rv;
416
417 switch (value) {
418 case 0:
419 if (eeepc->cpufv_disabled)
420 pr_warn("cpufv enabled (not officially supported on this model)\n");
421 eeepc->cpufv_disabled = false;
422 return count;
423 case 1:
424 return -EPERM;
425 default:
426 return -EINVAL;
427 }
428 }
429
430
431 static DEVICE_ATTR_RW(cpufv);
432 static DEVICE_ATTR_RO(available_cpufv);
433 static DEVICE_ATTR_RW(cpufv_disabled);
434
435 static struct attribute *platform_attributes[] = {
436 &dev_attr_camera.attr,
437 &dev_attr_cardr.attr,
438 &dev_attr_disp.attr,
439 &dev_attr_cpufv.attr,
440 &dev_attr_available_cpufv.attr,
441 &dev_attr_cpufv_disabled.attr,
442 NULL
443 };
444
445 static struct attribute_group platform_attribute_group = {
446 .attrs = platform_attributes
447 };
448
449 static int eeepc_platform_init(struct eeepc_laptop *eeepc)
450 {
451 int result;
452
453 eeepc->platform_device = platform_device_alloc(EEEPC_LAPTOP_FILE, -1);
454 if (!eeepc->platform_device)
455 return -ENOMEM;
456 platform_set_drvdata(eeepc->platform_device, eeepc);
457
458 result = platform_device_add(eeepc->platform_device);
459 if (result)
460 goto fail_platform_device;
461
462 result = sysfs_create_group(&eeepc->platform_device->dev.kobj,
463 &platform_attribute_group);
464 if (result)
465 goto fail_sysfs;
466 return 0;
467
468 fail_sysfs:
469 platform_device_del(eeepc->platform_device);
470 fail_platform_device:
471 platform_device_put(eeepc->platform_device);
472 return result;
473 }
474
475 static void eeepc_platform_exit(struct eeepc_laptop *eeepc)
476 {
477 sysfs_remove_group(&eeepc->platform_device->dev.kobj,
478 &platform_attribute_group);
479 platform_device_unregister(eeepc->platform_device);
480 }
481
482 /*
483 * LEDs
484 */
485 /*
486 * These functions actually update the LED's, and are called from a
487 * workqueue. By doing this as separate work rather than when the LED
488 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
489 * potentially bad time, such as a timer interrupt.
490 */
491 static void tpd_led_update(struct work_struct *work)
492 {
493 struct eeepc_laptop *eeepc;
494
495 eeepc = container_of(work, struct eeepc_laptop, tpd_led_work);
496
497 set_acpi(eeepc, CM_ASL_TPD, eeepc->tpd_led_wk);
498 }
499
500 static void tpd_led_set(struct led_classdev *led_cdev,
501 enum led_brightness value)
502 {
503 struct eeepc_laptop *eeepc;
504
505 eeepc = container_of(led_cdev, struct eeepc_laptop, tpd_led);
506
507 eeepc->tpd_led_wk = (value > 0) ? 1 : 0;
508 queue_work(eeepc->led_workqueue, &eeepc->tpd_led_work);
509 }
510
511 static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
512 {
513 struct eeepc_laptop *eeepc;
514
515 eeepc = container_of(led_cdev, struct eeepc_laptop, tpd_led);
516
517 return get_acpi(eeepc, CM_ASL_TPD);
518 }
519
520 static int eeepc_led_init(struct eeepc_laptop *eeepc)
521 {
522 int rv;
523
524 if (get_acpi(eeepc, CM_ASL_TPD) == -ENODEV)
525 return 0;
526
527 eeepc->led_workqueue = create_singlethread_workqueue("led_workqueue");
528 if (!eeepc->led_workqueue)
529 return -ENOMEM;
530 INIT_WORK(&eeepc->tpd_led_work, tpd_led_update);
531
532 eeepc->tpd_led.name = "eeepc::touchpad";
533 eeepc->tpd_led.brightness_set = tpd_led_set;
534 if (get_acpi(eeepc, CM_ASL_TPD) >= 0) /* if method is available */
535 eeepc->tpd_led.brightness_get = tpd_led_get;
536 eeepc->tpd_led.max_brightness = 1;
537
538 rv = led_classdev_register(&eeepc->platform_device->dev,
539 &eeepc->tpd_led);
540 if (rv) {
541 destroy_workqueue(eeepc->led_workqueue);
542 return rv;
543 }
544
545 return 0;
546 }
547
548 static void eeepc_led_exit(struct eeepc_laptop *eeepc)
549 {
550 if (!IS_ERR_OR_NULL(eeepc->tpd_led.dev))
551 led_classdev_unregister(&eeepc->tpd_led);
552 if (eeepc->led_workqueue)
553 destroy_workqueue(eeepc->led_workqueue);
554 }
555
556
557 /*
558 * PCI hotplug (for wlan rfkill)
559 */
560 static bool eeepc_wlan_rfkill_blocked(struct eeepc_laptop *eeepc)
561 {
562 if (get_acpi(eeepc, CM_ASL_WLAN) == 1)
563 return false;
564 return true;
565 }
566
567 static void eeepc_rfkill_hotplug(struct eeepc_laptop *eeepc, acpi_handle handle)
568 {
569 struct pci_dev *port;
570 struct pci_dev *dev;
571 struct pci_bus *bus;
572 bool blocked = eeepc_wlan_rfkill_blocked(eeepc);
573 bool absent;
574 u32 l;
575
576 if (eeepc->wlan_rfkill)
577 rfkill_set_sw_state(eeepc->wlan_rfkill, blocked);
578
579 mutex_lock(&eeepc->hotplug_lock);
580 pci_lock_rescan_remove();
581
582 if (!eeepc->hotplug_slot)
583 goto out_unlock;
584
585 port = acpi_get_pci_dev(handle);
586 if (!port) {
587 pr_warning("Unable to find port\n");
588 goto out_unlock;
589 }
590
591 bus = port->subordinate;
592
593 if (!bus) {
594 pr_warn("Unable to find PCI bus 1?\n");
595 goto out_put_dev;
596 }
597
598 if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
599 pr_err("Unable to read PCI config space?\n");
600 goto out_put_dev;
601 }
602
603 absent = (l == 0xffffffff);
604
605 if (blocked != absent) {
606 pr_warn("BIOS says wireless lan is %s, but the pci device is %s\n",
607 blocked ? "blocked" : "unblocked",
608 absent ? "absent" : "present");
609 pr_warn("skipped wireless hotplug as probably inappropriate for this model\n");
610 goto out_put_dev;
611 }
612
613 if (!blocked) {
614 dev = pci_get_slot(bus, 0);
615 if (dev) {
616 /* Device already present */
617 pci_dev_put(dev);
618 goto out_put_dev;
619 }
620 dev = pci_scan_single_device(bus, 0);
621 if (dev) {
622 pci_bus_assign_resources(bus);
623 pci_bus_add_device(dev);
624 }
625 } else {
626 dev = pci_get_slot(bus, 0);
627 if (dev) {
628 pci_stop_and_remove_bus_device(dev);
629 pci_dev_put(dev);
630 }
631 }
632 out_put_dev:
633 pci_dev_put(port);
634
635 out_unlock:
636 pci_unlock_rescan_remove();
637 mutex_unlock(&eeepc->hotplug_lock);
638 }
639
640 static void eeepc_rfkill_hotplug_update(struct eeepc_laptop *eeepc, char *node)
641 {
642 acpi_status status = AE_OK;
643 acpi_handle handle;
644
645 status = acpi_get_handle(NULL, node, &handle);
646
647 if (ACPI_SUCCESS(status))
648 eeepc_rfkill_hotplug(eeepc, handle);
649 }
650
651 static void eeepc_rfkill_notify(acpi_handle handle, u32 event, void *data)
652 {
653 struct eeepc_laptop *eeepc = data;
654
655 if (event != ACPI_NOTIFY_BUS_CHECK)
656 return;
657
658 eeepc_rfkill_hotplug(eeepc, handle);
659 }
660
661 static int eeepc_register_rfkill_notifier(struct eeepc_laptop *eeepc,
662 char *node)
663 {
664 acpi_status status;
665 acpi_handle handle;
666
667 status = acpi_get_handle(NULL, node, &handle);
668
669 if (ACPI_FAILURE(status))
670 return -ENODEV;
671
672 status = acpi_install_notify_handler(handle,
673 ACPI_SYSTEM_NOTIFY,
674 eeepc_rfkill_notify,
675 eeepc);
676 if (ACPI_FAILURE(status))
677 pr_warn("Failed to register notify on %s\n", node);
678
679 /*
680 * Refresh pci hotplug in case the rfkill state was
681 * changed during setup.
682 */
683 eeepc_rfkill_hotplug(eeepc, handle);
684 return 0;
685 }
686
687 static void eeepc_unregister_rfkill_notifier(struct eeepc_laptop *eeepc,
688 char *node)
689 {
690 acpi_status status = AE_OK;
691 acpi_handle handle;
692
693 status = acpi_get_handle(NULL, node, &handle);
694
695 if (ACPI_FAILURE(status))
696 return;
697
698 status = acpi_remove_notify_handler(handle,
699 ACPI_SYSTEM_NOTIFY,
700 eeepc_rfkill_notify);
701 if (ACPI_FAILURE(status))
702 pr_err("Error removing rfkill notify handler %s\n",
703 node);
704 /*
705 * Refresh pci hotplug in case the rfkill
706 * state was changed after
707 * eeepc_unregister_rfkill_notifier()
708 */
709 eeepc_rfkill_hotplug(eeepc, handle);
710 }
711
712 static int eeepc_get_adapter_status(struct hotplug_slot *hotplug_slot,
713 u8 *value)
714 {
715 struct eeepc_laptop *eeepc = hotplug_slot->private;
716 int val = get_acpi(eeepc, CM_ASL_WLAN);
717
718 if (val == 1 || val == 0)
719 *value = val;
720 else
721 return -EINVAL;
722
723 return 0;
724 }
725
726 static void eeepc_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
727 {
728 kfree(hotplug_slot->info);
729 kfree(hotplug_slot);
730 }
731
732 static struct hotplug_slot_ops eeepc_hotplug_slot_ops = {
733 .owner = THIS_MODULE,
734 .get_adapter_status = eeepc_get_adapter_status,
735 .get_power_status = eeepc_get_adapter_status,
736 };
737
738 static int eeepc_setup_pci_hotplug(struct eeepc_laptop *eeepc)
739 {
740 int ret = -ENOMEM;
741 struct pci_bus *bus = pci_find_bus(0, 1);
742
743 if (!bus) {
744 pr_err("Unable to find wifi PCI bus\n");
745 return -ENODEV;
746 }
747
748 eeepc->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
749 if (!eeepc->hotplug_slot)
750 goto error_slot;
751
752 eeepc->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
753 GFP_KERNEL);
754 if (!eeepc->hotplug_slot->info)
755 goto error_info;
756
757 eeepc->hotplug_slot->private = eeepc;
758 eeepc->hotplug_slot->release = &eeepc_cleanup_pci_hotplug;
759 eeepc->hotplug_slot->ops = &eeepc_hotplug_slot_ops;
760 eeepc_get_adapter_status(eeepc->hotplug_slot,
761 &eeepc->hotplug_slot->info->adapter_status);
762
763 ret = pci_hp_register(eeepc->hotplug_slot, bus, 0, "eeepc-wifi");
764 if (ret) {
765 pr_err("Unable to register hotplug slot - %d\n", ret);
766 goto error_register;
767 }
768
769 return 0;
770
771 error_register:
772 kfree(eeepc->hotplug_slot->info);
773 error_info:
774 kfree(eeepc->hotplug_slot);
775 eeepc->hotplug_slot = NULL;
776 error_slot:
777 return ret;
778 }
779
780 /*
781 * Rfkill devices
782 */
783 static int eeepc_rfkill_set(void *data, bool blocked)
784 {
785 acpi_handle handle = data;
786
787 return write_acpi_int(handle, NULL, !blocked);
788 }
789
790 static const struct rfkill_ops eeepc_rfkill_ops = {
791 .set_block = eeepc_rfkill_set,
792 };
793
794 static int eeepc_new_rfkill(struct eeepc_laptop *eeepc,
795 struct rfkill **rfkill,
796 const char *name,
797 enum rfkill_type type, int cm)
798 {
799 acpi_handle handle;
800 int result;
801
802 result = acpi_setter_handle(eeepc, cm, &handle);
803 if (result < 0)
804 return result;
805
806 *rfkill = rfkill_alloc(name, &eeepc->platform_device->dev, type,
807 &eeepc_rfkill_ops, handle);
808
809 if (!*rfkill)
810 return -EINVAL;
811
812 rfkill_init_sw_state(*rfkill, get_acpi(eeepc, cm) != 1);
813 result = rfkill_register(*rfkill);
814 if (result) {
815 rfkill_destroy(*rfkill);
816 *rfkill = NULL;
817 return result;
818 }
819 return 0;
820 }
821
822 static char EEEPC_RFKILL_NODE_1[] = "\\_SB.PCI0.P0P5";
823 static char EEEPC_RFKILL_NODE_2[] = "\\_SB.PCI0.P0P6";
824 static char EEEPC_RFKILL_NODE_3[] = "\\_SB.PCI0.P0P7";
825
826 static void eeepc_rfkill_exit(struct eeepc_laptop *eeepc)
827 {
828 eeepc_unregister_rfkill_notifier(eeepc, EEEPC_RFKILL_NODE_1);
829 eeepc_unregister_rfkill_notifier(eeepc, EEEPC_RFKILL_NODE_2);
830 eeepc_unregister_rfkill_notifier(eeepc, EEEPC_RFKILL_NODE_3);
831 if (eeepc->wlan_rfkill) {
832 rfkill_unregister(eeepc->wlan_rfkill);
833 rfkill_destroy(eeepc->wlan_rfkill);
834 eeepc->wlan_rfkill = NULL;
835 }
836
837 if (eeepc->hotplug_slot)
838 pci_hp_deregister(eeepc->hotplug_slot);
839
840 if (eeepc->bluetooth_rfkill) {
841 rfkill_unregister(eeepc->bluetooth_rfkill);
842 rfkill_destroy(eeepc->bluetooth_rfkill);
843 eeepc->bluetooth_rfkill = NULL;
844 }
845 if (eeepc->wwan3g_rfkill) {
846 rfkill_unregister(eeepc->wwan3g_rfkill);
847 rfkill_destroy(eeepc->wwan3g_rfkill);
848 eeepc->wwan3g_rfkill = NULL;
849 }
850 if (eeepc->wimax_rfkill) {
851 rfkill_unregister(eeepc->wimax_rfkill);
852 rfkill_destroy(eeepc->wimax_rfkill);
853 eeepc->wimax_rfkill = NULL;
854 }
855 }
856
857 static int eeepc_rfkill_init(struct eeepc_laptop *eeepc)
858 {
859 int result = 0;
860
861 mutex_init(&eeepc->hotplug_lock);
862
863 result = eeepc_new_rfkill(eeepc, &eeepc->wlan_rfkill,
864 "eeepc-wlan", RFKILL_TYPE_WLAN,
865 CM_ASL_WLAN);
866
867 if (result && result != -ENODEV)
868 goto exit;
869
870 result = eeepc_new_rfkill(eeepc, &eeepc->bluetooth_rfkill,
871 "eeepc-bluetooth", RFKILL_TYPE_BLUETOOTH,
872 CM_ASL_BLUETOOTH);
873
874 if (result && result != -ENODEV)
875 goto exit;
876
877 result = eeepc_new_rfkill(eeepc, &eeepc->wwan3g_rfkill,
878 "eeepc-wwan3g", RFKILL_TYPE_WWAN,
879 CM_ASL_3G);
880
881 if (result && result != -ENODEV)
882 goto exit;
883
884 result = eeepc_new_rfkill(eeepc, &eeepc->wimax_rfkill,
885 "eeepc-wimax", RFKILL_TYPE_WIMAX,
886 CM_ASL_WIMAX);
887
888 if (result && result != -ENODEV)
889 goto exit;
890
891 if (eeepc->hotplug_disabled)
892 return 0;
893
894 result = eeepc_setup_pci_hotplug(eeepc);
895 /*
896 * If we get -EBUSY then something else is handling the PCI hotplug -
897 * don't fail in this case
898 */
899 if (result == -EBUSY)
900 result = 0;
901
902 eeepc_register_rfkill_notifier(eeepc, EEEPC_RFKILL_NODE_1);
903 eeepc_register_rfkill_notifier(eeepc, EEEPC_RFKILL_NODE_2);
904 eeepc_register_rfkill_notifier(eeepc, EEEPC_RFKILL_NODE_3);
905
906 exit:
907 if (result && result != -ENODEV)
908 eeepc_rfkill_exit(eeepc);
909 return result;
910 }
911
912 /*
913 * Platform driver - hibernate/resume callbacks
914 */
915 static int eeepc_hotk_thaw(struct device *device)
916 {
917 struct eeepc_laptop *eeepc = dev_get_drvdata(device);
918
919 if (eeepc->wlan_rfkill) {
920 int wlan;
921
922 /*
923 * Work around bios bug - acpi _PTS turns off the wireless led
924 * during suspend. Normally it restores it on resume, but
925 * we should kick it ourselves in case hibernation is aborted.
926 */
927 wlan = get_acpi(eeepc, CM_ASL_WLAN);
928 if (wlan >= 0)
929 set_acpi(eeepc, CM_ASL_WLAN, wlan);
930 }
931
932 return 0;
933 }
934
935 static int eeepc_hotk_restore(struct device *device)
936 {
937 struct eeepc_laptop *eeepc = dev_get_drvdata(device);
938
939 /* Refresh both wlan rfkill state and pci hotplug */
940 if (eeepc->wlan_rfkill) {
941 eeepc_rfkill_hotplug_update(eeepc, EEEPC_RFKILL_NODE_1);
942 eeepc_rfkill_hotplug_update(eeepc, EEEPC_RFKILL_NODE_2);
943 eeepc_rfkill_hotplug_update(eeepc, EEEPC_RFKILL_NODE_3);
944 }
945
946 if (eeepc->bluetooth_rfkill)
947 rfkill_set_sw_state(eeepc->bluetooth_rfkill,
948 get_acpi(eeepc, CM_ASL_BLUETOOTH) != 1);
949 if (eeepc->wwan3g_rfkill)
950 rfkill_set_sw_state(eeepc->wwan3g_rfkill,
951 get_acpi(eeepc, CM_ASL_3G) != 1);
952 if (eeepc->wimax_rfkill)
953 rfkill_set_sw_state(eeepc->wimax_rfkill,
954 get_acpi(eeepc, CM_ASL_WIMAX) != 1);
955
956 return 0;
957 }
958
959 static const struct dev_pm_ops eeepc_pm_ops = {
960 .thaw = eeepc_hotk_thaw,
961 .restore = eeepc_hotk_restore,
962 };
963
964 static struct platform_driver platform_driver = {
965 .driver = {
966 .name = EEEPC_LAPTOP_FILE,
967 .pm = &eeepc_pm_ops,
968 }
969 };
970
971 /*
972 * Hwmon device
973 */
974
975 #define EEEPC_EC_SC00 0x61
976 #define EEEPC_EC_FAN_PWM (EEEPC_EC_SC00 + 2) /* Fan PWM duty cycle (%) */
977 #define EEEPC_EC_FAN_HRPM (EEEPC_EC_SC00 + 5) /* High byte, fan speed (RPM) */
978 #define EEEPC_EC_FAN_LRPM (EEEPC_EC_SC00 + 6) /* Low byte, fan speed (RPM) */
979
980 #define EEEPC_EC_SFB0 0xD0
981 #define EEEPC_EC_FAN_CTRL (EEEPC_EC_SFB0 + 3) /* Byte containing SF25 */
982
983 static inline int eeepc_pwm_to_lmsensors(int value)
984 {
985 return value * 255 / 100;
986 }
987
988 static inline int eeepc_lmsensors_to_pwm(int value)
989 {
990 value = clamp_val(value, 0, 255);
991 return value * 100 / 255;
992 }
993
994 static int eeepc_get_fan_pwm(void)
995 {
996 u8 value = 0;
997
998 ec_read(EEEPC_EC_FAN_PWM, &value);
999 return eeepc_pwm_to_lmsensors(value);
1000 }
1001
1002 static void eeepc_set_fan_pwm(int value)
1003 {
1004 value = eeepc_lmsensors_to_pwm(value);
1005 ec_write(EEEPC_EC_FAN_PWM, value);
1006 }
1007
1008 static int eeepc_get_fan_rpm(void)
1009 {
1010 u8 high = 0;
1011 u8 low = 0;
1012
1013 ec_read(EEEPC_EC_FAN_HRPM, &high);
1014 ec_read(EEEPC_EC_FAN_LRPM, &low);
1015 return high << 8 | low;
1016 }
1017
1018 #define EEEPC_EC_FAN_CTRL_BIT 0x02
1019 #define EEEPC_FAN_CTRL_MANUAL 1
1020 #define EEEPC_FAN_CTRL_AUTO 2
1021
1022 static int eeepc_get_fan_ctrl(void)
1023 {
1024 u8 value = 0;
1025
1026 ec_read(EEEPC_EC_FAN_CTRL, &value);
1027 if (value & EEEPC_EC_FAN_CTRL_BIT)
1028 return EEEPC_FAN_CTRL_MANUAL;
1029 else
1030 return EEEPC_FAN_CTRL_AUTO;
1031 }
1032
1033 static void eeepc_set_fan_ctrl(int manual)
1034 {
1035 u8 value = 0;
1036
1037 ec_read(EEEPC_EC_FAN_CTRL, &value);
1038 if (manual == EEEPC_FAN_CTRL_MANUAL)
1039 value |= EEEPC_EC_FAN_CTRL_BIT;
1040 else
1041 value &= ~EEEPC_EC_FAN_CTRL_BIT;
1042 ec_write(EEEPC_EC_FAN_CTRL, value);
1043 }
1044
1045 static ssize_t store_sys_hwmon(void (*set)(int), const char *buf, size_t count)
1046 {
1047 int rv, value;
1048
1049 rv = parse_arg(buf, &value);
1050 if (rv < 0)
1051 return rv;
1052 set(value);
1053 return count;
1054 }
1055
1056 static ssize_t show_sys_hwmon(int (*get)(void), char *buf)
1057 {
1058 return sprintf(buf, "%d\n", get());
1059 }
1060
1061 #define EEEPC_SENSOR_SHOW_FUNC(_name, _get) \
1062 static ssize_t _name##_show(struct device *dev, \
1063 struct device_attribute *attr, \
1064 char *buf) \
1065 { \
1066 return show_sys_hwmon(_get, buf); \
1067 }
1068
1069 #define EEEPC_SENSOR_STORE_FUNC(_name, _set) \
1070 static ssize_t _name##_store(struct device *dev, \
1071 struct device_attribute *attr, \
1072 const char *buf, size_t count) \
1073 { \
1074 return store_sys_hwmon(_set, buf, count); \
1075 }
1076
1077 #define EEEPC_CREATE_SENSOR_ATTR_RW(_name, _get, _set) \
1078 EEEPC_SENSOR_SHOW_FUNC(_name, _get) \
1079 EEEPC_SENSOR_STORE_FUNC(_name, _set) \
1080 static DEVICE_ATTR_RW(_name)
1081
1082 #define EEEPC_CREATE_SENSOR_ATTR_RO(_name, _get) \
1083 EEEPC_SENSOR_SHOW_FUNC(_name, _get) \
1084 static DEVICE_ATTR_RO(_name)
1085
1086 EEEPC_CREATE_SENSOR_ATTR_RO(fan1_input, eeepc_get_fan_rpm);
1087 EEEPC_CREATE_SENSOR_ATTR_RW(pwm1, eeepc_get_fan_pwm,
1088 eeepc_set_fan_pwm);
1089 EEEPC_CREATE_SENSOR_ATTR_RW(pwm1_enable, eeepc_get_fan_ctrl,
1090 eeepc_set_fan_ctrl);
1091
1092 static struct attribute *hwmon_attrs[] = {
1093 &dev_attr_pwm1.attr,
1094 &dev_attr_fan1_input.attr,
1095 &dev_attr_pwm1_enable.attr,
1096 NULL
1097 };
1098 ATTRIBUTE_GROUPS(hwmon);
1099
1100 static int eeepc_hwmon_init(struct eeepc_laptop *eeepc)
1101 {
1102 struct device *dev = &eeepc->platform_device->dev;
1103 struct device *hwmon;
1104
1105 hwmon = devm_hwmon_device_register_with_groups(dev, "eeepc", NULL,
1106 hwmon_groups);
1107 if (IS_ERR(hwmon)) {
1108 pr_err("Could not register eeepc hwmon device\n");
1109 return PTR_ERR(hwmon);
1110 }
1111 return 0;
1112 }
1113
1114 /*
1115 * Backlight device
1116 */
1117 static int read_brightness(struct backlight_device *bd)
1118 {
1119 struct eeepc_laptop *eeepc = bl_get_data(bd);
1120
1121 return get_acpi(eeepc, CM_ASL_PANELBRIGHT);
1122 }
1123
1124 static int set_brightness(struct backlight_device *bd, int value)
1125 {
1126 struct eeepc_laptop *eeepc = bl_get_data(bd);
1127
1128 return set_acpi(eeepc, CM_ASL_PANELBRIGHT, value);
1129 }
1130
1131 static int update_bl_status(struct backlight_device *bd)
1132 {
1133 return set_brightness(bd, bd->props.brightness);
1134 }
1135
1136 static const struct backlight_ops eeepcbl_ops = {
1137 .get_brightness = read_brightness,
1138 .update_status = update_bl_status,
1139 };
1140
1141 static int eeepc_backlight_notify(struct eeepc_laptop *eeepc)
1142 {
1143 struct backlight_device *bd = eeepc->backlight_device;
1144 int old = bd->props.brightness;
1145
1146 backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1147
1148 return old;
1149 }
1150
1151 static int eeepc_backlight_init(struct eeepc_laptop *eeepc)
1152 {
1153 struct backlight_properties props;
1154 struct backlight_device *bd;
1155
1156 memset(&props, 0, sizeof(struct backlight_properties));
1157 props.type = BACKLIGHT_PLATFORM;
1158 props.max_brightness = 15;
1159 bd = backlight_device_register(EEEPC_LAPTOP_FILE,
1160 &eeepc->platform_device->dev, eeepc,
1161 &eeepcbl_ops, &props);
1162 if (IS_ERR(bd)) {
1163 pr_err("Could not register eeepc backlight device\n");
1164 eeepc->backlight_device = NULL;
1165 return PTR_ERR(bd);
1166 }
1167 eeepc->backlight_device = bd;
1168 bd->props.brightness = read_brightness(bd);
1169 bd->props.power = FB_BLANK_UNBLANK;
1170 backlight_update_status(bd);
1171 return 0;
1172 }
1173
1174 static void eeepc_backlight_exit(struct eeepc_laptop *eeepc)
1175 {
1176 backlight_device_unregister(eeepc->backlight_device);
1177 eeepc->backlight_device = NULL;
1178 }
1179
1180
1181 /*
1182 * Input device (i.e. hotkeys)
1183 */
1184 static int eeepc_input_init(struct eeepc_laptop *eeepc)
1185 {
1186 struct input_dev *input;
1187 int error;
1188
1189 input = input_allocate_device();
1190 if (!input)
1191 return -ENOMEM;
1192
1193 input->name = "Asus EeePC extra buttons";
1194 input->phys = EEEPC_LAPTOP_FILE "/input0";
1195 input->id.bustype = BUS_HOST;
1196 input->dev.parent = &eeepc->platform_device->dev;
1197
1198 error = sparse_keymap_setup(input, eeepc_keymap, NULL);
1199 if (error) {
1200 pr_err("Unable to setup input device keymap\n");
1201 goto err_free_dev;
1202 }
1203
1204 error = input_register_device(input);
1205 if (error) {
1206 pr_err("Unable to register input device\n");
1207 goto err_free_keymap;
1208 }
1209
1210 eeepc->inputdev = input;
1211 return 0;
1212
1213 err_free_keymap:
1214 sparse_keymap_free(input);
1215 err_free_dev:
1216 input_free_device(input);
1217 return error;
1218 }
1219
1220 static void eeepc_input_exit(struct eeepc_laptop *eeepc)
1221 {
1222 if (eeepc->inputdev) {
1223 sparse_keymap_free(eeepc->inputdev);
1224 input_unregister_device(eeepc->inputdev);
1225 }
1226 eeepc->inputdev = NULL;
1227 }
1228
1229 /*
1230 * ACPI driver
1231 */
1232 static void eeepc_input_notify(struct eeepc_laptop *eeepc, int event)
1233 {
1234 if (!eeepc->inputdev)
1235 return;
1236 if (!sparse_keymap_report_event(eeepc->inputdev, event, 1, true))
1237 pr_info("Unknown key %x pressed\n", event);
1238 }
1239
1240 static void eeepc_acpi_notify(struct acpi_device *device, u32 event)
1241 {
1242 struct eeepc_laptop *eeepc = acpi_driver_data(device);
1243 int old_brightness, new_brightness;
1244 u16 count;
1245
1246 if (event > ACPI_MAX_SYS_NOTIFY)
1247 return;
1248 count = eeepc->event_count[event % 128]++;
1249 acpi_bus_generate_netlink_event(device->pnp.device_class,
1250 dev_name(&device->dev), event,
1251 count);
1252
1253 /* Brightness events are special */
1254 if (event < NOTIFY_BRN_MIN || event > NOTIFY_BRN_MAX) {
1255 eeepc_input_notify(eeepc, event);
1256 return;
1257 }
1258
1259 /* Ignore them completely if the acpi video driver is used */
1260 if (!eeepc->backlight_device)
1261 return;
1262
1263 /* Update the backlight device. */
1264 old_brightness = eeepc_backlight_notify(eeepc);
1265
1266 /* Convert event to keypress (obsolescent hack) */
1267 new_brightness = event - NOTIFY_BRN_MIN;
1268
1269 if (new_brightness < old_brightness) {
1270 event = NOTIFY_BRN_MIN; /* brightness down */
1271 } else if (new_brightness > old_brightness) {
1272 event = NOTIFY_BRN_MAX; /* brightness up */
1273 } else {
1274 /*
1275 * no change in brightness - already at min/max,
1276 * event will be desired value (or else ignored)
1277 */
1278 }
1279 eeepc_input_notify(eeepc, event);
1280 }
1281
1282 static void eeepc_dmi_check(struct eeepc_laptop *eeepc)
1283 {
1284 const char *model;
1285
1286 model = dmi_get_system_info(DMI_PRODUCT_NAME);
1287 if (!model)
1288 return;
1289
1290 /*
1291 * Blacklist for setting cpufv (cpu speed).
1292 *
1293 * EeePC 4G ("701") implements CFVS, but it is not supported
1294 * by the pre-installed OS, and the original option to change it
1295 * in the BIOS setup screen was removed in later versions.
1296 *
1297 * Judging by the lack of "Super Hybrid Engine" on Asus product pages,
1298 * this applies to all "701" models (4G/4G Surf/2G Surf).
1299 *
1300 * So Asus made a deliberate decision not to support it on this model.
1301 * We have several reports that using it can cause the system to hang
1302 *
1303 * The hang has also been reported on a "702" (Model name "8G"?).
1304 *
1305 * We avoid dmi_check_system() / dmi_match(), because they use
1306 * substring matching. We don't want to affect the "701SD"
1307 * and "701SDX" models, because they do support S.H.E.
1308 */
1309 if (strcmp(model, "701") == 0 || strcmp(model, "702") == 0) {
1310 eeepc->cpufv_disabled = true;
1311 pr_info("model %s does not officially support setting cpu speed\n",
1312 model);
1313 pr_info("cpufv disabled to avoid instability\n");
1314 }
1315
1316 /*
1317 * Blacklist for wlan hotplug
1318 *
1319 * Eeepc 1005HA doesn't work like others models and don't need the
1320 * hotplug code. In fact, current hotplug code seems to unplug another
1321 * device...
1322 */
1323 if (strcmp(model, "1005HA") == 0 || strcmp(model, "1201N") == 0 ||
1324 strcmp(model, "1005PE") == 0) {
1325 eeepc->hotplug_disabled = true;
1326 pr_info("wlan hotplug disabled\n");
1327 }
1328 }
1329
1330 static void cmsg_quirk(struct eeepc_laptop *eeepc, int cm, const char *name)
1331 {
1332 int dummy;
1333
1334 /* Some BIOSes do not report cm although it is available.
1335 Check if cm_getv[cm] works and, if yes, assume cm should be set. */
1336 if (!(eeepc->cm_supported & (1 << cm))
1337 && !read_acpi_int(eeepc->handle, cm_getv[cm], &dummy)) {
1338 pr_info("%s (%x) not reported by BIOS, enabling anyway\n",
1339 name, 1 << cm);
1340 eeepc->cm_supported |= 1 << cm;
1341 }
1342 }
1343
1344 static void cmsg_quirks(struct eeepc_laptop *eeepc)
1345 {
1346 cmsg_quirk(eeepc, CM_ASL_LID, "LID");
1347 cmsg_quirk(eeepc, CM_ASL_TYPE, "TYPE");
1348 cmsg_quirk(eeepc, CM_ASL_PANELPOWER, "PANELPOWER");
1349 cmsg_quirk(eeepc, CM_ASL_TPD, "TPD");
1350 }
1351
1352 static int eeepc_acpi_init(struct eeepc_laptop *eeepc)
1353 {
1354 unsigned int init_flags;
1355 int result;
1356
1357 result = acpi_bus_get_status(eeepc->device);
1358 if (result)
1359 return result;
1360 if (!eeepc->device->status.present) {
1361 pr_err("Hotkey device not present, aborting\n");
1362 return -ENODEV;
1363 }
1364
1365 init_flags = DISABLE_ASL_WLAN | DISABLE_ASL_DISPLAYSWITCH;
1366 pr_notice("Hotkey init flags 0x%x\n", init_flags);
1367
1368 if (write_acpi_int(eeepc->handle, "INIT", init_flags)) {
1369 pr_err("Hotkey initialization failed\n");
1370 return -ENODEV;
1371 }
1372
1373 /* get control methods supported */
1374 if (read_acpi_int(eeepc->handle, "CMSG", &eeepc->cm_supported)) {
1375 pr_err("Get control methods supported failed\n");
1376 return -ENODEV;
1377 }
1378 cmsg_quirks(eeepc);
1379 pr_info("Get control methods supported: 0x%x\n", eeepc->cm_supported);
1380
1381 return 0;
1382 }
1383
1384 static void eeepc_enable_camera(struct eeepc_laptop *eeepc)
1385 {
1386 /*
1387 * If the following call to set_acpi() fails, it's because there's no
1388 * camera so we can ignore the error.
1389 */
1390 if (get_acpi(eeepc, CM_ASL_CAMERA) == 0)
1391 set_acpi(eeepc, CM_ASL_CAMERA, 1);
1392 }
1393
1394 static bool eeepc_device_present;
1395
1396 static int eeepc_acpi_add(struct acpi_device *device)
1397 {
1398 struct eeepc_laptop *eeepc;
1399 int result;
1400
1401 pr_notice(EEEPC_LAPTOP_NAME "\n");
1402 eeepc = kzalloc(sizeof(struct eeepc_laptop), GFP_KERNEL);
1403 if (!eeepc)
1404 return -ENOMEM;
1405 eeepc->handle = device->handle;
1406 strcpy(acpi_device_name(device), EEEPC_ACPI_DEVICE_NAME);
1407 strcpy(acpi_device_class(device), EEEPC_ACPI_CLASS);
1408 device->driver_data = eeepc;
1409 eeepc->device = device;
1410
1411 eeepc->hotplug_disabled = hotplug_disabled;
1412
1413 eeepc_dmi_check(eeepc);
1414
1415 result = eeepc_acpi_init(eeepc);
1416 if (result)
1417 goto fail_platform;
1418 eeepc_enable_camera(eeepc);
1419
1420 /*
1421 * Register the platform device first. It is used as a parent for the
1422 * sub-devices below.
1423 *
1424 * Note that if there are multiple instances of this ACPI device it
1425 * will bail out, because the platform device is registered with a
1426 * fixed name. Of course it doesn't make sense to have more than one,
1427 * and machine-specific scripts find the fixed name convenient. But
1428 * It's also good for us to exclude multiple instances because both
1429 * our hwmon and our wlan rfkill subdevice use global ACPI objects
1430 * (the EC and the wlan PCI slot respectively).
1431 */
1432 result = eeepc_platform_init(eeepc);
1433 if (result)
1434 goto fail_platform;
1435
1436 if (!acpi_video_backlight_support()) {
1437 result = eeepc_backlight_init(eeepc);
1438 if (result)
1439 goto fail_backlight;
1440 } else {
1441 pr_info("Backlight controlled by ACPI video driver\n");
1442 }
1443
1444 result = eeepc_input_init(eeepc);
1445 if (result)
1446 goto fail_input;
1447
1448 result = eeepc_hwmon_init(eeepc);
1449 if (result)
1450 goto fail_hwmon;
1451
1452 result = eeepc_led_init(eeepc);
1453 if (result)
1454 goto fail_led;
1455
1456 result = eeepc_rfkill_init(eeepc);
1457 if (result)
1458 goto fail_rfkill;
1459
1460 eeepc_device_present = true;
1461 return 0;
1462
1463 fail_rfkill:
1464 eeepc_led_exit(eeepc);
1465 fail_led:
1466 fail_hwmon:
1467 eeepc_input_exit(eeepc);
1468 fail_input:
1469 eeepc_backlight_exit(eeepc);
1470 fail_backlight:
1471 eeepc_platform_exit(eeepc);
1472 fail_platform:
1473 kfree(eeepc);
1474
1475 return result;
1476 }
1477
1478 static int eeepc_acpi_remove(struct acpi_device *device)
1479 {
1480 struct eeepc_laptop *eeepc = acpi_driver_data(device);
1481
1482 eeepc_backlight_exit(eeepc);
1483 eeepc_rfkill_exit(eeepc);
1484 eeepc_input_exit(eeepc);
1485 eeepc_led_exit(eeepc);
1486 eeepc_platform_exit(eeepc);
1487
1488 kfree(eeepc);
1489 return 0;
1490 }
1491
1492
1493 static const struct acpi_device_id eeepc_device_ids[] = {
1494 {EEEPC_ACPI_HID, 0},
1495 {"", 0},
1496 };
1497 MODULE_DEVICE_TABLE(acpi, eeepc_device_ids);
1498
1499 static struct acpi_driver eeepc_acpi_driver = {
1500 .name = EEEPC_LAPTOP_NAME,
1501 .class = EEEPC_ACPI_CLASS,
1502 .owner = THIS_MODULE,
1503 .ids = eeepc_device_ids,
1504 .flags = ACPI_DRIVER_ALL_NOTIFY_EVENTS,
1505 .ops = {
1506 .add = eeepc_acpi_add,
1507 .remove = eeepc_acpi_remove,
1508 .notify = eeepc_acpi_notify,
1509 },
1510 };
1511
1512
1513 static int __init eeepc_laptop_init(void)
1514 {
1515 int result;
1516
1517 result = platform_driver_register(&platform_driver);
1518 if (result < 0)
1519 return result;
1520
1521 result = acpi_bus_register_driver(&eeepc_acpi_driver);
1522 if (result < 0)
1523 goto fail_acpi_driver;
1524
1525 if (!eeepc_device_present) {
1526 result = -ENODEV;
1527 goto fail_no_device;
1528 }
1529
1530 return 0;
1531
1532 fail_no_device:
1533 acpi_bus_unregister_driver(&eeepc_acpi_driver);
1534 fail_acpi_driver:
1535 platform_driver_unregister(&platform_driver);
1536 return result;
1537 }
1538
1539 static void __exit eeepc_laptop_exit(void)
1540 {
1541 acpi_bus_unregister_driver(&eeepc_acpi_driver);
1542 platform_driver_unregister(&platform_driver);
1543 }
1544
1545 module_init(eeepc_laptop_init);
1546 module_exit(eeepc_laptop_exit);
Linux with added FPC-III support