Version:  2.0.40 2.2.26 2.4.37 2.6.39 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15

Linux/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_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);
1048 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us