backlight: msi-laptop, msi-wmi: fix incomplete registration failure handling
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / platform / x86 / msi-wmi.c
blob367caaae2f3cfcc388238e3459b84835b1ca46c2
1 /*
2 * MSI WMI hotkeys
4 * Copyright (C) 2009 Novell <trenn@suse.de>
6 * Most stuff taken over from hp-wmi
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
24 #include <linux/kernel.h>
25 #include <linux/input.h>
26 #include <linux/input/sparse-keymap.h>
27 #include <linux/acpi.h>
28 #include <linux/backlight.h>
30 MODULE_AUTHOR("Thomas Renninger <trenn@suse.de>");
31 MODULE_DESCRIPTION("MSI laptop WMI hotkeys driver");
32 MODULE_LICENSE("GPL");
34 MODULE_ALIAS("wmi:551A1F84-FBDD-4125-91DB-3EA8F44F1D45");
35 MODULE_ALIAS("wmi:B6F3EEF2-3D2F-49DC-9DE3-85BCE18C62F2");
37 #define DRV_NAME "msi-wmi"
38 #define DRV_PFX DRV_NAME ": "
40 #define MSIWMI_BIOS_GUID "551A1F84-FBDD-4125-91DB-3EA8F44F1D45"
41 #define MSIWMI_EVENT_GUID "B6F3EEF2-3D2F-49DC-9DE3-85BCE18C62F2"
43 #define dprintk(msg...) pr_debug(DRV_PFX msg)
45 #define KEYCODE_BASE 0xD0
46 #define MSI_WMI_BRIGHTNESSUP KEYCODE_BASE
47 #define MSI_WMI_BRIGHTNESSDOWN (KEYCODE_BASE + 1)
48 #define MSI_WMI_VOLUMEUP (KEYCODE_BASE + 2)
49 #define MSI_WMI_VOLUMEDOWN (KEYCODE_BASE + 3)
50 static struct key_entry msi_wmi_keymap[] = {
51 { KE_KEY, MSI_WMI_BRIGHTNESSUP, {KEY_BRIGHTNESSUP} },
52 { KE_KEY, MSI_WMI_BRIGHTNESSDOWN, {KEY_BRIGHTNESSDOWN} },
53 { KE_KEY, MSI_WMI_VOLUMEUP, {KEY_VOLUMEUP} },
54 { KE_KEY, MSI_WMI_VOLUMEDOWN, {KEY_VOLUMEDOWN} },
55 { KE_END, 0}
57 static ktime_t last_pressed[ARRAY_SIZE(msi_wmi_keymap) - 1];
59 struct backlight_device *backlight;
61 static int backlight_map[] = { 0x00, 0x33, 0x66, 0x99, 0xCC, 0xFF };
63 static struct input_dev *msi_wmi_input_dev;
65 static int msi_wmi_query_block(int instance, int *ret)
67 acpi_status status;
68 union acpi_object *obj;
70 struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
72 status = wmi_query_block(MSIWMI_BIOS_GUID, instance, &output);
74 obj = output.pointer;
76 if (!obj || obj->type != ACPI_TYPE_INTEGER) {
77 if (obj) {
78 printk(KERN_ERR DRV_PFX "query block returned object "
79 "type: %d - buffer length:%d\n", obj->type,
80 obj->type == ACPI_TYPE_BUFFER ?
81 obj->buffer.length : 0);
83 kfree(obj);
84 return -EINVAL;
86 *ret = obj->integer.value;
87 kfree(obj);
88 return 0;
91 static int msi_wmi_set_block(int instance, int value)
93 acpi_status status;
95 struct acpi_buffer input = { sizeof(int), &value };
97 dprintk("Going to set block of instance: %d - value: %d\n",
98 instance, value);
100 status = wmi_set_block(MSIWMI_BIOS_GUID, instance, &input);
102 return ACPI_SUCCESS(status) ? 0 : 1;
105 static int bl_get(struct backlight_device *bd)
107 int level, err, ret;
109 /* Instance 1 is "get backlight", cmp with DSDT */
110 err = msi_wmi_query_block(1, &ret);
111 if (err) {
112 printk(KERN_ERR DRV_PFX "Could not query backlight: %d\n", err);
113 return -EINVAL;
115 dprintk("Get: Query block returned: %d\n", ret);
116 for (level = 0; level < ARRAY_SIZE(backlight_map); level++) {
117 if (backlight_map[level] == ret) {
118 dprintk("Current backlight level: 0x%X - index: %d\n",
119 backlight_map[level], level);
120 break;
123 if (level == ARRAY_SIZE(backlight_map)) {
124 printk(KERN_ERR DRV_PFX "get: Invalid brightness value: 0x%X\n",
125 ret);
126 return -EINVAL;
128 return level;
131 static int bl_set_status(struct backlight_device *bd)
133 int bright = bd->props.brightness;
134 if (bright >= ARRAY_SIZE(backlight_map) || bright < 0)
135 return -EINVAL;
137 /* Instance 0 is "set backlight" */
138 return msi_wmi_set_block(0, backlight_map[bright]);
141 static const struct backlight_ops msi_backlight_ops = {
142 .get_brightness = bl_get,
143 .update_status = bl_set_status,
146 static void msi_wmi_notify(u32 value, void *context)
148 struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
149 static struct key_entry *key;
150 union acpi_object *obj;
151 ktime_t cur;
152 acpi_status status;
154 status = wmi_get_event_data(value, &response);
155 if (status != AE_OK) {
156 printk(KERN_INFO DRV_PFX "bad event status 0x%x\n", status);
157 return;
160 obj = (union acpi_object *)response.pointer;
162 if (obj && obj->type == ACPI_TYPE_INTEGER) {
163 int eventcode = obj->integer.value;
164 dprintk("Eventcode: 0x%x\n", eventcode);
165 key = sparse_keymap_entry_from_scancode(msi_wmi_input_dev,
166 eventcode);
167 if (key) {
168 ktime_t diff;
169 cur = ktime_get_real();
170 diff = ktime_sub(cur, last_pressed[key->code -
171 KEYCODE_BASE]);
172 /* Ignore event if the same event happened in a 50 ms
173 timeframe -> Key press may result in 10-20 GPEs */
174 if (ktime_to_us(diff) < 1000 * 50) {
175 dprintk("Suppressed key event 0x%X - "
176 "Last press was %lld us ago\n",
177 key->code, ktime_to_us(diff));
178 return;
180 last_pressed[key->code - KEYCODE_BASE] = cur;
182 if (key->type == KE_KEY &&
183 /* Brightness is served via acpi video driver */
184 (!acpi_video_backlight_support() ||
185 (key->code != MSI_WMI_BRIGHTNESSUP &&
186 key->code != MSI_WMI_BRIGHTNESSDOWN))) {
187 dprintk("Send key: 0x%X - "
188 "Input layer keycode: %d\n", key->code,
189 key->keycode);
190 sparse_keymap_report_entry(msi_wmi_input_dev,
191 key, 1, true);
193 } else
194 printk(KERN_INFO "Unknown key pressed - %x\n",
195 eventcode);
196 } else
197 printk(KERN_INFO DRV_PFX "Unknown event received\n");
198 kfree(response.pointer);
201 static int __init msi_wmi_input_setup(void)
203 int err;
205 msi_wmi_input_dev = input_allocate_device();
206 if (!msi_wmi_input_dev)
207 return -ENOMEM;
209 msi_wmi_input_dev->name = "MSI WMI hotkeys";
210 msi_wmi_input_dev->phys = "wmi/input0";
211 msi_wmi_input_dev->id.bustype = BUS_HOST;
213 err = sparse_keymap_setup(msi_wmi_input_dev, msi_wmi_keymap, NULL);
214 if (err)
215 goto err_free_dev;
217 err = input_register_device(msi_wmi_input_dev);
219 if (err)
220 goto err_free_keymap;
222 memset(last_pressed, 0, sizeof(last_pressed));
224 return 0;
226 err_free_keymap:
227 sparse_keymap_free(msi_wmi_input_dev);
228 err_free_dev:
229 input_free_device(msi_wmi_input_dev);
230 return err;
233 static int __init msi_wmi_init(void)
235 int err;
237 if (!wmi_has_guid(MSIWMI_EVENT_GUID)) {
238 printk(KERN_ERR
239 "This machine doesn't have MSI-hotkeys through WMI\n");
240 return -ENODEV;
242 err = wmi_install_notify_handler(MSIWMI_EVENT_GUID,
243 msi_wmi_notify, NULL);
244 if (ACPI_FAILURE(err))
245 return -EINVAL;
247 err = msi_wmi_input_setup();
248 if (err)
249 goto err_uninstall_notifier;
251 if (!acpi_video_backlight_support()) {
252 struct backlight_properties props;
253 memset(&props, 0, sizeof(struct backlight_properties));
254 props.max_brightness = ARRAY_SIZE(backlight_map) - 1;
255 backlight = backlight_device_register(DRV_NAME, NULL, NULL,
256 &msi_backlight_ops,
257 &props);
258 if (IS_ERR(backlight)) {
259 err = PTR_ERR(backlight);
260 goto err_free_input;
263 err = bl_get(NULL);
264 if (err < 0)
265 goto err_free_backlight;
267 backlight->props.brightness = err;
269 dprintk("Event handler installed\n");
271 return 0;
273 err_free_backlight:
274 backlight_device_unregister(backlight);
275 err_free_input:
276 input_unregister_device(msi_wmi_input_dev);
277 err_uninstall_notifier:
278 wmi_remove_notify_handler(MSIWMI_EVENT_GUID);
279 return err;
282 static void __exit msi_wmi_exit(void)
284 if (wmi_has_guid(MSIWMI_EVENT_GUID)) {
285 wmi_remove_notify_handler(MSIWMI_EVENT_GUID);
286 sparse_keymap_free(msi_wmi_input_dev);
287 input_unregister_device(msi_wmi_input_dev);
288 backlight_device_unregister(backlight);
292 module_init(msi_wmi_init);
293 module_exit(msi_wmi_exit);