GNU Linux-libre 4.9.328-gnu1
[releases.git] / drivers / platform / x86 / hp-wmi.c
1 /*
2  * HP WMI hotkeys
3  *
4  * Copyright (C) 2008 Red Hat <mjg@redhat.com>
5  * Copyright (C) 2010, 2011 Anssi Hannula <anssi.hannula@iki.fi>
6  *
7  * Portions based on wistron_btns.c:
8  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
9  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
10  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
11  *
12  *  This program is free software; you can redistribute it and/or modify
13  *  it under the terms of the GNU General Public License as published by
14  *  the Free Software Foundation; either version 2 of the License, or
15  *  (at your option) any later version.
16  *
17  *  This program is distributed in the hope that it will be useful,
18  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
19  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
20  *  GNU General Public License for more details.
21  *
22  *  You should have received a copy of the GNU General Public License
23  *  along with this program; if not, write to the Free Software
24  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
25  */
26
27 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
28
29 #include <linux/kernel.h>
30 #include <linux/module.h>
31 #include <linux/init.h>
32 #include <linux/slab.h>
33 #include <linux/types.h>
34 #include <linux/input.h>
35 #include <linux/input/sparse-keymap.h>
36 #include <linux/platform_device.h>
37 #include <linux/acpi.h>
38 #include <linux/rfkill.h>
39 #include <linux/string.h>
40
41 MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
42 MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
43 MODULE_LICENSE("GPL");
44
45 MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
46 MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");
47
48 #define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
49 #define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"
50
51 #define HPWMI_DISPLAY_QUERY 0x1
52 #define HPWMI_HDDTEMP_QUERY 0x2
53 #define HPWMI_ALS_QUERY 0x3
54 #define HPWMI_HARDWARE_QUERY 0x4
55 #define HPWMI_WIRELESS_QUERY 0x5
56 #define HPWMI_BIOS_QUERY 0x9
57 #define HPWMI_FEATURE_QUERY 0xb
58 #define HPWMI_HOTKEY_QUERY 0xc
59 #define HPWMI_FEATURE2_QUERY 0xd
60 #define HPWMI_WIRELESS2_QUERY 0x1b
61 #define HPWMI_POSTCODEERROR_QUERY 0x2a
62
63 enum hp_wmi_radio {
64         HPWMI_WIFI = 0,
65         HPWMI_BLUETOOTH = 1,
66         HPWMI_WWAN = 2,
67         HPWMI_GPS = 3,
68 };
69
70 enum hp_wmi_event_ids {
71         HPWMI_DOCK_EVENT = 1,
72         HPWMI_PARK_HDD = 2,
73         HPWMI_SMART_ADAPTER = 3,
74         HPWMI_BEZEL_BUTTON = 4,
75         HPWMI_WIRELESS = 5,
76         HPWMI_CPU_BATTERY_THROTTLE = 6,
77         HPWMI_LOCK_SWITCH = 7,
78         HPWMI_LID_SWITCH = 8,
79         HPWMI_SCREEN_ROTATION = 9,
80         HPWMI_COOLSENSE_SYSTEM_MOBILE = 0x0A,
81         HPWMI_COOLSENSE_SYSTEM_HOT = 0x0B,
82         HPWMI_PROXIMITY_SENSOR = 0x0C,
83         HPWMI_BACKLIT_KB_BRIGHTNESS = 0x0D,
84         HPWMI_PEAKSHIFT_PERIOD = 0x0F,
85         HPWMI_BATTERY_CHARGE_PERIOD = 0x10,
86 };
87
88 struct bios_args {
89         u32 signature;
90         u32 command;
91         u32 commandtype;
92         u32 datasize;
93         u8 data[128];
94 };
95
96 struct bios_return {
97         u32 sigpass;
98         u32 return_code;
99 };
100
101 enum hp_return_value {
102         HPWMI_RET_WRONG_SIGNATURE       = 0x02,
103         HPWMI_RET_UNKNOWN_COMMAND       = 0x03,
104         HPWMI_RET_UNKNOWN_CMDTYPE       = 0x04,
105         HPWMI_RET_INVALID_PARAMETERS    = 0x05,
106 };
107
108 enum hp_wireless2_bits {
109         HPWMI_POWER_STATE       = 0x01,
110         HPWMI_POWER_SOFT        = 0x02,
111         HPWMI_POWER_BIOS        = 0x04,
112         HPWMI_POWER_HARD        = 0x08,
113 };
114
115 #define IS_HWBLOCKED(x) ((x & (HPWMI_POWER_BIOS | HPWMI_POWER_HARD)) \
116                          != (HPWMI_POWER_BIOS | HPWMI_POWER_HARD))
117 #define IS_SWBLOCKED(x) !(x & HPWMI_POWER_SOFT)
118
119 struct bios_rfkill2_device_state {
120         u8 radio_type;
121         u8 bus_type;
122         u16 vendor_id;
123         u16 product_id;
124         u16 subsys_vendor_id;
125         u16 subsys_product_id;
126         u8 rfkill_id;
127         u8 power;
128         u8 unknown[4];
129 };
130
131 /* 7 devices fit into the 128 byte buffer */
132 #define HPWMI_MAX_RFKILL2_DEVICES       7
133
134 struct bios_rfkill2_state {
135         u8 unknown[7];
136         u8 count;
137         u8 pad[8];
138         struct bios_rfkill2_device_state device[HPWMI_MAX_RFKILL2_DEVICES];
139 };
140
141 static const struct key_entry hp_wmi_keymap[] = {
142         { KE_KEY, 0x02,   { KEY_BRIGHTNESSUP } },
143         { KE_KEY, 0x03,   { KEY_BRIGHTNESSDOWN } },
144         { KE_KEY, 0x20e6, { KEY_PROG1 } },
145         { KE_KEY, 0x20e8, { KEY_MEDIA } },
146         { KE_KEY, 0x2142, { KEY_MEDIA } },
147         { KE_KEY, 0x213b, { KEY_INFO } },
148         { KE_KEY, 0x2169, { KEY_ROTATE_DISPLAY } },
149         { KE_KEY, 0x216a, { KEY_SETUP } },
150         { KE_KEY, 0x231b, { KEY_HELP } },
151         { KE_END, 0 }
152 };
153
154 static struct input_dev *hp_wmi_input_dev;
155 static struct platform_device *hp_wmi_platform_dev;
156
157 static struct rfkill *wifi_rfkill;
158 static struct rfkill *bluetooth_rfkill;
159 static struct rfkill *wwan_rfkill;
160
161 struct rfkill2_device {
162         u8 id;
163         int num;
164         struct rfkill *rfkill;
165 };
166
167 static int rfkill2_count;
168 static struct rfkill2_device rfkill2[HPWMI_MAX_RFKILL2_DEVICES];
169
170 /*
171  * hp_wmi_perform_query
172  *
173  * query:       The commandtype -> What should be queried
174  * write:       The command -> 0 read, 1 write, 3 ODM specific
175  * buffer:      Buffer used as input and/or output
176  * insize:      Size of input buffer
177  * outsize:     Size of output buffer
178  *
179  * returns zero on success
180  *         an HP WMI query specific error code (which is positive)
181  *         -EINVAL if the query was not successful at all
182  *         -EINVAL if the output buffer size exceeds buffersize
183  *
184  * Note: The buffersize must at least be the maximum of the input and output
185  *       size. E.g. Battery info query (0x7) is defined to have 1 byte input
186  *       and 128 byte output. The caller would do:
187  *       buffer = kzalloc(128, GFP_KERNEL);
188  *       ret = hp_wmi_perform_query(0x7, 0, buffer, 1, 128)
189  */
190 static int hp_wmi_perform_query(int query, int write, void *buffer,
191                                 int insize, int outsize)
192 {
193         struct bios_return *bios_return;
194         int actual_outsize;
195         union acpi_object *obj;
196         struct bios_args args = {
197                 .signature = 0x55434553,
198                 .command = write ? 0x2 : 0x1,
199                 .commandtype = query,
200                 .datasize = insize,
201                 .data = { 0 },
202         };
203         struct acpi_buffer input = { sizeof(struct bios_args), &args };
204         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
205         u32 rc;
206
207         if (WARN_ON(insize > sizeof(args.data)))
208                 return -EINVAL;
209         memcpy(&args.data[0], buffer, insize);
210
211         wmi_evaluate_method(HPWMI_BIOS_GUID, 0, 0x3, &input, &output);
212
213         obj = output.pointer;
214
215         if (!obj)
216                 return -EINVAL;
217         else if (obj->type != ACPI_TYPE_BUFFER) {
218                 kfree(obj);
219                 return -EINVAL;
220         }
221
222         bios_return = (struct bios_return *)obj->buffer.pointer;
223         rc = bios_return->return_code;
224
225         if (rc) {
226                 if (rc != HPWMI_RET_UNKNOWN_CMDTYPE)
227                         pr_warn("query 0x%x returned error 0x%x\n", query, rc);
228                 kfree(obj);
229                 return rc;
230         }
231
232         if (!outsize) {
233                 /* ignore output data */
234                 kfree(obj);
235                 return 0;
236         }
237
238         actual_outsize = min(outsize, (int)(obj->buffer.length - sizeof(*bios_return)));
239         memcpy(buffer, obj->buffer.pointer + sizeof(*bios_return), actual_outsize);
240         memset(buffer + actual_outsize, 0, outsize - actual_outsize);
241         kfree(obj);
242         return 0;
243 }
244
245 static int hp_wmi_display_state(void)
246 {
247         int state = 0;
248         int ret = hp_wmi_perform_query(HPWMI_DISPLAY_QUERY, 0, &state,
249                                        sizeof(state), sizeof(state));
250         if (ret)
251                 return ret < 0 ? ret : -EINVAL;
252         return state;
253 }
254
255 static int hp_wmi_hddtemp_state(void)
256 {
257         int state = 0;
258         int ret = hp_wmi_perform_query(HPWMI_HDDTEMP_QUERY, 0, &state,
259                                        sizeof(state), sizeof(state));
260         if (ret)
261                 return ret < 0 ? ret : -EINVAL;
262         return state;
263 }
264
265 static int hp_wmi_als_state(void)
266 {
267         int state = 0;
268         int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 0, &state,
269                                        sizeof(state), sizeof(state));
270         if (ret)
271                 return ret < 0 ? ret : -EINVAL;
272         return state;
273 }
274
275 static int hp_wmi_dock_state(void)
276 {
277         int state = 0;
278         int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
279                                        sizeof(state), sizeof(state));
280
281         if (ret)
282                 return ret < 0 ? ret : -EINVAL;
283
284         return state & 0x1;
285 }
286
287 static int hp_wmi_tablet_state(void)
288 {
289         int state = 0;
290         int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
291                                        sizeof(state), sizeof(state));
292         if (ret)
293                 return ret < 0 ? ret : -EINVAL;
294
295         return (state & 0x4) ? 1 : 0;
296 }
297
298 static int __init hp_wmi_bios_2008_later(void)
299 {
300         int state = 0;
301         int ret = hp_wmi_perform_query(HPWMI_FEATURE_QUERY, 0, &state,
302                                        sizeof(state), sizeof(state));
303         if (!ret)
304                 return 1;
305
306         return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
307 }
308
309 static int __init hp_wmi_bios_2009_later(void)
310 {
311         u8 state[128];
312         int ret = hp_wmi_perform_query(HPWMI_FEATURE2_QUERY, 0, &state,
313                                        sizeof(state), sizeof(state));
314         if (!ret)
315                 return 1;
316
317         return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
318 }
319
320 static int __init hp_wmi_enable_hotkeys(void)
321 {
322         int value = 0x6e;
323         int ret = hp_wmi_perform_query(HPWMI_BIOS_QUERY, 1, &value,
324                                        sizeof(value), 0);
325         if (ret)
326                 return ret < 0 ? ret : -EINVAL;
327         return 0;
328 }
329
330 static int hp_wmi_set_block(void *data, bool blocked)
331 {
332         enum hp_wmi_radio r = (enum hp_wmi_radio) data;
333         int query = BIT(r + 8) | ((!blocked) << r);
334         int ret;
335
336         ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1,
337                                    &query, sizeof(query), 0);
338         if (ret)
339                 return ret < 0 ? ret : -EINVAL;
340         return 0;
341 }
342
343 static const struct rfkill_ops hp_wmi_rfkill_ops = {
344         .set_block = hp_wmi_set_block,
345 };
346
347 static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
348 {
349         int wireless = 0;
350         int mask;
351         hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
352                              &wireless, sizeof(wireless),
353                              sizeof(wireless));
354         /* TBD: Pass error */
355
356         mask = 0x200 << (r * 8);
357
358         if (wireless & mask)
359                 return false;
360         else
361                 return true;
362 }
363
364 static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
365 {
366         int wireless = 0;
367         int mask;
368         hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
369                              &wireless, sizeof(wireless),
370                              sizeof(wireless));
371         /* TBD: Pass error */
372
373         mask = 0x800 << (r * 8);
374
375         if (wireless & mask)
376                 return false;
377         else
378                 return true;
379 }
380
381 static int hp_wmi_rfkill2_set_block(void *data, bool blocked)
382 {
383         int rfkill_id = (int)(long)data;
384         char buffer[4] = { 0x01, 0x00, rfkill_id, !blocked };
385
386         if (hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 1,
387                                    buffer, sizeof(buffer), 0))
388                 return -EINVAL;
389         return 0;
390 }
391
392 static const struct rfkill_ops hp_wmi_rfkill2_ops = {
393         .set_block = hp_wmi_rfkill2_set_block,
394 };
395
396 static int hp_wmi_rfkill2_refresh(void)
397 {
398         int err, i;
399         struct bios_rfkill2_state state;
400
401         err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 0, &state,
402                                    0, sizeof(state));
403         if (err)
404                 return err;
405
406         for (i = 0; i < rfkill2_count; i++) {
407                 int num = rfkill2[i].num;
408                 struct bios_rfkill2_device_state *devstate;
409                 devstate = &state.device[num];
410
411                 if (num >= state.count ||
412                     devstate->rfkill_id != rfkill2[i].id) {
413                         pr_warn("power configuration of the wireless devices unexpectedly changed\n");
414                         continue;
415                 }
416
417                 rfkill_set_states(rfkill2[i].rfkill,
418                                   IS_SWBLOCKED(devstate->power),
419                                   IS_HWBLOCKED(devstate->power));
420         }
421
422         return 0;
423 }
424
425 static int hp_wmi_post_code_state(void)
426 {
427         int state = 0;
428         int ret = hp_wmi_perform_query(HPWMI_POSTCODEERROR_QUERY, 0, &state,
429                                        sizeof(state), sizeof(state));
430         if (ret)
431                 return ret < 0 ? ret : -EINVAL;
432         return state;
433 }
434
435 static ssize_t show_display(struct device *dev, struct device_attribute *attr,
436                             char *buf)
437 {
438         int value = hp_wmi_display_state();
439         if (value < 0)
440                 return -EINVAL;
441         return sprintf(buf, "%d\n", value);
442 }
443
444 static ssize_t show_hddtemp(struct device *dev, struct device_attribute *attr,
445                             char *buf)
446 {
447         int value = hp_wmi_hddtemp_state();
448         if (value < 0)
449                 return -EINVAL;
450         return sprintf(buf, "%d\n", value);
451 }
452
453 static ssize_t show_als(struct device *dev, struct device_attribute *attr,
454                         char *buf)
455 {
456         int value = hp_wmi_als_state();
457         if (value < 0)
458                 return -EINVAL;
459         return sprintf(buf, "%d\n", value);
460 }
461
462 static ssize_t show_dock(struct device *dev, struct device_attribute *attr,
463                          char *buf)
464 {
465         int value = hp_wmi_dock_state();
466         if (value < 0)
467                 return -EINVAL;
468         return sprintf(buf, "%d\n", value);
469 }
470
471 static ssize_t show_tablet(struct device *dev, struct device_attribute *attr,
472                          char *buf)
473 {
474         int value = hp_wmi_tablet_state();
475         if (value < 0)
476                 return -EINVAL;
477         return sprintf(buf, "%d\n", value);
478 }
479
480 static ssize_t show_postcode(struct device *dev, struct device_attribute *attr,
481                          char *buf)
482 {
483         /* Get the POST error code of previous boot failure. */
484         int value = hp_wmi_post_code_state();
485         if (value < 0)
486                 return -EINVAL;
487         return sprintf(buf, "0x%x\n", value);
488 }
489
490 static ssize_t set_als(struct device *dev, struct device_attribute *attr,
491                        const char *buf, size_t count)
492 {
493         u32 tmp = simple_strtoul(buf, NULL, 10);
494         int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 1, &tmp,
495                                        sizeof(tmp), sizeof(tmp));
496         if (ret)
497                 return ret < 0 ? ret : -EINVAL;
498
499         return count;
500 }
501
502 static ssize_t set_postcode(struct device *dev, struct device_attribute *attr,
503                        const char *buf, size_t count)
504 {
505         int ret;
506         u32 tmp;
507         long unsigned int tmp2;
508
509         ret = kstrtoul(buf, 10, &tmp2);
510         if (ret || tmp2 != 1)
511                 return -EINVAL;
512
513         /* Clear the POST error code. It is kept until until cleared. */
514         tmp = (u32) tmp2;
515         ret = hp_wmi_perform_query(HPWMI_POSTCODEERROR_QUERY, 1, &tmp,
516                                        sizeof(tmp), sizeof(tmp));
517         if (ret)
518                 return ret < 0 ? ret : -EINVAL;
519
520         return count;
521 }
522
523 static DEVICE_ATTR(display, S_IRUGO, show_display, NULL);
524 static DEVICE_ATTR(hddtemp, S_IRUGO, show_hddtemp, NULL);
525 static DEVICE_ATTR(als, S_IRUGO | S_IWUSR, show_als, set_als);
526 static DEVICE_ATTR(dock, S_IRUGO, show_dock, NULL);
527 static DEVICE_ATTR(tablet, S_IRUGO, show_tablet, NULL);
528 static DEVICE_ATTR(postcode, S_IRUGO | S_IWUSR, show_postcode, set_postcode);
529
530 static void hp_wmi_notify(u32 value, void *context)
531 {
532         struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
533         union acpi_object *obj;
534         u32 event_id, event_data;
535         int key_code = 0, ret;
536         u32 *location;
537         acpi_status status;
538
539         status = wmi_get_event_data(value, &response);
540         if (status != AE_OK) {
541                 pr_info("bad event status 0x%x\n", status);
542                 return;
543         }
544
545         obj = (union acpi_object *)response.pointer;
546
547         if (!obj)
548                 return;
549         if (obj->type != ACPI_TYPE_BUFFER) {
550                 pr_info("Unknown response received %d\n", obj->type);
551                 kfree(obj);
552                 return;
553         }
554
555         /*
556          * Depending on ACPI version the concatenation of id and event data
557          * inside _WED function will result in a 8 or 16 byte buffer.
558          */
559         location = (u32 *)obj->buffer.pointer;
560         if (obj->buffer.length == 8) {
561                 event_id = *location;
562                 event_data = *(location + 1);
563         } else if (obj->buffer.length == 16) {
564                 event_id = *location;
565                 event_data = *(location + 2);
566         } else {
567                 pr_info("Unknown buffer length %d\n", obj->buffer.length);
568                 kfree(obj);
569                 return;
570         }
571         kfree(obj);
572
573         switch (event_id) {
574         case HPWMI_DOCK_EVENT:
575                 if (test_bit(SW_DOCK, hp_wmi_input_dev->swbit))
576                         input_report_switch(hp_wmi_input_dev, SW_DOCK,
577                                             hp_wmi_dock_state());
578                 if (test_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit))
579                         input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
580                                             hp_wmi_tablet_state());
581                 input_sync(hp_wmi_input_dev);
582                 break;
583         case HPWMI_PARK_HDD:
584                 break;
585         case HPWMI_SMART_ADAPTER:
586                 break;
587         case HPWMI_BEZEL_BUTTON:
588                 ret = hp_wmi_perform_query(HPWMI_HOTKEY_QUERY, 0,
589                                            &key_code,
590                                            sizeof(key_code),
591                                            sizeof(key_code));
592                 if (ret)
593                         break;
594
595                 if (!sparse_keymap_report_event(hp_wmi_input_dev,
596                                                 key_code, 1, true))
597                         pr_info("Unknown key code - 0x%x\n", key_code);
598                 break;
599         case HPWMI_WIRELESS:
600                 if (rfkill2_count) {
601                         hp_wmi_rfkill2_refresh();
602                         break;
603                 }
604
605                 if (wifi_rfkill)
606                         rfkill_set_states(wifi_rfkill,
607                                           hp_wmi_get_sw_state(HPWMI_WIFI),
608                                           hp_wmi_get_hw_state(HPWMI_WIFI));
609                 if (bluetooth_rfkill)
610                         rfkill_set_states(bluetooth_rfkill,
611                                           hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
612                                           hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
613                 if (wwan_rfkill)
614                         rfkill_set_states(wwan_rfkill,
615                                           hp_wmi_get_sw_state(HPWMI_WWAN),
616                                           hp_wmi_get_hw_state(HPWMI_WWAN));
617                 break;
618         case HPWMI_CPU_BATTERY_THROTTLE:
619                 pr_info("Unimplemented CPU throttle because of 3 Cell battery event detected\n");
620                 break;
621         case HPWMI_LOCK_SWITCH:
622                 break;
623         case HPWMI_LID_SWITCH:
624                 break;
625         case HPWMI_SCREEN_ROTATION:
626                 break;
627         case HPWMI_COOLSENSE_SYSTEM_MOBILE:
628                 break;
629         case HPWMI_COOLSENSE_SYSTEM_HOT:
630                 break;
631         case HPWMI_PROXIMITY_SENSOR:
632                 break;
633         case HPWMI_BACKLIT_KB_BRIGHTNESS:
634                 break;
635         case HPWMI_PEAKSHIFT_PERIOD:
636                 break;
637         case HPWMI_BATTERY_CHARGE_PERIOD:
638                 break;
639         default:
640                 pr_info("Unknown event_id - %d - 0x%x\n", event_id, event_data);
641                 break;
642         }
643 }
644
645 static int __init hp_wmi_input_setup(void)
646 {
647         acpi_status status;
648         int err;
649         int val;
650
651         hp_wmi_input_dev = input_allocate_device();
652         if (!hp_wmi_input_dev)
653                 return -ENOMEM;
654
655         hp_wmi_input_dev->name = "HP WMI hotkeys";
656         hp_wmi_input_dev->phys = "wmi/input0";
657         hp_wmi_input_dev->id.bustype = BUS_HOST;
658
659         __set_bit(EV_SW, hp_wmi_input_dev->evbit);
660
661         /* Dock */
662         val = hp_wmi_dock_state();
663         if (!(val < 0)) {
664                 __set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
665                 input_report_switch(hp_wmi_input_dev, SW_DOCK, val);
666         }
667
668         /* Tablet mode */
669         val = hp_wmi_tablet_state();
670         if (!(val < 0)) {
671                 __set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);
672                 input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE, val);
673         }
674
675         err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
676         if (err)
677                 goto err_free_dev;
678
679         /* Set initial hardware state */
680         input_sync(hp_wmi_input_dev);
681
682         if (!hp_wmi_bios_2009_later() && hp_wmi_bios_2008_later())
683                 hp_wmi_enable_hotkeys();
684
685         status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
686         if (ACPI_FAILURE(status)) {
687                 err = -EIO;
688                 goto err_free_keymap;
689         }
690
691         err = input_register_device(hp_wmi_input_dev);
692         if (err)
693                 goto err_uninstall_notifier;
694
695         return 0;
696
697  err_uninstall_notifier:
698         wmi_remove_notify_handler(HPWMI_EVENT_GUID);
699  err_free_keymap:
700         sparse_keymap_free(hp_wmi_input_dev);
701  err_free_dev:
702         input_free_device(hp_wmi_input_dev);
703         return err;
704 }
705
706 static void hp_wmi_input_destroy(void)
707 {
708         wmi_remove_notify_handler(HPWMI_EVENT_GUID);
709         sparse_keymap_free(hp_wmi_input_dev);
710         input_unregister_device(hp_wmi_input_dev);
711 }
712
713 static void cleanup_sysfs(struct platform_device *device)
714 {
715         device_remove_file(&device->dev, &dev_attr_display);
716         device_remove_file(&device->dev, &dev_attr_hddtemp);
717         device_remove_file(&device->dev, &dev_attr_als);
718         device_remove_file(&device->dev, &dev_attr_dock);
719         device_remove_file(&device->dev, &dev_attr_tablet);
720         device_remove_file(&device->dev, &dev_attr_postcode);
721 }
722
723 static int __init hp_wmi_rfkill_setup(struct platform_device *device)
724 {
725         int err;
726         int wireless = 0;
727
728         err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, &wireless,
729                                    sizeof(wireless), sizeof(wireless));
730         if (err)
731                 return err;
732
733         err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, &wireless,
734                                    sizeof(wireless), 0);
735         if (err)
736                 return err;
737
738         if (wireless & 0x1) {
739                 wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
740                                            RFKILL_TYPE_WLAN,
741                                            &hp_wmi_rfkill_ops,
742                                            (void *) HPWMI_WIFI);
743                 if (!wifi_rfkill)
744                         return -ENOMEM;
745                 rfkill_init_sw_state(wifi_rfkill,
746                                      hp_wmi_get_sw_state(HPWMI_WIFI));
747                 rfkill_set_hw_state(wifi_rfkill,
748                                     hp_wmi_get_hw_state(HPWMI_WIFI));
749                 err = rfkill_register(wifi_rfkill);
750                 if (err)
751                         goto register_wifi_error;
752         }
753
754         if (wireless & 0x2) {
755                 bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
756                                                 RFKILL_TYPE_BLUETOOTH,
757                                                 &hp_wmi_rfkill_ops,
758                                                 (void *) HPWMI_BLUETOOTH);
759                 if (!bluetooth_rfkill) {
760                         err = -ENOMEM;
761                         goto register_bluetooth_error;
762                 }
763                 rfkill_init_sw_state(bluetooth_rfkill,
764                                      hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
765                 rfkill_set_hw_state(bluetooth_rfkill,
766                                     hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
767                 err = rfkill_register(bluetooth_rfkill);
768                 if (err)
769                         goto register_bluetooth_error;
770         }
771
772         if (wireless & 0x4) {
773                 wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
774                                            RFKILL_TYPE_WWAN,
775                                            &hp_wmi_rfkill_ops,
776                                            (void *) HPWMI_WWAN);
777                 if (!wwan_rfkill) {
778                         err = -ENOMEM;
779                         goto register_wwan_error;
780                 }
781                 rfkill_init_sw_state(wwan_rfkill,
782                                      hp_wmi_get_sw_state(HPWMI_WWAN));
783                 rfkill_set_hw_state(wwan_rfkill,
784                                     hp_wmi_get_hw_state(HPWMI_WWAN));
785                 err = rfkill_register(wwan_rfkill);
786                 if (err)
787                         goto register_wwan_error;
788         }
789
790         return 0;
791
792 register_wwan_error:
793         rfkill_destroy(wwan_rfkill);
794         wwan_rfkill = NULL;
795         if (bluetooth_rfkill)
796                 rfkill_unregister(bluetooth_rfkill);
797 register_bluetooth_error:
798         rfkill_destroy(bluetooth_rfkill);
799         bluetooth_rfkill = NULL;
800         if (wifi_rfkill)
801                 rfkill_unregister(wifi_rfkill);
802 register_wifi_error:
803         rfkill_destroy(wifi_rfkill);
804         wifi_rfkill = NULL;
805         return err;
806 }
807
808 static int __init hp_wmi_rfkill2_setup(struct platform_device *device)
809 {
810         int err, i;
811         struct bios_rfkill2_state state;
812         err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 0, &state,
813                                    0, sizeof(state));
814         if (err)
815                 return err;
816
817         if (state.count > HPWMI_MAX_RFKILL2_DEVICES) {
818                 pr_warn("unable to parse 0x1b query output\n");
819                 return -EINVAL;
820         }
821
822         for (i = 0; i < state.count; i++) {
823                 struct rfkill *rfkill;
824                 enum rfkill_type type;
825                 char *name;
826                 switch (state.device[i].radio_type) {
827                 case HPWMI_WIFI:
828                         type = RFKILL_TYPE_WLAN;
829                         name = "hp-wifi";
830                         break;
831                 case HPWMI_BLUETOOTH:
832                         type = RFKILL_TYPE_BLUETOOTH;
833                         name = "hp-bluetooth";
834                         break;
835                 case HPWMI_WWAN:
836                         type = RFKILL_TYPE_WWAN;
837                         name = "hp-wwan";
838                         break;
839                 case HPWMI_GPS:
840                         type = RFKILL_TYPE_GPS;
841                         name = "hp-gps";
842                         break;
843                 default:
844                         pr_warn("unknown device type 0x%x\n",
845                                 state.device[i].radio_type);
846                         continue;
847                 }
848
849                 if (!state.device[i].vendor_id) {
850                         pr_warn("zero device %d while %d reported\n",
851                                 i, state.count);
852                         continue;
853                 }
854
855                 rfkill = rfkill_alloc(name, &device->dev, type,
856                                       &hp_wmi_rfkill2_ops, (void *)(long)i);
857                 if (!rfkill) {
858                         err = -ENOMEM;
859                         goto fail;
860                 }
861
862                 rfkill2[rfkill2_count].id = state.device[i].rfkill_id;
863                 rfkill2[rfkill2_count].num = i;
864                 rfkill2[rfkill2_count].rfkill = rfkill;
865
866                 rfkill_init_sw_state(rfkill,
867                                      IS_SWBLOCKED(state.device[i].power));
868                 rfkill_set_hw_state(rfkill,
869                                     IS_HWBLOCKED(state.device[i].power));
870
871                 if (!(state.device[i].power & HPWMI_POWER_BIOS))
872                         pr_info("device %s blocked by BIOS\n", name);
873
874                 err = rfkill_register(rfkill);
875                 if (err) {
876                         rfkill_destroy(rfkill);
877                         goto fail;
878                 }
879
880                 rfkill2_count++;
881         }
882
883         return 0;
884 fail:
885         for (; rfkill2_count > 0; rfkill2_count--) {
886                 rfkill_unregister(rfkill2[rfkill2_count - 1].rfkill);
887                 rfkill_destroy(rfkill2[rfkill2_count - 1].rfkill);
888         }
889         return err;
890 }
891
892 static int __init hp_wmi_bios_setup(struct platform_device *device)
893 {
894         int err;
895
896         /* clear detected rfkill devices */
897         wifi_rfkill = NULL;
898         bluetooth_rfkill = NULL;
899         wwan_rfkill = NULL;
900         rfkill2_count = 0;
901
902         if (hp_wmi_rfkill_setup(device))
903                 hp_wmi_rfkill2_setup(device);
904
905         err = device_create_file(&device->dev, &dev_attr_display);
906         if (err)
907                 goto add_sysfs_error;
908         err = device_create_file(&device->dev, &dev_attr_hddtemp);
909         if (err)
910                 goto add_sysfs_error;
911         err = device_create_file(&device->dev, &dev_attr_als);
912         if (err)
913                 goto add_sysfs_error;
914         err = device_create_file(&device->dev, &dev_attr_dock);
915         if (err)
916                 goto add_sysfs_error;
917         err = device_create_file(&device->dev, &dev_attr_tablet);
918         if (err)
919                 goto add_sysfs_error;
920         err = device_create_file(&device->dev, &dev_attr_postcode);
921         if (err)
922                 goto add_sysfs_error;
923         return 0;
924
925 add_sysfs_error:
926         cleanup_sysfs(device);
927         return err;
928 }
929
930 static int __exit hp_wmi_bios_remove(struct platform_device *device)
931 {
932         int i;
933         cleanup_sysfs(device);
934
935         for (i = 0; i < rfkill2_count; i++) {
936                 rfkill_unregister(rfkill2[i].rfkill);
937                 rfkill_destroy(rfkill2[i].rfkill);
938         }
939
940         if (wifi_rfkill) {
941                 rfkill_unregister(wifi_rfkill);
942                 rfkill_destroy(wifi_rfkill);
943         }
944         if (bluetooth_rfkill) {
945                 rfkill_unregister(bluetooth_rfkill);
946                 rfkill_destroy(bluetooth_rfkill);
947         }
948         if (wwan_rfkill) {
949                 rfkill_unregister(wwan_rfkill);
950                 rfkill_destroy(wwan_rfkill);
951         }
952
953         return 0;
954 }
955
956 static int hp_wmi_resume_handler(struct device *device)
957 {
958         /*
959          * Hardware state may have changed while suspended, so trigger
960          * input events for the current state. As this is a switch,
961          * the input layer will only actually pass it on if the state
962          * changed.
963          */
964         if (hp_wmi_input_dev) {
965                 if (test_bit(SW_DOCK, hp_wmi_input_dev->swbit))
966                         input_report_switch(hp_wmi_input_dev, SW_DOCK,
967                                             hp_wmi_dock_state());
968                 if (test_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit))
969                         input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
970                                             hp_wmi_tablet_state());
971                 input_sync(hp_wmi_input_dev);
972         }
973
974         if (rfkill2_count)
975                 hp_wmi_rfkill2_refresh();
976
977         if (wifi_rfkill)
978                 rfkill_set_states(wifi_rfkill,
979                                   hp_wmi_get_sw_state(HPWMI_WIFI),
980                                   hp_wmi_get_hw_state(HPWMI_WIFI));
981         if (bluetooth_rfkill)
982                 rfkill_set_states(bluetooth_rfkill,
983                                   hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
984                                   hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
985         if (wwan_rfkill)
986                 rfkill_set_states(wwan_rfkill,
987                                   hp_wmi_get_sw_state(HPWMI_WWAN),
988                                   hp_wmi_get_hw_state(HPWMI_WWAN));
989
990         return 0;
991 }
992
993 static const struct dev_pm_ops hp_wmi_pm_ops = {
994         .resume  = hp_wmi_resume_handler,
995         .restore  = hp_wmi_resume_handler,
996 };
997
998 static struct platform_driver hp_wmi_driver = {
999         .driver = {
1000                 .name = "hp-wmi",
1001                 .pm = &hp_wmi_pm_ops,
1002         },
1003         .remove = __exit_p(hp_wmi_bios_remove),
1004 };
1005
1006 static int __init hp_wmi_init(void)
1007 {
1008         int err;
1009         int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
1010         int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
1011
1012         if (!bios_capable && !event_capable)
1013                 return -ENODEV;
1014
1015         if (event_capable) {
1016                 err = hp_wmi_input_setup();
1017                 if (err)
1018                         return err;
1019         }
1020
1021         if (bios_capable) {
1022                 hp_wmi_platform_dev =
1023                         platform_device_register_simple("hp-wmi", -1, NULL, 0);
1024                 if (IS_ERR(hp_wmi_platform_dev)) {
1025                         err = PTR_ERR(hp_wmi_platform_dev);
1026                         goto err_destroy_input;
1027                 }
1028
1029                 err = platform_driver_probe(&hp_wmi_driver, hp_wmi_bios_setup);
1030                 if (err)
1031                         goto err_unregister_device;
1032         }
1033
1034         return 0;
1035
1036 err_unregister_device:
1037         platform_device_unregister(hp_wmi_platform_dev);
1038 err_destroy_input:
1039         if (event_capable)
1040                 hp_wmi_input_destroy();
1041
1042         return err;
1043 }
1044 module_init(hp_wmi_init);
1045
1046 static void __exit hp_wmi_exit(void)
1047 {
1048         if (wmi_has_guid(HPWMI_EVENT_GUID))
1049                 hp_wmi_input_destroy();
1050
1051         if (hp_wmi_platform_dev) {
1052                 platform_device_unregister(hp_wmi_platform_dev);
1053                 platform_driver_unregister(&hp_wmi_driver);
1054         }
1055 }
1056 module_exit(hp_wmi_exit);