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