x86: Check tsc available/disabled in the delayed init function
[cascardo/linux.git] / drivers / platform / x86 / hp-wmi.c
1 /*
2  * HP WMI hotkeys
3  *
4  * Copyright (C) 2008 Red Hat <mjg@redhat.com>
5  *
6  * Portions based on wistron_btns.c:
7  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
8  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
9  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
10  *
11  *  This program is free software; you can redistribute it and/or modify
12  *  it under the terms of the GNU General Public License as published by
13  *  the Free Software Foundation; either version 2 of the License, or
14  *  (at your option) any later version.
15  *
16  *  This program is distributed in the hope that it will be useful,
17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  *  GNU General Public License for more details.
20  *
21  *  You should have received a copy of the GNU General Public License
22  *  along with this program; if not, write to the Free Software
23  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
24  */
25
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/slab.h>
30 #include <linux/types.h>
31 #include <linux/input.h>
32 #include <linux/input/sparse-keymap.h>
33 #include <linux/platform_device.h>
34 #include <linux/acpi.h>
35 #include <linux/rfkill.h>
36 #include <linux/string.h>
37
38 MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
39 MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
40 MODULE_LICENSE("GPL");
41
42 MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
43 MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");
44
45 #define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
46 #define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"
47
48 #define HPWMI_DISPLAY_QUERY 0x1
49 #define HPWMI_HDDTEMP_QUERY 0x2
50 #define HPWMI_ALS_QUERY 0x3
51 #define HPWMI_HARDWARE_QUERY 0x4
52 #define HPWMI_WIRELESS_QUERY 0x5
53 #define HPWMI_HOTKEY_QUERY 0xc
54
55 #define PREFIX "HP WMI: "
56 #define UNIMP "Unimplemented "
57
58 enum hp_wmi_radio {
59         HPWMI_WIFI = 0,
60         HPWMI_BLUETOOTH = 1,
61         HPWMI_WWAN = 2,
62 };
63
64 enum hp_wmi_event_ids {
65         HPWMI_DOCK_EVENT = 1,
66         HPWMI_PARK_HDD = 2,
67         HPWMI_SMART_ADAPTER = 3,
68         HPWMI_BEZEL_BUTTON = 4,
69         HPWMI_WIRELESS = 5,
70         HPWMI_CPU_BATTERY_THROTTLE = 6,
71         HPWMI_LOCK_SWITCH = 7,
72 };
73
74 static int __devinit hp_wmi_bios_setup(struct platform_device *device);
75 static int __exit hp_wmi_bios_remove(struct platform_device *device);
76 static int hp_wmi_resume_handler(struct device *device);
77
78 struct bios_args {
79         u32 signature;
80         u32 command;
81         u32 commandtype;
82         u32 datasize;
83         u32 data;
84 };
85
86 struct bios_return {
87         u32 sigpass;
88         u32 return_code;
89         u32 value;
90 };
91
92 static const struct key_entry hp_wmi_keymap[] = {
93         { KE_KEY, 0x02,   { KEY_BRIGHTNESSUP } },
94         { KE_KEY, 0x03,   { KEY_BRIGHTNESSDOWN } },
95         { KE_KEY, 0x20e6, { KEY_PROG1 } },
96         { KE_KEY, 0x20e8, { KEY_MEDIA } },
97         { KE_KEY, 0x2142, { KEY_MEDIA } },
98         { KE_KEY, 0x213b, { KEY_INFO } },
99         { KE_KEY, 0x2169, { KEY_DIRECTION } },
100         { KE_KEY, 0x231b, { KEY_HELP } },
101         { KE_END, 0 }
102 };
103
104 static struct input_dev *hp_wmi_input_dev;
105 static struct platform_device *hp_wmi_platform_dev;
106
107 static struct rfkill *wifi_rfkill;
108 static struct rfkill *bluetooth_rfkill;
109 static struct rfkill *wwan_rfkill;
110
111 static const struct dev_pm_ops hp_wmi_pm_ops = {
112         .resume  = hp_wmi_resume_handler,
113         .restore  = hp_wmi_resume_handler,
114 };
115
116 static struct platform_driver hp_wmi_driver = {
117         .driver = {
118                 .name = "hp-wmi",
119                 .owner = THIS_MODULE,
120                 .pm = &hp_wmi_pm_ops,
121         },
122         .probe = hp_wmi_bios_setup,
123         .remove = hp_wmi_bios_remove,
124 };
125
126 /*
127  * hp_wmi_perform_query
128  *
129  * query:       The commandtype -> What should be queried
130  * write:       The command -> 0 read, 1 write, 3 ODM specific
131  * buffer:      Buffer used as input and/or output
132  * buffersize:  Size of buffer
133  *
134  * returns zero on success
135  *         an HP WMI query specific error code (which is positive)
136  *         -EINVAL if the query was not successful at all
137  *         -EINVAL if the output buffer size exceeds buffersize
138  *
139  * Note: The buffersize must at least be the maximum of the input and output
140  *       size. E.g. Battery info query (0x7) is defined to have 1 byte input
141  *       and 128 byte output. The caller would do:
142  *       buffer = kzalloc(128, GFP_KERNEL);
143  *       ret = hp_wmi_perform_query(0x7, 0, buffer, 128)
144  */
145 static int hp_wmi_perform_query(int query, int write, u32 *buffer,
146                                 int buffersize)
147 {
148         struct bios_return bios_return;
149         acpi_status status;
150         union acpi_object *obj;
151         struct bios_args args = {
152                 .signature = 0x55434553,
153                 .command = write ? 0x2 : 0x1,
154                 .commandtype = query,
155                 .datasize = buffersize,
156                 .data = *buffer,
157         };
158         struct acpi_buffer input = { sizeof(struct bios_args), &args };
159         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
160
161         status = wmi_evaluate_method(HPWMI_BIOS_GUID, 0, 0x3, &input, &output);
162
163         obj = output.pointer;
164
165         if (!obj)
166                 return -EINVAL;
167         else if (obj->type != ACPI_TYPE_BUFFER) {
168                 kfree(obj);
169                 return -EINVAL;
170         }
171
172         bios_return = *((struct bios_return *)obj->buffer.pointer);
173
174         memcpy(buffer, &bios_return.value, sizeof(bios_return.value));
175         return 0;
176 }
177
178 static int hp_wmi_display_state(void)
179 {
180         int state = 0;
181         int ret = hp_wmi_perform_query(HPWMI_DISPLAY_QUERY, 0, &state,
182                                        sizeof(state));
183         if (ret)
184                 return -EINVAL;
185         return state;
186 }
187
188 static int hp_wmi_hddtemp_state(void)
189 {
190         int state = 0;
191         int ret = hp_wmi_perform_query(HPWMI_HDDTEMP_QUERY, 0, &state,
192                                        sizeof(state));
193         if (ret)
194                 return -EINVAL;
195         return state;
196 }
197
198 static int hp_wmi_als_state(void)
199 {
200         int state = 0;
201         int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 0, &state,
202                                        sizeof(state));
203         if (ret)
204                 return -EINVAL;
205         return state;
206 }
207
208 static int hp_wmi_dock_state(void)
209 {
210         int state = 0;
211         int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
212                                        sizeof(state));
213
214         if (ret)
215                 return -EINVAL;
216
217         return state & 0x1;
218 }
219
220 static int hp_wmi_tablet_state(void)
221 {
222         int state = 0;
223         int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
224                                        sizeof(state));
225         if (ret)
226                 return ret;
227
228         return (state & 0x4) ? 1 : 0;
229 }
230
231 static int hp_wmi_set_block(void *data, bool blocked)
232 {
233         enum hp_wmi_radio r = (enum hp_wmi_radio) data;
234         int query = BIT(r + 8) | ((!blocked) << r);
235         int ret;
236
237         ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1,
238                                    &query, sizeof(query));
239         if (ret)
240                 return -EINVAL;
241         return 0;
242 }
243
244 static const struct rfkill_ops hp_wmi_rfkill_ops = {
245         .set_block = hp_wmi_set_block,
246 };
247
248 static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
249 {
250         int wireless = 0;
251         int mask;
252         hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
253                              &wireless, sizeof(wireless));
254         /* TBD: Pass error */
255
256         mask = 0x200 << (r * 8);
257
258         if (wireless & mask)
259                 return false;
260         else
261                 return true;
262 }
263
264 static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
265 {
266         int wireless = 0;
267         int mask;
268         hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
269                              &wireless, sizeof(wireless));
270         /* TBD: Pass error */
271
272         mask = 0x800 << (r * 8);
273
274         if (wireless & mask)
275                 return false;
276         else
277                 return true;
278 }
279
280 static ssize_t show_display(struct device *dev, struct device_attribute *attr,
281                             char *buf)
282 {
283         int value = hp_wmi_display_state();
284         if (value < 0)
285                 return -EINVAL;
286         return sprintf(buf, "%d\n", value);
287 }
288
289 static ssize_t show_hddtemp(struct device *dev, struct device_attribute *attr,
290                             char *buf)
291 {
292         int value = hp_wmi_hddtemp_state();
293         if (value < 0)
294                 return -EINVAL;
295         return sprintf(buf, "%d\n", value);
296 }
297
298 static ssize_t show_als(struct device *dev, struct device_attribute *attr,
299                         char *buf)
300 {
301         int value = hp_wmi_als_state();
302         if (value < 0)
303                 return -EINVAL;
304         return sprintf(buf, "%d\n", value);
305 }
306
307 static ssize_t show_dock(struct device *dev, struct device_attribute *attr,
308                          char *buf)
309 {
310         int value = hp_wmi_dock_state();
311         if (value < 0)
312                 return -EINVAL;
313         return sprintf(buf, "%d\n", value);
314 }
315
316 static ssize_t show_tablet(struct device *dev, struct device_attribute *attr,
317                          char *buf)
318 {
319         int value = hp_wmi_tablet_state();
320         if (value < 0)
321                 return -EINVAL;
322         return sprintf(buf, "%d\n", value);
323 }
324
325 static ssize_t set_als(struct device *dev, struct device_attribute *attr,
326                        const char *buf, size_t count)
327 {
328         u32 tmp = simple_strtoul(buf, NULL, 10);
329         int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 1, &tmp,
330                                        sizeof(tmp));
331         if (ret)
332                 return -EINVAL;
333
334         return count;
335 }
336
337 static DEVICE_ATTR(display, S_IRUGO, show_display, NULL);
338 static DEVICE_ATTR(hddtemp, S_IRUGO, show_hddtemp, NULL);
339 static DEVICE_ATTR(als, S_IRUGO | S_IWUSR, show_als, set_als);
340 static DEVICE_ATTR(dock, S_IRUGO, show_dock, NULL);
341 static DEVICE_ATTR(tablet, S_IRUGO, show_tablet, NULL);
342
343 static void hp_wmi_notify(u32 value, void *context)
344 {
345         struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
346         union acpi_object *obj;
347         u32 event_id, event_data;
348         int key_code = 0, ret;
349         u32 *location;
350         acpi_status status;
351
352         status = wmi_get_event_data(value, &response);
353         if (status != AE_OK) {
354                 printk(KERN_INFO PREFIX "bad event status 0x%x\n", status);
355                 return;
356         }
357
358         obj = (union acpi_object *)response.pointer;
359
360         if (!obj)
361                 return;
362         if (obj->type != ACPI_TYPE_BUFFER) {
363                 printk(KERN_INFO "hp-wmi: Unknown response received %d\n",
364                        obj->type);
365                 kfree(obj);
366                 return;
367         }
368
369         /*
370          * Depending on ACPI version the concatenation of id and event data
371          * inside _WED function will result in a 8 or 16 byte buffer.
372          */
373         location = (u32 *)obj->buffer.pointer;
374         if (obj->buffer.length == 8) {
375                 event_id = *location;
376                 event_data = *(location + 1);
377         } else if (obj->buffer.length == 16) {
378                 event_id = *location;
379                 event_data = *(location + 2);
380         } else {
381                 printk(KERN_INFO "hp-wmi: Unknown buffer length %d\n",
382                        obj->buffer.length);
383                 kfree(obj);
384                 return;
385         }
386         kfree(obj);
387
388         switch (event_id) {
389         case HPWMI_DOCK_EVENT:
390                 input_report_switch(hp_wmi_input_dev, SW_DOCK,
391                                     hp_wmi_dock_state());
392                 input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
393                                     hp_wmi_tablet_state());
394                 input_sync(hp_wmi_input_dev);
395                 break;
396         case HPWMI_PARK_HDD:
397                 break;
398         case HPWMI_SMART_ADAPTER:
399                 break;
400         case HPWMI_BEZEL_BUTTON:
401                 ret = hp_wmi_perform_query(HPWMI_HOTKEY_QUERY, 0,
402                                            &key_code,
403                                            sizeof(key_code));
404                 if (ret)
405                         break;
406
407                 if (!sparse_keymap_report_event(hp_wmi_input_dev,
408                                                 key_code, 1, true))
409                         printk(KERN_INFO PREFIX "Unknown key code - 0x%x\n",
410                                key_code);
411                 break;
412         case HPWMI_WIRELESS:
413                 if (wifi_rfkill)
414                         rfkill_set_states(wifi_rfkill,
415                                           hp_wmi_get_sw_state(HPWMI_WIFI),
416                                           hp_wmi_get_hw_state(HPWMI_WIFI));
417                 if (bluetooth_rfkill)
418                         rfkill_set_states(bluetooth_rfkill,
419                                           hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
420                                           hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
421                 if (wwan_rfkill)
422                         rfkill_set_states(wwan_rfkill,
423                                           hp_wmi_get_sw_state(HPWMI_WWAN),
424                                           hp_wmi_get_hw_state(HPWMI_WWAN));
425                 break;
426         case HPWMI_CPU_BATTERY_THROTTLE:
427                 printk(KERN_INFO PREFIX UNIMP "CPU throttle because of 3 Cell"
428                        " battery event detected\n");
429                 break;
430         case HPWMI_LOCK_SWITCH:
431                 break;
432         default:
433                 printk(KERN_INFO PREFIX "Unknown event_id - %d - 0x%x\n",
434                        event_id, event_data);
435                 break;
436         }
437 }
438
439 static int __init hp_wmi_input_setup(void)
440 {
441         acpi_status status;
442         int err;
443
444         hp_wmi_input_dev = input_allocate_device();
445         if (!hp_wmi_input_dev)
446                 return -ENOMEM;
447
448         hp_wmi_input_dev->name = "HP WMI hotkeys";
449         hp_wmi_input_dev->phys = "wmi/input0";
450         hp_wmi_input_dev->id.bustype = BUS_HOST;
451
452         __set_bit(EV_SW, hp_wmi_input_dev->evbit);
453         __set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
454         __set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);
455
456         err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
457         if (err)
458                 goto err_free_dev;
459
460         /* Set initial hardware state */
461         input_report_switch(hp_wmi_input_dev, SW_DOCK, hp_wmi_dock_state());
462         input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
463                             hp_wmi_tablet_state());
464         input_sync(hp_wmi_input_dev);
465
466         status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
467         if (ACPI_FAILURE(status)) {
468                 err = -EIO;
469                 goto err_free_keymap;
470         }
471
472         err = input_register_device(hp_wmi_input_dev);
473         if (err)
474                 goto err_uninstall_notifier;
475
476         return 0;
477
478  err_uninstall_notifier:
479         wmi_remove_notify_handler(HPWMI_EVENT_GUID);
480  err_free_keymap:
481         sparse_keymap_free(hp_wmi_input_dev);
482  err_free_dev:
483         input_free_device(hp_wmi_input_dev);
484         return err;
485 }
486
487 static void hp_wmi_input_destroy(void)
488 {
489         wmi_remove_notify_handler(HPWMI_EVENT_GUID);
490         sparse_keymap_free(hp_wmi_input_dev);
491         input_unregister_device(hp_wmi_input_dev);
492 }
493
494 static void cleanup_sysfs(struct platform_device *device)
495 {
496         device_remove_file(&device->dev, &dev_attr_display);
497         device_remove_file(&device->dev, &dev_attr_hddtemp);
498         device_remove_file(&device->dev, &dev_attr_als);
499         device_remove_file(&device->dev, &dev_attr_dock);
500         device_remove_file(&device->dev, &dev_attr_tablet);
501 }
502
503 static int __devinit hp_wmi_bios_setup(struct platform_device *device)
504 {
505         int err;
506         int wireless = 0;
507
508         err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, &wireless,
509                                    sizeof(wireless));
510         if (err)
511                 return err;
512
513         err = device_create_file(&device->dev, &dev_attr_display);
514         if (err)
515                 goto add_sysfs_error;
516         err = device_create_file(&device->dev, &dev_attr_hddtemp);
517         if (err)
518                 goto add_sysfs_error;
519         err = device_create_file(&device->dev, &dev_attr_als);
520         if (err)
521                 goto add_sysfs_error;
522         err = device_create_file(&device->dev, &dev_attr_dock);
523         if (err)
524                 goto add_sysfs_error;
525         err = device_create_file(&device->dev, &dev_attr_tablet);
526         if (err)
527                 goto add_sysfs_error;
528
529         if (wireless & 0x1) {
530                 wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
531                                            RFKILL_TYPE_WLAN,
532                                            &hp_wmi_rfkill_ops,
533                                            (void *) HPWMI_WIFI);
534                 rfkill_init_sw_state(wifi_rfkill,
535                                      hp_wmi_get_sw_state(HPWMI_WIFI));
536                 rfkill_set_hw_state(wifi_rfkill,
537                                     hp_wmi_get_hw_state(HPWMI_WIFI));
538                 err = rfkill_register(wifi_rfkill);
539                 if (err)
540                         goto register_wifi_error;
541         }
542
543         if (wireless & 0x2) {
544                 bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
545                                                 RFKILL_TYPE_BLUETOOTH,
546                                                 &hp_wmi_rfkill_ops,
547                                                 (void *) HPWMI_BLUETOOTH);
548                 rfkill_init_sw_state(bluetooth_rfkill,
549                                      hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
550                 rfkill_set_hw_state(bluetooth_rfkill,
551                                     hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
552                 err = rfkill_register(bluetooth_rfkill);
553                 if (err)
554                         goto register_bluetooth_error;
555         }
556
557         if (wireless & 0x4) {
558                 wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
559                                            RFKILL_TYPE_WWAN,
560                                            &hp_wmi_rfkill_ops,
561                                            (void *) HPWMI_WWAN);
562                 rfkill_init_sw_state(wwan_rfkill,
563                                      hp_wmi_get_sw_state(HPWMI_WWAN));
564                 rfkill_set_hw_state(wwan_rfkill,
565                                     hp_wmi_get_hw_state(HPWMI_WWAN));
566                 err = rfkill_register(wwan_rfkill);
567                 if (err)
568                         goto register_wwan_err;
569         }
570
571         return 0;
572 register_wwan_err:
573         rfkill_destroy(wwan_rfkill);
574         if (bluetooth_rfkill)
575                 rfkill_unregister(bluetooth_rfkill);
576 register_bluetooth_error:
577         rfkill_destroy(bluetooth_rfkill);
578         if (wifi_rfkill)
579                 rfkill_unregister(wifi_rfkill);
580 register_wifi_error:
581         rfkill_destroy(wifi_rfkill);
582 add_sysfs_error:
583         cleanup_sysfs(device);
584         return err;
585 }
586
587 static int __exit hp_wmi_bios_remove(struct platform_device *device)
588 {
589         cleanup_sysfs(device);
590
591         if (wifi_rfkill) {
592                 rfkill_unregister(wifi_rfkill);
593                 rfkill_destroy(wifi_rfkill);
594         }
595         if (bluetooth_rfkill) {
596                 rfkill_unregister(bluetooth_rfkill);
597                 rfkill_destroy(bluetooth_rfkill);
598         }
599         if (wwan_rfkill) {
600                 rfkill_unregister(wwan_rfkill);
601                 rfkill_destroy(wwan_rfkill);
602         }
603
604         return 0;
605 }
606
607 static int hp_wmi_resume_handler(struct device *device)
608 {
609         /*
610          * Hardware state may have changed while suspended, so trigger
611          * input events for the current state. As this is a switch,
612          * the input layer will only actually pass it on if the state
613          * changed.
614          */
615         if (hp_wmi_input_dev) {
616                 input_report_switch(hp_wmi_input_dev, SW_DOCK,
617                                     hp_wmi_dock_state());
618                 input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
619                                     hp_wmi_tablet_state());
620                 input_sync(hp_wmi_input_dev);
621         }
622
623         if (wifi_rfkill)
624                 rfkill_set_states(wifi_rfkill,
625                                   hp_wmi_get_sw_state(HPWMI_WIFI),
626                                   hp_wmi_get_hw_state(HPWMI_WIFI));
627         if (bluetooth_rfkill)
628                 rfkill_set_states(bluetooth_rfkill,
629                                   hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
630                                   hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
631         if (wwan_rfkill)
632                 rfkill_set_states(wwan_rfkill,
633                                   hp_wmi_get_sw_state(HPWMI_WWAN),
634                                   hp_wmi_get_hw_state(HPWMI_WWAN));
635
636         return 0;
637 }
638
639 static int __init hp_wmi_init(void)
640 {
641         int err;
642         int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
643         int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
644
645         if (event_capable) {
646                 err = hp_wmi_input_setup();
647                 if (err)
648                         return err;
649         }
650
651         if (bios_capable) {
652                 err = platform_driver_register(&hp_wmi_driver);
653                 if (err)
654                         goto err_driver_reg;
655                 hp_wmi_platform_dev = platform_device_alloc("hp-wmi", -1);
656                 if (!hp_wmi_platform_dev) {
657                         err = -ENOMEM;
658                         goto err_device_alloc;
659                 }
660                 err = platform_device_add(hp_wmi_platform_dev);
661                 if (err)
662                         goto err_device_add;
663         }
664
665         if (!bios_capable && !event_capable)
666                 return -ENODEV;
667
668         return 0;
669
670 err_device_add:
671         platform_device_put(hp_wmi_platform_dev);
672 err_device_alloc:
673         platform_driver_unregister(&hp_wmi_driver);
674 err_driver_reg:
675         if (event_capable)
676                 hp_wmi_input_destroy();
677
678         return err;
679 }
680
681 static void __exit hp_wmi_exit(void)
682 {
683         if (wmi_has_guid(HPWMI_EVENT_GUID))
684                 hp_wmi_input_destroy();
685
686         if (hp_wmi_platform_dev) {
687                 platform_device_unregister(hp_wmi_platform_dev);
688                 platform_driver_unregister(&hp_wmi_driver);
689         }
690 }
691
692 module_init(hp_wmi_init);
693 module_exit(hp_wmi_exit);