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