Commit | Line | Data |
---|---|---|
58ac7aa0 | 1 | /* |
a4b5a279 | 2 | * ideapad-laptop.c - Lenovo IdeaPad ACPI Extras |
58ac7aa0 DW |
3 | * |
4 | * Copyright © 2010 Intel Corporation | |
5 | * Copyright © 2010 David Woodhouse <dwmw2@infradead.org> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | |
20 | * 02110-1301, USA. | |
21 | */ | |
22 | ||
9ab23989 JP |
23 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
24 | ||
58ac7aa0 DW |
25 | #include <linux/kernel.h> |
26 | #include <linux/module.h> | |
27 | #include <linux/init.h> | |
28 | #include <linux/types.h> | |
29 | #include <acpi/acpi_bus.h> | |
30 | #include <acpi/acpi_drivers.h> | |
31 | #include <linux/rfkill.h> | |
98ee6919 | 32 | #include <linux/platform_device.h> |
f63409ae IP |
33 | #include <linux/input.h> |
34 | #include <linux/input/sparse-keymap.h> | |
58ac7aa0 | 35 | |
c1f73658 | 36 | #define IDEAPAD_RFKILL_DEV_NUM (3) |
58ac7aa0 | 37 | |
3371f481 IP |
38 | #define CFG_BT_BIT (16) |
39 | #define CFG_3G_BIT (17) | |
40 | #define CFG_WIFI_BIT (18) | |
41 | ||
ce326329 | 42 | struct ideapad_private { |
c1f73658 | 43 | struct rfkill *rfk[IDEAPAD_RFKILL_DEV_NUM]; |
98ee6919 | 44 | struct platform_device *platform_device; |
f63409ae | 45 | struct input_dev *inputdev; |
3371f481 | 46 | unsigned long cfg; |
58ac7aa0 DW |
47 | }; |
48 | ||
c1f73658 | 49 | static acpi_handle ideapad_handle; |
bfa97b7d IP |
50 | static bool no_bt_rfkill; |
51 | module_param(no_bt_rfkill, bool, 0444); | |
52 | MODULE_PARM_DESC(no_bt_rfkill, "No rfkill for bluetooth."); | |
53 | ||
6a09f21d IP |
54 | /* |
55 | * ACPI Helpers | |
56 | */ | |
57 | #define IDEAPAD_EC_TIMEOUT (100) /* in ms */ | |
58 | ||
59 | static int read_method_int(acpi_handle handle, const char *method, int *val) | |
60 | { | |
61 | acpi_status status; | |
62 | unsigned long long result; | |
63 | ||
64 | status = acpi_evaluate_integer(handle, (char *)method, NULL, &result); | |
65 | if (ACPI_FAILURE(status)) { | |
66 | *val = -1; | |
67 | return -1; | |
68 | } else { | |
69 | *val = result; | |
70 | return 0; | |
71 | } | |
72 | } | |
73 | ||
74 | static int method_vpcr(acpi_handle handle, int cmd, int *ret) | |
75 | { | |
76 | acpi_status status; | |
77 | unsigned long long result; | |
78 | struct acpi_object_list params; | |
79 | union acpi_object in_obj; | |
80 | ||
81 | params.count = 1; | |
82 | params.pointer = &in_obj; | |
83 | in_obj.type = ACPI_TYPE_INTEGER; | |
84 | in_obj.integer.value = cmd; | |
85 | ||
86 | status = acpi_evaluate_integer(handle, "VPCR", ¶ms, &result); | |
87 | ||
88 | if (ACPI_FAILURE(status)) { | |
89 | *ret = -1; | |
90 | return -1; | |
91 | } else { | |
92 | *ret = result; | |
93 | return 0; | |
94 | } | |
95 | } | |
96 | ||
97 | static int method_vpcw(acpi_handle handle, int cmd, int data) | |
98 | { | |
99 | struct acpi_object_list params; | |
100 | union acpi_object in_obj[2]; | |
101 | acpi_status status; | |
102 | ||
103 | params.count = 2; | |
104 | params.pointer = in_obj; | |
105 | in_obj[0].type = ACPI_TYPE_INTEGER; | |
106 | in_obj[0].integer.value = cmd; | |
107 | in_obj[1].type = ACPI_TYPE_INTEGER; | |
108 | in_obj[1].integer.value = data; | |
109 | ||
110 | status = acpi_evaluate_object(handle, "VPCW", ¶ms, NULL); | |
111 | if (status != AE_OK) | |
112 | return -1; | |
113 | return 0; | |
114 | } | |
115 | ||
116 | static int read_ec_data(acpi_handle handle, int cmd, unsigned long *data) | |
117 | { | |
118 | int val; | |
119 | unsigned long int end_jiffies; | |
120 | ||
121 | if (method_vpcw(handle, 1, cmd)) | |
122 | return -1; | |
123 | ||
124 | for (end_jiffies = jiffies+(HZ)*IDEAPAD_EC_TIMEOUT/1000+1; | |
125 | time_before(jiffies, end_jiffies);) { | |
126 | schedule(); | |
127 | if (method_vpcr(handle, 1, &val)) | |
128 | return -1; | |
129 | if (val == 0) { | |
130 | if (method_vpcr(handle, 0, &val)) | |
131 | return -1; | |
132 | *data = val; | |
133 | return 0; | |
134 | } | |
135 | } | |
136 | pr_err("timeout in read_ec_cmd\n"); | |
137 | return -1; | |
138 | } | |
139 | ||
140 | static int write_ec_cmd(acpi_handle handle, int cmd, unsigned long data) | |
141 | { | |
142 | int val; | |
143 | unsigned long int end_jiffies; | |
144 | ||
145 | if (method_vpcw(handle, 0, data)) | |
146 | return -1; | |
147 | if (method_vpcw(handle, 1, cmd)) | |
148 | return -1; | |
149 | ||
150 | for (end_jiffies = jiffies+(HZ)*IDEAPAD_EC_TIMEOUT/1000+1; | |
151 | time_before(jiffies, end_jiffies);) { | |
152 | schedule(); | |
153 | if (method_vpcr(handle, 1, &val)) | |
154 | return -1; | |
155 | if (val == 0) | |
156 | return 0; | |
157 | } | |
158 | pr_err("timeout in write_ec_cmd\n"); | |
159 | return -1; | |
160 | } | |
6a09f21d | 161 | |
a4b5a279 | 162 | /* |
3371f481 | 163 | * sysfs |
a4b5a279 | 164 | */ |
58ac7aa0 DW |
165 | static ssize_t show_ideapad_cam(struct device *dev, |
166 | struct device_attribute *attr, | |
167 | char *buf) | |
168 | { | |
26c81d5c | 169 | unsigned long result; |
58ac7aa0 | 170 | |
c1f73658 | 171 | if (read_ec_data(ideapad_handle, 0x1D, &result)) |
26c81d5c IP |
172 | return sprintf(buf, "-1\n"); |
173 | return sprintf(buf, "%lu\n", result); | |
58ac7aa0 DW |
174 | } |
175 | ||
176 | static ssize_t store_ideapad_cam(struct device *dev, | |
177 | struct device_attribute *attr, | |
178 | const char *buf, size_t count) | |
179 | { | |
180 | int ret, state; | |
181 | ||
182 | if (!count) | |
183 | return 0; | |
184 | if (sscanf(buf, "%i", &state) != 1) | |
185 | return -EINVAL; | |
c1f73658 | 186 | ret = write_ec_cmd(ideapad_handle, 0x1E, state); |
58ac7aa0 DW |
187 | if (ret < 0) |
188 | return ret; | |
189 | return count; | |
190 | } | |
191 | ||
192 | static DEVICE_ATTR(camera_power, 0644, show_ideapad_cam, store_ideapad_cam); | |
193 | ||
3371f481 IP |
194 | static ssize_t show_ideapad_cfg(struct device *dev, |
195 | struct device_attribute *attr, | |
196 | char *buf) | |
197 | { | |
198 | struct ideapad_private *priv = dev_get_drvdata(dev); | |
199 | ||
200 | return sprintf(buf, "0x%.8lX\n", priv->cfg); | |
201 | } | |
202 | ||
203 | static DEVICE_ATTR(cfg, 0444, show_ideapad_cfg, NULL); | |
204 | ||
205 | static struct attribute *ideapad_attributes[] = { | |
206 | &dev_attr_camera_power.attr, | |
207 | &dev_attr_cfg.attr, | |
208 | NULL | |
209 | }; | |
210 | ||
211 | static struct attribute_group ideapad_attribute_group = { | |
212 | .attrs = ideapad_attributes | |
213 | }; | |
214 | ||
a4b5a279 IP |
215 | /* |
216 | * Rfkill | |
217 | */ | |
c1f73658 IP |
218 | struct ideapad_rfk_data { |
219 | char *name; | |
220 | int cfgbit; | |
221 | int opcode; | |
222 | int type; | |
223 | }; | |
224 | ||
225 | const struct ideapad_rfk_data ideapad_rfk_data[] = { | |
3371f481 IP |
226 | { "ideapad_wlan", CFG_WIFI_BIT, 0x15, RFKILL_TYPE_WLAN }, |
227 | { "ideapad_bluetooth", CFG_BT_BIT, 0x17, RFKILL_TYPE_BLUETOOTH }, | |
228 | { "ideapad_3g", CFG_3G_BIT, 0x20, RFKILL_TYPE_WWAN }, | |
c1f73658 IP |
229 | }; |
230 | ||
58ac7aa0 DW |
231 | static int ideapad_rfk_set(void *data, bool blocked) |
232 | { | |
c1f73658 | 233 | unsigned long opcode = (unsigned long)data; |
fa08359e | 234 | |
c1f73658 | 235 | return write_ec_cmd(ideapad_handle, opcode, !blocked); |
58ac7aa0 DW |
236 | } |
237 | ||
238 | static struct rfkill_ops ideapad_rfk_ops = { | |
239 | .set_block = ideapad_rfk_set, | |
240 | }; | |
241 | ||
ce326329 | 242 | static void ideapad_sync_rfk_state(struct acpi_device *adevice) |
58ac7aa0 | 243 | { |
ce326329 | 244 | struct ideapad_private *priv = dev_get_drvdata(&adevice->dev); |
2b7266bd | 245 | unsigned long hw_blocked; |
58ac7aa0 DW |
246 | int i; |
247 | ||
c1f73658 | 248 | if (read_ec_data(ideapad_handle, 0x23, &hw_blocked)) |
58ac7aa0 | 249 | return; |
2b7266bd | 250 | hw_blocked = !hw_blocked; |
58ac7aa0 | 251 | |
c1f73658 | 252 | for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++) |
ce326329 | 253 | if (priv->rfk[i]) |
2b7266bd | 254 | rfkill_set_hw_state(priv->rfk[i], hw_blocked); |
58ac7aa0 DW |
255 | } |
256 | ||
a4b5a279 IP |
257 | static int __devinit ideapad_register_rfkill(struct acpi_device *adevice, |
258 | int dev) | |
58ac7aa0 | 259 | { |
ce326329 | 260 | struct ideapad_private *priv = dev_get_drvdata(&adevice->dev); |
58ac7aa0 | 261 | int ret; |
2b7266bd | 262 | unsigned long sw_blocked; |
58ac7aa0 | 263 | |
bfa97b7d IP |
264 | if (no_bt_rfkill && |
265 | (ideapad_rfk_data[dev].type == RFKILL_TYPE_BLUETOOTH)) { | |
266 | /* Force to enable bluetooth when no_bt_rfkill=1 */ | |
c1f73658 | 267 | write_ec_cmd(ideapad_handle, |
bfa97b7d IP |
268 | ideapad_rfk_data[dev].opcode, 1); |
269 | return 0; | |
270 | } | |
271 | ||
2b7266bd IP |
272 | priv->rfk[dev] = rfkill_alloc(ideapad_rfk_data[dev].name, &adevice->dev, |
273 | ideapad_rfk_data[dev].type, &ideapad_rfk_ops, | |
ce326329 DW |
274 | (void *)(long)dev); |
275 | if (!priv->rfk[dev]) | |
58ac7aa0 DW |
276 | return -ENOMEM; |
277 | ||
c1f73658 | 278 | if (read_ec_data(ideapad_handle, ideapad_rfk_data[dev].opcode-1, |
2b7266bd IP |
279 | &sw_blocked)) { |
280 | rfkill_init_sw_state(priv->rfk[dev], 0); | |
281 | } else { | |
282 | sw_blocked = !sw_blocked; | |
283 | rfkill_init_sw_state(priv->rfk[dev], sw_blocked); | |
284 | } | |
285 | ||
ce326329 | 286 | ret = rfkill_register(priv->rfk[dev]); |
58ac7aa0 | 287 | if (ret) { |
ce326329 | 288 | rfkill_destroy(priv->rfk[dev]); |
58ac7aa0 DW |
289 | return ret; |
290 | } | |
291 | return 0; | |
292 | } | |
293 | ||
a4b5a279 IP |
294 | static void __devexit ideapad_unregister_rfkill(struct acpi_device *adevice, |
295 | int dev) | |
58ac7aa0 | 296 | { |
ce326329 DW |
297 | struct ideapad_private *priv = dev_get_drvdata(&adevice->dev); |
298 | ||
299 | if (!priv->rfk[dev]) | |
58ac7aa0 DW |
300 | return; |
301 | ||
ce326329 DW |
302 | rfkill_unregister(priv->rfk[dev]); |
303 | rfkill_destroy(priv->rfk[dev]); | |
58ac7aa0 DW |
304 | } |
305 | ||
98ee6919 IP |
306 | /* |
307 | * Platform device | |
308 | */ | |
8693ae84 | 309 | static int __devinit ideapad_platform_init(struct ideapad_private *priv) |
98ee6919 IP |
310 | { |
311 | int result; | |
312 | ||
8693ae84 IP |
313 | priv->platform_device = platform_device_alloc("ideapad", -1); |
314 | if (!priv->platform_device) | |
98ee6919 | 315 | return -ENOMEM; |
8693ae84 | 316 | platform_set_drvdata(priv->platform_device, priv); |
98ee6919 | 317 | |
8693ae84 | 318 | result = platform_device_add(priv->platform_device); |
98ee6919 IP |
319 | if (result) |
320 | goto fail_platform_device; | |
321 | ||
8693ae84 | 322 | result = sysfs_create_group(&priv->platform_device->dev.kobj, |
c9f718d0 IP |
323 | &ideapad_attribute_group); |
324 | if (result) | |
325 | goto fail_sysfs; | |
98ee6919 IP |
326 | return 0; |
327 | ||
c9f718d0 | 328 | fail_sysfs: |
8693ae84 | 329 | platform_device_del(priv->platform_device); |
98ee6919 | 330 | fail_platform_device: |
8693ae84 | 331 | platform_device_put(priv->platform_device); |
98ee6919 IP |
332 | return result; |
333 | } | |
334 | ||
8693ae84 | 335 | static void ideapad_platform_exit(struct ideapad_private *priv) |
98ee6919 | 336 | { |
8693ae84 | 337 | sysfs_remove_group(&priv->platform_device->dev.kobj, |
c9f718d0 | 338 | &ideapad_attribute_group); |
8693ae84 | 339 | platform_device_unregister(priv->platform_device); |
98ee6919 | 340 | } |
98ee6919 | 341 | |
f63409ae IP |
342 | /* |
343 | * input device | |
344 | */ | |
345 | static const struct key_entry ideapad_keymap[] = { | |
346 | { KE_KEY, 0x06, { KEY_SWITCHVIDEOMODE } }, | |
347 | { KE_KEY, 0x0D, { KEY_WLAN } }, | |
348 | { KE_END, 0 }, | |
349 | }; | |
350 | ||
8693ae84 | 351 | static int __devinit ideapad_input_init(struct ideapad_private *priv) |
f63409ae IP |
352 | { |
353 | struct input_dev *inputdev; | |
354 | int error; | |
355 | ||
356 | inputdev = input_allocate_device(); | |
357 | if (!inputdev) { | |
358 | pr_info("Unable to allocate input device\n"); | |
359 | return -ENOMEM; | |
360 | } | |
361 | ||
362 | inputdev->name = "Ideapad extra buttons"; | |
363 | inputdev->phys = "ideapad/input0"; | |
364 | inputdev->id.bustype = BUS_HOST; | |
8693ae84 | 365 | inputdev->dev.parent = &priv->platform_device->dev; |
f63409ae IP |
366 | |
367 | error = sparse_keymap_setup(inputdev, ideapad_keymap, NULL); | |
368 | if (error) { | |
369 | pr_err("Unable to setup input device keymap\n"); | |
370 | goto err_free_dev; | |
371 | } | |
372 | ||
373 | error = input_register_device(inputdev); | |
374 | if (error) { | |
375 | pr_err("Unable to register input device\n"); | |
376 | goto err_free_keymap; | |
377 | } | |
378 | ||
8693ae84 | 379 | priv->inputdev = inputdev; |
f63409ae IP |
380 | return 0; |
381 | ||
382 | err_free_keymap: | |
383 | sparse_keymap_free(inputdev); | |
384 | err_free_dev: | |
385 | input_free_device(inputdev); | |
386 | return error; | |
387 | } | |
388 | ||
8693ae84 | 389 | static void __devexit ideapad_input_exit(struct ideapad_private *priv) |
f63409ae | 390 | { |
8693ae84 IP |
391 | sparse_keymap_free(priv->inputdev); |
392 | input_unregister_device(priv->inputdev); | |
393 | priv->inputdev = NULL; | |
f63409ae IP |
394 | } |
395 | ||
8693ae84 IP |
396 | static void ideapad_input_report(struct ideapad_private *priv, |
397 | unsigned long scancode) | |
f63409ae | 398 | { |
8693ae84 | 399 | sparse_keymap_report_event(priv->inputdev, scancode, 1, true); |
f63409ae | 400 | } |
f63409ae | 401 | |
a4b5a279 IP |
402 | /* |
403 | * module init/exit | |
404 | */ | |
58ac7aa0 DW |
405 | static const struct acpi_device_id ideapad_device_ids[] = { |
406 | { "VPC2004", 0}, | |
407 | { "", 0}, | |
408 | }; | |
409 | MODULE_DEVICE_TABLE(acpi, ideapad_device_ids); | |
410 | ||
a4b5a279 | 411 | static int __devinit ideapad_acpi_add(struct acpi_device *adevice) |
58ac7aa0 | 412 | { |
3371f481 IP |
413 | int ret, i; |
414 | unsigned long cfg; | |
ce326329 | 415 | struct ideapad_private *priv; |
58ac7aa0 | 416 | |
3371f481 | 417 | if (read_method_int(adevice->handle, "_CFG", (int *)&cfg)) |
6f8371c0 IP |
418 | return -ENODEV; |
419 | ||
ce326329 DW |
420 | priv = kzalloc(sizeof(*priv), GFP_KERNEL); |
421 | if (!priv) | |
422 | return -ENOMEM; | |
c9f718d0 | 423 | dev_set_drvdata(&adevice->dev, priv); |
c1f73658 | 424 | ideapad_handle = adevice->handle; |
3371f481 | 425 | priv->cfg = cfg; |
98ee6919 | 426 | |
8693ae84 | 427 | ret = ideapad_platform_init(priv); |
98ee6919 IP |
428 | if (ret) |
429 | goto platform_failed; | |
ce326329 | 430 | |
8693ae84 | 431 | ret = ideapad_input_init(priv); |
f63409ae IP |
432 | if (ret) |
433 | goto input_failed; | |
434 | ||
c1f73658 | 435 | for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++) { |
3371f481 | 436 | if (test_bit(ideapad_rfk_data[i].cfgbit, &cfg)) |
c9f718d0 | 437 | ideapad_register_rfkill(adevice, i); |
c1f73658 IP |
438 | else |
439 | priv->rfk[i] = NULL; | |
58ac7aa0 | 440 | } |
ce326329 | 441 | ideapad_sync_rfk_state(adevice); |
c9f718d0 | 442 | |
58ac7aa0 | 443 | return 0; |
98ee6919 | 444 | |
f63409ae | 445 | input_failed: |
8693ae84 | 446 | ideapad_platform_exit(priv); |
98ee6919 IP |
447 | platform_failed: |
448 | kfree(priv); | |
449 | return ret; | |
58ac7aa0 DW |
450 | } |
451 | ||
a4b5a279 | 452 | static int __devexit ideapad_acpi_remove(struct acpi_device *adevice, int type) |
58ac7aa0 | 453 | { |
ce326329 | 454 | struct ideapad_private *priv = dev_get_drvdata(&adevice->dev); |
58ac7aa0 | 455 | int i; |
ce326329 | 456 | |
c1f73658 | 457 | for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++) |
ce326329 | 458 | ideapad_unregister_rfkill(adevice, i); |
8693ae84 IP |
459 | ideapad_input_exit(priv); |
460 | ideapad_platform_exit(priv); | |
ce326329 DW |
461 | dev_set_drvdata(&adevice->dev, NULL); |
462 | kfree(priv); | |
c9f718d0 | 463 | |
58ac7aa0 DW |
464 | return 0; |
465 | } | |
466 | ||
ce326329 | 467 | static void ideapad_acpi_notify(struct acpi_device *adevice, u32 event) |
58ac7aa0 | 468 | { |
8693ae84 | 469 | struct ideapad_private *priv = dev_get_drvdata(&adevice->dev); |
8e7d3543 IP |
470 | acpi_handle handle = adevice->handle; |
471 | unsigned long vpc1, vpc2, vpc_bit; | |
472 | ||
473 | if (read_ec_data(handle, 0x10, &vpc1)) | |
474 | return; | |
475 | if (read_ec_data(handle, 0x1A, &vpc2)) | |
476 | return; | |
477 | ||
478 | vpc1 = (vpc2 << 8) | vpc1; | |
479 | for (vpc_bit = 0; vpc_bit < 16; vpc_bit++) { | |
480 | if (test_bit(vpc_bit, &vpc1)) { | |
481 | if (vpc_bit == 9) | |
482 | ideapad_sync_rfk_state(adevice); | |
883ae799 IP |
483 | else if (vpc_bit == 4) |
484 | read_ec_data(handle, 0x12, &vpc2); | |
f63409ae | 485 | else |
8693ae84 | 486 | ideapad_input_report(priv, vpc_bit); |
8e7d3543 IP |
487 | } |
488 | } | |
58ac7aa0 DW |
489 | } |
490 | ||
491 | static struct acpi_driver ideapad_acpi_driver = { | |
492 | .name = "ideapad_acpi", | |
493 | .class = "IdeaPad", | |
494 | .ids = ideapad_device_ids, | |
495 | .ops.add = ideapad_acpi_add, | |
496 | .ops.remove = ideapad_acpi_remove, | |
497 | .ops.notify = ideapad_acpi_notify, | |
498 | .owner = THIS_MODULE, | |
499 | }; | |
500 | ||
58ac7aa0 DW |
501 | static int __init ideapad_acpi_module_init(void) |
502 | { | |
a4b5a279 | 503 | return acpi_bus_register_driver(&ideapad_acpi_driver); |
58ac7aa0 DW |
504 | } |
505 | ||
58ac7aa0 DW |
506 | static void __exit ideapad_acpi_module_exit(void) |
507 | { | |
508 | acpi_bus_unregister_driver(&ideapad_acpi_driver); | |
58ac7aa0 DW |
509 | } |
510 | ||
511 | MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>"); | |
512 | MODULE_DESCRIPTION("IdeaPad ACPI Extras"); | |
513 | MODULE_LICENSE("GPL"); | |
514 | ||
515 | module_init(ideapad_acpi_module_init); | |
516 | module_exit(ideapad_acpi_module_exit); |