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