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