diff options
Diffstat (limited to 'drivers/platform')
-rw-r--r-- | drivers/platform/Kconfig | 5 | ||||
-rw-r--r-- | drivers/platform/Makefile | 5 | ||||
-rw-r--r-- | drivers/platform/x86/Kconfig | 375 | ||||
-rw-r--r-- | drivers/platform/x86/Makefile | 19 | ||||
-rw-r--r-- | drivers/platform/x86/acer-wmi.c | 1345 | ||||
-rw-r--r-- | drivers/platform/x86/asus-laptop.c | 1266 | ||||
-rw-r--r-- | drivers/platform/x86/asus_acpi.c | 1460 | ||||
-rw-r--r-- | drivers/platform/x86/compal-laptop.c | 406 | ||||
-rw-r--r-- | drivers/platform/x86/eeepc-laptop.c | 872 | ||||
-rw-r--r-- | drivers/platform/x86/fujitsu-laptop.c | 1293 | ||||
-rw-r--r-- | drivers/platform/x86/hp-wmi.c | 512 | ||||
-rw-r--r-- | drivers/platform/x86/intel_menlow.c | 536 | ||||
-rw-r--r-- | drivers/platform/x86/msi-laptop.c | 437 | ||||
-rw-r--r-- | drivers/platform/x86/panasonic-laptop.c | 744 | ||||
-rw-r--r-- | drivers/platform/x86/sony-laptop.c | 2784 | ||||
-rw-r--r-- | drivers/platform/x86/tc1100-wmi.c | 289 | ||||
-rw-r--r-- | drivers/platform/x86/thinkpad_acpi.c | 6948 | ||||
-rw-r--r-- | drivers/platform/x86/toshiba_acpi.c | 863 | ||||
-rw-r--r-- | drivers/platform/x86/wmi.c | 747 |
19 files changed, 20906 insertions, 0 deletions
diff --git a/drivers/platform/Kconfig b/drivers/platform/Kconfig new file mode 100644 index 000000000000..9652c3fe7f5e --- /dev/null +++ b/drivers/platform/Kconfig | |||
@@ -0,0 +1,5 @@ | |||
1 | # drivers/platform/Kconfig | ||
2 | |||
3 | if X86 | ||
4 | source "drivers/platform/x86/Kconfig" | ||
5 | endif | ||
diff --git a/drivers/platform/Makefile b/drivers/platform/Makefile new file mode 100644 index 000000000000..782953ae4c03 --- /dev/null +++ b/drivers/platform/Makefile | |||
@@ -0,0 +1,5 @@ | |||
1 | # | ||
2 | # Makefile for linux/drivers/platform | ||
3 | # | ||
4 | |||
5 | obj-$(CONFIG_X86) += x86/ | ||
diff --git a/drivers/platform/x86/Kconfig b/drivers/platform/x86/Kconfig new file mode 100644 index 000000000000..e65448e99b48 --- /dev/null +++ b/drivers/platform/x86/Kconfig | |||
@@ -0,0 +1,375 @@ | |||
1 | # | ||
2 | # X86 Platform Specific Drivers | ||
3 | # | ||
4 | |||
5 | menuconfig X86_PLATFORM_DEVICES | ||
6 | bool "X86 Platform Specific Device Drivers" | ||
7 | default y | ||
8 | ---help--- | ||
9 | Say Y here to get to see options for device drivers for various | ||
10 | x86 platforms, including vendor-specific laptop extension drivers. | ||
11 | This option alone does not add any kernel code. | ||
12 | |||
13 | If you say N, all options in this submenu will be skipped and disabled. | ||
14 | |||
15 | if X86_PLATFORM_DEVICES | ||
16 | |||
17 | config ACER_WMI | ||
18 | tristate "Acer WMI Laptop Extras (EXPERIMENTAL)" | ||
19 | depends on EXPERIMENTAL | ||
20 | depends on ACPI | ||
21 | depends on LEDS_CLASS | ||
22 | depends on NEW_LEDS | ||
23 | depends on BACKLIGHT_CLASS_DEVICE | ||
24 | depends on SERIO_I8042 | ||
25 | depends on RFKILL | ||
26 | select ACPI_WMI | ||
27 | ---help--- | ||
28 | This is a driver for newer Acer (and Wistron) laptops. It adds | ||
29 | wireless radio and bluetooth control, and on some laptops, | ||
30 | exposes the mail LED and LCD backlight. | ||
31 | |||
32 | For more information about this driver see | ||
33 | <file:Documentation/laptops/acer-wmi.txt> | ||
34 | |||
35 | If you have an ACPI-WMI compatible Acer/ Wistron laptop, say Y or M | ||
36 | here. | ||
37 | |||
38 | config ASUS_LAPTOP | ||
39 | tristate "Asus Laptop Extras (EXPERIMENTAL)" | ||
40 | depends on ACPI | ||
41 | depends on EXPERIMENTAL && !ACPI_ASUS | ||
42 | depends on LEDS_CLASS | ||
43 | depends on NEW_LEDS | ||
44 | depends on BACKLIGHT_CLASS_DEVICE | ||
45 | ---help--- | ||
46 | This is the new Linux driver for Asus laptops. It may also support some | ||
47 | MEDION, JVC or VICTOR laptops. It makes all the extra buttons generate | ||
48 | standard ACPI events that go through /proc/acpi/events. It also adds | ||
49 | support for video output switching, LCD backlight control, Bluetooth and | ||
50 | Wlan control, and most importantly, allows you to blink those fancy LEDs. | ||
51 | |||
52 | For more information and a userspace daemon for handling the extra | ||
53 | buttons see <http://acpi4asus.sf.net/>. | ||
54 | |||
55 | If you have an ACPI-compatible ASUS laptop, say Y or M here. | ||
56 | |||
57 | config FUJITSU_LAPTOP | ||
58 | tristate "Fujitsu Laptop Extras" | ||
59 | depends on ACPI | ||
60 | depends on INPUT | ||
61 | depends on BACKLIGHT_CLASS_DEVICE | ||
62 | ---help--- | ||
63 | This is a driver for laptops built by Fujitsu: | ||
64 | |||
65 | * P2xxx/P5xxx/S6xxx/S7xxx series Lifebooks | ||
66 | * Possibly other Fujitsu laptop models | ||
67 | * Tested with S6410 and S7020 | ||
68 | |||
69 | It adds support for LCD brightness control and some hotkeys. | ||
70 | |||
71 | If you have a Fujitsu laptop, say Y or M here. | ||
72 | |||
73 | config FUJITSU_LAPTOP_DEBUG | ||
74 | bool "Verbose debug mode for Fujitsu Laptop Extras" | ||
75 | depends on FUJITSU_LAPTOP | ||
76 | default n | ||
77 | ---help--- | ||
78 | Enables extra debug output from the fujitsu extras driver, at the | ||
79 | expense of a slight increase in driver size. | ||
80 | |||
81 | If you are not sure, say N here. | ||
82 | |||
83 | config TC1100_WMI | ||
84 | tristate "HP Compaq TC1100 Tablet WMI Extras (EXPERIMENTAL)" | ||
85 | depends on !X86_64 | ||
86 | depends on EXPERIMENTAL | ||
87 | depends on ACPI | ||
88 | select ACPI_WMI | ||
89 | ---help--- | ||
90 | This is a driver for the WMI extensions (wireless and bluetooth power | ||
91 | control) of the HP Compaq TC1100 tablet. | ||
92 | |||
93 | config HP_WMI | ||
94 | tristate "HP WMI extras" | ||
95 | depends on ACPI_WMI | ||
96 | depends on INPUT | ||
97 | depends on RFKILL | ||
98 | help | ||
99 | Say Y here if you want to support WMI-based hotkeys on HP laptops and | ||
100 | to read data from WMI such as docking or ambient light sensor state. | ||
101 | |||
102 | To compile this driver as a module, choose M here: the module will | ||
103 | be called hp-wmi. | ||
104 | |||
105 | config MSI_LAPTOP | ||
106 | tristate "MSI Laptop Extras" | ||
107 | depends on ACPI | ||
108 | depends on BACKLIGHT_CLASS_DEVICE | ||
109 | ---help--- | ||
110 | This is a driver for laptops built by MSI (MICRO-STAR | ||
111 | INTERNATIONAL): | ||
112 | |||
113 | MSI MegaBook S270 (MS-1013) | ||
114 | Cytron/TCM/Medion/Tchibo MD96100/SAM2000 | ||
115 | |||
116 | It adds support for Bluetooth, WLAN and LCD brightness control. | ||
117 | |||
118 | More information about this driver is available at | ||
119 | <http://0pointer.de/lennart/tchibo.html>. | ||
120 | |||
121 | If you have an MSI S270 laptop, say Y or M here. | ||
122 | |||
123 | config PANASONIC_LAPTOP | ||
124 | tristate "Panasonic Laptop Extras" | ||
125 | depends on INPUT && ACPI | ||
126 | depends on BACKLIGHT_CLASS_DEVICE | ||
127 | ---help--- | ||
128 | This driver adds support for access to backlight control and hotkeys | ||
129 | on Panasonic Let's Note laptops. | ||
130 | |||
131 | If you have a Panasonic Let's note laptop (such as the R1(N variant), | ||
132 | R2, R3, R5, T2, W2 and Y2 series), say Y. | ||
133 | |||
134 | config COMPAL_LAPTOP | ||
135 | tristate "Compal Laptop Extras" | ||
136 | depends on ACPI | ||
137 | depends on BACKLIGHT_CLASS_DEVICE | ||
138 | ---help--- | ||
139 | This is a driver for laptops built by Compal: | ||
140 | |||
141 | Compal FL90/IFL90 | ||
142 | Compal FL91/IFL91 | ||
143 | Compal FL92/JFL92 | ||
144 | Compal FT00/IFT00 | ||
145 | |||
146 | It adds support for Bluetooth, WLAN and LCD brightness control. | ||
147 | |||
148 | If you have an Compal FL9x/IFL9x/FT00 laptop, say Y or M here. | ||
149 | |||
150 | config SONY_LAPTOP | ||
151 | tristate "Sony Laptop Extras" | ||
152 | depends on ACPI | ||
153 | select BACKLIGHT_CLASS_DEVICE | ||
154 | depends on INPUT | ||
155 | ---help--- | ||
156 | This mini-driver drives the SNC and SPIC devices present in the ACPI | ||
157 | BIOS of the Sony Vaio laptops. | ||
158 | |||
159 | It gives access to some extra laptop functionalities like Bluetooth, | ||
160 | screen brightness control, Fn keys and allows powering on/off some | ||
161 | devices. | ||
162 | |||
163 | Read <file:Documentation/laptops/sony-laptop.txt> for more information. | ||
164 | |||
165 | config SONYPI_COMPAT | ||
166 | bool "Sonypi compatibility" | ||
167 | depends on SONY_LAPTOP | ||
168 | ---help--- | ||
169 | Build the sonypi driver compatibility code into the sony-laptop driver. | ||
170 | |||
171 | config THINKPAD_ACPI | ||
172 | tristate "ThinkPad ACPI Laptop Extras" | ||
173 | depends on ACPI | ||
174 | select BACKLIGHT_LCD_SUPPORT | ||
175 | select BACKLIGHT_CLASS_DEVICE | ||
176 | select HWMON | ||
177 | select NVRAM | ||
178 | select INPUT | ||
179 | select NEW_LEDS | ||
180 | select LEDS_CLASS | ||
181 | select NET | ||
182 | select RFKILL | ||
183 | ---help--- | ||
184 | This is a driver for the IBM and Lenovo ThinkPad laptops. It adds | ||
185 | support for Fn-Fx key combinations, Bluetooth control, video | ||
186 | output switching, ThinkLight control, UltraBay eject and more. | ||
187 | For more information about this driver see | ||
188 | <file:Documentation/laptops/thinkpad-acpi.txt> and | ||
189 | <http://ibm-acpi.sf.net/> . | ||
190 | |||
191 | This driver was formerly known as ibm-acpi. | ||
192 | |||
193 | If you have an IBM or Lenovo ThinkPad laptop, say Y or M here. | ||
194 | |||
195 | config THINKPAD_ACPI_DEBUG | ||
196 | bool "Verbose debug mode" | ||
197 | depends on THINKPAD_ACPI | ||
198 | default n | ||
199 | ---help--- | ||
200 | Enables extra debugging information, at the expense of a slightly | ||
201 | increase in driver size. | ||
202 | |||
203 | If you are not sure, say N here. | ||
204 | |||
205 | config THINKPAD_ACPI_DOCK | ||
206 | bool "Legacy Docking Station Support" | ||
207 | depends on THINKPAD_ACPI | ||
208 | depends on ACPI_DOCK=n | ||
209 | default n | ||
210 | ---help--- | ||
211 | Allows the thinkpad_acpi driver to handle docking station events. | ||
212 | This support was made obsolete by the generic ACPI docking station | ||
213 | support (CONFIG_ACPI_DOCK). It will allow locking and removing the | ||
214 | laptop from the docking station, but will not properly connect PCI | ||
215 | devices. | ||
216 | |||
217 | If you are not sure, say N here. | ||
218 | |||
219 | config THINKPAD_ACPI_BAY | ||
220 | bool "Legacy Removable Bay Support" | ||
221 | depends on THINKPAD_ACPI | ||
222 | default y | ||
223 | ---help--- | ||
224 | Allows the thinkpad_acpi driver to handle removable bays. It will | ||
225 | electrically disable the device in the bay, and also generate | ||
226 | notifications when the bay lever is ejected or inserted. | ||
227 | |||
228 | If you are not sure, say Y here. | ||
229 | |||
230 | config THINKPAD_ACPI_VIDEO | ||
231 | bool "Video output control support" | ||
232 | depends on THINKPAD_ACPI | ||
233 | default y | ||
234 | ---help--- | ||
235 | Allows the thinkpad_acpi driver to provide an interface to control | ||
236 | the various video output ports. | ||
237 | |||
238 | This feature often won't work well, depending on ThinkPad model, | ||
239 | display state, video output devices in use, whether there is a X | ||
240 | server running, phase of the moon, and the current mood of | ||
241 | Schroedinger's cat. If you can use X.org's RandR to control | ||
242 | your ThinkPad's video output ports instead of this feature, | ||
243 | don't think twice: do it and say N here to save some memory. | ||
244 | |||
245 | If you are not sure, say Y here. | ||
246 | |||
247 | config THINKPAD_ACPI_HOTKEY_POLL | ||
248 | bool "Support NVRAM polling for hot keys" | ||
249 | depends on THINKPAD_ACPI | ||
250 | default y | ||
251 | ---help--- | ||
252 | Some thinkpad models benefit from NVRAM polling to detect a few of | ||
253 | the hot key press events. If you know your ThinkPad model does not | ||
254 | need to do NVRAM polling to support any of the hot keys you use, | ||
255 | unselecting this option will save about 1kB of memory. | ||
256 | |||
257 | ThinkPads T40 and newer, R52 and newer, and X31 and newer are | ||
258 | unlikely to need NVRAM polling in their latest BIOS versions. | ||
259 | |||
260 | NVRAM polling can detect at most the following keys: ThinkPad/Access | ||
261 | IBM, Zoom, Switch Display (fn+F7), ThinkLight, Volume up/down/mute, | ||
262 | Brightness up/down, Display Expand (fn+F8), Hibernate (fn+F12). | ||
263 | |||
264 | If you are not sure, say Y here. The driver enables polling only if | ||
265 | it is strictly necessary to do so. | ||
266 | |||
267 | config INTEL_MENLOW | ||
268 | tristate "Thermal Management driver for Intel menlow platform" | ||
269 | depends on ACPI_THERMAL | ||
270 | select THERMAL | ||
271 | ---help--- | ||
272 | ACPI thermal management enhancement driver on | ||
273 | Intel Menlow platform. | ||
274 | |||
275 | If unsure, say N. | ||
276 | |||
277 | config EEEPC_LAPTOP | ||
278 | tristate "Eee PC Hotkey Driver (EXPERIMENTAL)" | ||
279 | depends on ACPI | ||
280 | depends on EXPERIMENTAL | ||
281 | select BACKLIGHT_CLASS_DEVICE | ||
282 | select HWMON | ||
283 | select RFKILL | ||
284 | ---help--- | ||
285 | This driver supports the Fn-Fx keys on Eee PC laptops. | ||
286 | It also adds the ability to switch camera/wlan on/off. | ||
287 | |||
288 | If you have an Eee PC laptop, say Y or M here. | ||
289 | |||
290 | |||
291 | config ACPI_WMI | ||
292 | tristate "WMI (EXPERIMENTAL)" | ||
293 | depends on ACPI | ||
294 | depends on EXPERIMENTAL | ||
295 | help | ||
296 | This driver adds support for the ACPI-WMI (Windows Management | ||
297 | Instrumentation) mapper device (PNP0C14) found on some systems. | ||
298 | |||
299 | ACPI-WMI is a proprietary extension to ACPI to expose parts of the | ||
300 | ACPI firmware to userspace - this is done through various vendor | ||
301 | defined methods and data blocks in a PNP0C14 device, which are then | ||
302 | made available for userspace to call. | ||
303 | |||
304 | The implementation of this in Linux currently only exposes this to | ||
305 | other kernel space drivers. | ||
306 | |||
307 | This driver is a required dependency to build the firmware specific | ||
308 | drivers needed on many machines, including Acer and HP laptops. | ||
309 | |||
310 | It is safe to enable this driver even if your DSDT doesn't define | ||
311 | any ACPI-WMI devices. | ||
312 | |||
313 | config ACPI_ASUS | ||
314 | tristate "ASUS/Medion Laptop Extras" | ||
315 | depends on ACPI | ||
316 | select BACKLIGHT_CLASS_DEVICE | ||
317 | ---help--- | ||
318 | This driver provides support for extra features of ACPI-compatible | ||
319 | ASUS laptops. As some of Medion laptops are made by ASUS, it may also | ||
320 | support some Medion laptops (such as 9675 for example). It makes all | ||
321 | the extra buttons generate standard ACPI events that go through | ||
322 | /proc/acpi/events, and (on some models) adds support for changing the | ||
323 | display brightness and output, switching the LCD backlight on and off, | ||
324 | and most importantly, allows you to blink those fancy LEDs intended | ||
325 | for reporting mail and wireless status. | ||
326 | |||
327 | Note: display switching code is currently considered EXPERIMENTAL, | ||
328 | toying with these values may even lock your machine. | ||
329 | |||
330 | All settings are changed via /proc/acpi/asus directory entries. Owner | ||
331 | and group for these entries can be set with asus_uid and asus_gid | ||
332 | parameters. | ||
333 | |||
334 | More information and a userspace daemon for handling the extra buttons | ||
335 | at <http://sourceforge.net/projects/acpi4asus/>. | ||
336 | |||
337 | If you have an ACPI-compatible ASUS laptop, say Y or M here. This | ||
338 | driver is still under development, so if your laptop is unsupported or | ||
339 | something works not quite as expected, please use the mailing list | ||
340 | available on the above page (acpi4asus-user@lists.sourceforge.net). | ||
341 | |||
342 | NOTE: This driver is deprecated and will probably be removed soon, | ||
343 | use asus-laptop instead. | ||
344 | |||
345 | config ACPI_TOSHIBA | ||
346 | tristate "Toshiba Laptop Extras" | ||
347 | depends on ACPI | ||
348 | depends on INPUT | ||
349 | select INPUT_POLLDEV | ||
350 | select NET | ||
351 | select RFKILL | ||
352 | select BACKLIGHT_CLASS_DEVICE | ||
353 | ---help--- | ||
354 | This driver adds support for access to certain system settings | ||
355 | on "legacy free" Toshiba laptops. These laptops can be recognized by | ||
356 | their lack of a BIOS setup menu and APM support. | ||
357 | |||
358 | On these machines, all system configuration is handled through the | ||
359 | ACPI. This driver is required for access to controls not covered | ||
360 | by the general ACPI drivers, such as LCD brightness, video output, | ||
361 | etc. | ||
362 | |||
363 | This driver differs from the non-ACPI Toshiba laptop driver (located | ||
364 | under "Processor type and features") in several aspects. | ||
365 | Configuration is accessed by reading and writing text files in the | ||
366 | /proc tree instead of by program interface to /dev. Furthermore, no | ||
367 | power management functions are exposed, as those are handled by the | ||
368 | general ACPI drivers. | ||
369 | |||
370 | More information about this driver is available at | ||
371 | <http://memebeam.org/toys/ToshibaAcpiDriver>. | ||
372 | |||
373 | If you have a legacy free Toshiba laptop (such as the Libretto L1 | ||
374 | series), say Y. | ||
375 | endif # X86_PLATFORM_DEVICES | ||
diff --git a/drivers/platform/x86/Makefile b/drivers/platform/x86/Makefile new file mode 100644 index 000000000000..1e9de2ae0de5 --- /dev/null +++ b/drivers/platform/x86/Makefile | |||
@@ -0,0 +1,19 @@ | |||
1 | # | ||
2 | # Makefile for linux/drivers/platform/x86 | ||
3 | # x86 Platform-Specific Drivers | ||
4 | # | ||
5 | obj-$(CONFIG_ASUS_LAPTOP) += asus-laptop.o | ||
6 | obj-$(CONFIG_EEEPC_LAPTOP) += eeepc-laptop.o | ||
7 | obj-$(CONFIG_MSI_LAPTOP) += msi-laptop.o | ||
8 | obj-$(CONFIG_COMPAL_LAPTOP) += compal-laptop.o | ||
9 | obj-$(CONFIG_ACER_WMI) += acer-wmi.o | ||
10 | obj-$(CONFIG_HP_WMI) += hp-wmi.o | ||
11 | obj-$(CONFIG_TC1100_WMI) += tc1100-wmi.o | ||
12 | obj-$(CONFIG_SONY_LAPTOP) += sony-laptop.o | ||
13 | obj-$(CONFIG_THINKPAD_ACPI) += thinkpad_acpi.o | ||
14 | obj-$(CONFIG_FUJITSU_LAPTOP) += fujitsu-laptop.o | ||
15 | obj-$(CONFIG_PANASONIC_LAPTOP) += panasonic-laptop.o | ||
16 | obj-$(CONFIG_INTEL_MENLOW) += intel_menlow.o | ||
17 | obj-$(CONFIG_ACPI_WMI) += wmi.o | ||
18 | obj-$(CONFIG_ACPI_ASUS) += asus_acpi.o | ||
19 | obj-$(CONFIG_ACPI_TOSHIBA) += toshiba_acpi.o | ||
diff --git a/drivers/platform/x86/acer-wmi.c b/drivers/platform/x86/acer-wmi.c new file mode 100644 index 000000000000..94c9f911824e --- /dev/null +++ b/drivers/platform/x86/acer-wmi.c | |||
@@ -0,0 +1,1345 @@ | |||
1 | /* | ||
2 | * Acer WMI Laptop Extras | ||
3 | * | ||
4 | * Copyright (C) 2007-2008 Carlos Corbacho <carlos@strangeworlds.co.uk> | ||
5 | * | ||
6 | * Based on acer_acpi: | ||
7 | * Copyright (C) 2005-2007 E.M. Smith | ||
8 | * Copyright (C) 2007-2008 Carlos Corbacho <cathectic@gmail.com> | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify | ||
11 | * it under the terms of the GNU General Public License as published by | ||
12 | * the Free Software Foundation; either version 2 of the License, or | ||
13 | * (at your option) any later version. | ||
14 | * | ||
15 | * This program is distributed in the hope that it will be useful, | ||
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
18 | * GNU General Public License for more details. | ||
19 | * | ||
20 | * You should have received a copy of the GNU General Public License | ||
21 | * along with this program; if not, write to the Free Software | ||
22 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
23 | */ | ||
24 | |||
25 | #include <linux/kernel.h> | ||
26 | #include <linux/module.h> | ||
27 | #include <linux/init.h> | ||
28 | #include <linux/types.h> | ||
29 | #include <linux/dmi.h> | ||
30 | #include <linux/fb.h> | ||
31 | #include <linux/backlight.h> | ||
32 | #include <linux/leds.h> | ||
33 | #include <linux/platform_device.h> | ||
34 | #include <linux/acpi.h> | ||
35 | #include <linux/i8042.h> | ||
36 | #include <linux/rfkill.h> | ||
37 | #include <linux/workqueue.h> | ||
38 | #include <linux/debugfs.h> | ||
39 | |||
40 | #include <acpi/acpi_drivers.h> | ||
41 | |||
42 | MODULE_AUTHOR("Carlos Corbacho"); | ||
43 | MODULE_DESCRIPTION("Acer Laptop WMI Extras Driver"); | ||
44 | MODULE_LICENSE("GPL"); | ||
45 | |||
46 | #define ACER_LOGPREFIX "acer-wmi: " | ||
47 | #define ACER_ERR KERN_ERR ACER_LOGPREFIX | ||
48 | #define ACER_NOTICE KERN_NOTICE ACER_LOGPREFIX | ||
49 | #define ACER_INFO KERN_INFO ACER_LOGPREFIX | ||
50 | |||
51 | /* | ||
52 | * The following defines quirks to get some specific functions to work | ||
53 | * which are known to not be supported over ACPI-WMI (such as the mail LED | ||
54 | * on WMID based Acer's) | ||
55 | */ | ||
56 | struct acer_quirks { | ||
57 | const char *vendor; | ||
58 | const char *model; | ||
59 | u16 quirks; | ||
60 | }; | ||
61 | |||
62 | /* | ||
63 | * Magic Number | ||
64 | * Meaning is unknown - this number is required for writing to ACPI for AMW0 | ||
65 | * (it's also used in acerhk when directly accessing the BIOS) | ||
66 | */ | ||
67 | #define ACER_AMW0_WRITE 0x9610 | ||
68 | |||
69 | /* | ||
70 | * Bit masks for the AMW0 interface | ||
71 | */ | ||
72 | #define ACER_AMW0_WIRELESS_MASK 0x35 | ||
73 | #define ACER_AMW0_BLUETOOTH_MASK 0x34 | ||
74 | #define ACER_AMW0_MAILLED_MASK 0x31 | ||
75 | |||
76 | /* | ||
77 | * Method IDs for WMID interface | ||
78 | */ | ||
79 | #define ACER_WMID_GET_WIRELESS_METHODID 1 | ||
80 | #define ACER_WMID_GET_BLUETOOTH_METHODID 2 | ||
81 | #define ACER_WMID_GET_BRIGHTNESS_METHODID 3 | ||
82 | #define ACER_WMID_SET_WIRELESS_METHODID 4 | ||
83 | #define ACER_WMID_SET_BLUETOOTH_METHODID 5 | ||
84 | #define ACER_WMID_SET_BRIGHTNESS_METHODID 6 | ||
85 | #define ACER_WMID_GET_THREEG_METHODID 10 | ||
86 | #define ACER_WMID_SET_THREEG_METHODID 11 | ||
87 | |||
88 | /* | ||
89 | * Acer ACPI method GUIDs | ||
90 | */ | ||
91 | #define AMW0_GUID1 "67C3371D-95A3-4C37-BB61-DD47B491DAAB" | ||
92 | #define AMW0_GUID2 "431F16ED-0C2B-444C-B267-27DEB140CF9C" | ||
93 | #define WMID_GUID1 "6AF4F258-B401-42fd-BE91-3D4AC2D7C0D3" | ||
94 | #define WMID_GUID2 "95764E09-FB56-4e83-B31A-37761F60994A" | ||
95 | |||
96 | MODULE_ALIAS("wmi:67C3371D-95A3-4C37-BB61-DD47B491DAAB"); | ||
97 | MODULE_ALIAS("wmi:6AF4F258-B401-42fd-BE91-3D4AC2D7C0D3"); | ||
98 | |||
99 | /* Temporary workaround until the WMI sysfs interface goes in */ | ||
100 | MODULE_ALIAS("dmi:*:*Acer*:*:"); | ||
101 | |||
102 | /* | ||
103 | * Interface capability flags | ||
104 | */ | ||
105 | #define ACER_CAP_MAILLED (1<<0) | ||
106 | #define ACER_CAP_WIRELESS (1<<1) | ||
107 | #define ACER_CAP_BLUETOOTH (1<<2) | ||
108 | #define ACER_CAP_BRIGHTNESS (1<<3) | ||
109 | #define ACER_CAP_THREEG (1<<4) | ||
110 | #define ACER_CAP_ANY (0xFFFFFFFF) | ||
111 | |||
112 | /* | ||
113 | * Interface type flags | ||
114 | */ | ||
115 | enum interface_flags { | ||
116 | ACER_AMW0, | ||
117 | ACER_AMW0_V2, | ||
118 | ACER_WMID, | ||
119 | }; | ||
120 | |||
121 | #define ACER_DEFAULT_WIRELESS 0 | ||
122 | #define ACER_DEFAULT_BLUETOOTH 0 | ||
123 | #define ACER_DEFAULT_MAILLED 0 | ||
124 | #define ACER_DEFAULT_THREEG 0 | ||
125 | |||
126 | static int max_brightness = 0xF; | ||
127 | |||
128 | static int mailled = -1; | ||
129 | static int brightness = -1; | ||
130 | static int threeg = -1; | ||
131 | static int force_series; | ||
132 | |||
133 | module_param(mailled, int, 0444); | ||
134 | module_param(brightness, int, 0444); | ||
135 | module_param(threeg, int, 0444); | ||
136 | module_param(force_series, int, 0444); | ||
137 | MODULE_PARM_DESC(mailled, "Set initial state of Mail LED"); | ||
138 | MODULE_PARM_DESC(brightness, "Set initial LCD backlight brightness"); | ||
139 | MODULE_PARM_DESC(threeg, "Set initial state of 3G hardware"); | ||
140 | MODULE_PARM_DESC(force_series, "Force a different laptop series"); | ||
141 | |||
142 | struct acer_data { | ||
143 | int mailled; | ||
144 | int threeg; | ||
145 | int brightness; | ||
146 | }; | ||
147 | |||
148 | struct acer_debug { | ||
149 | struct dentry *root; | ||
150 | struct dentry *devices; | ||
151 | u32 wmid_devices; | ||
152 | }; | ||
153 | |||
154 | static struct rfkill *wireless_rfkill; | ||
155 | static struct rfkill *bluetooth_rfkill; | ||
156 | |||
157 | /* Each low-level interface must define at least some of the following */ | ||
158 | struct wmi_interface { | ||
159 | /* The WMI device type */ | ||
160 | u32 type; | ||
161 | |||
162 | /* The capabilities this interface provides */ | ||
163 | u32 capability; | ||
164 | |||
165 | /* Private data for the current interface */ | ||
166 | struct acer_data data; | ||
167 | |||
168 | /* debugfs entries associated with this interface */ | ||
169 | struct acer_debug debug; | ||
170 | }; | ||
171 | |||
172 | /* The static interface pointer, points to the currently detected interface */ | ||
173 | static struct wmi_interface *interface; | ||
174 | |||
175 | /* | ||
176 | * Embedded Controller quirks | ||
177 | * Some laptops require us to directly access the EC to either enable or query | ||
178 | * features that are not available through WMI. | ||
179 | */ | ||
180 | |||
181 | struct quirk_entry { | ||
182 | u8 wireless; | ||
183 | u8 mailled; | ||
184 | s8 brightness; | ||
185 | u8 bluetooth; | ||
186 | }; | ||
187 | |||
188 | static struct quirk_entry *quirks; | ||
189 | |||
190 | static void set_quirks(void) | ||
191 | { | ||
192 | if (!interface) | ||
193 | return; | ||
194 | |||
195 | if (quirks->mailled) | ||
196 | interface->capability |= ACER_CAP_MAILLED; | ||
197 | |||
198 | if (quirks->brightness) | ||
199 | interface->capability |= ACER_CAP_BRIGHTNESS; | ||
200 | } | ||
201 | |||
202 | static int dmi_matched(const struct dmi_system_id *dmi) | ||
203 | { | ||
204 | quirks = dmi->driver_data; | ||
205 | return 0; | ||
206 | } | ||
207 | |||
208 | static struct quirk_entry quirk_unknown = { | ||
209 | }; | ||
210 | |||
211 | static struct quirk_entry quirk_acer_aspire_1520 = { | ||
212 | .brightness = -1, | ||
213 | }; | ||
214 | |||
215 | static struct quirk_entry quirk_acer_travelmate_2490 = { | ||
216 | .mailled = 1, | ||
217 | }; | ||
218 | |||
219 | /* This AMW0 laptop has no bluetooth */ | ||
220 | static struct quirk_entry quirk_medion_md_98300 = { | ||
221 | .wireless = 1, | ||
222 | }; | ||
223 | |||
224 | static struct quirk_entry quirk_fujitsu_amilo_li_1718 = { | ||
225 | .wireless = 2, | ||
226 | }; | ||
227 | |||
228 | static struct dmi_system_id acer_quirks[] = { | ||
229 | { | ||
230 | .callback = dmi_matched, | ||
231 | .ident = "Acer Aspire 1360", | ||
232 | .matches = { | ||
233 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
234 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1360"), | ||
235 | }, | ||
236 | .driver_data = &quirk_acer_aspire_1520, | ||
237 | }, | ||
238 | { | ||
239 | .callback = dmi_matched, | ||
240 | .ident = "Acer Aspire 1520", | ||
241 | .matches = { | ||
242 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
243 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1520"), | ||
244 | }, | ||
245 | .driver_data = &quirk_acer_aspire_1520, | ||
246 | }, | ||
247 | { | ||
248 | .callback = dmi_matched, | ||
249 | .ident = "Acer Aspire 3100", | ||
250 | .matches = { | ||
251 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
252 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 3100"), | ||
253 | }, | ||
254 | .driver_data = &quirk_acer_travelmate_2490, | ||
255 | }, | ||
256 | { | ||
257 | .callback = dmi_matched, | ||
258 | .ident = "Acer Aspire 3610", | ||
259 | .matches = { | ||
260 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
261 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 3610"), | ||
262 | }, | ||
263 | .driver_data = &quirk_acer_travelmate_2490, | ||
264 | }, | ||
265 | { | ||
266 | .callback = dmi_matched, | ||
267 | .ident = "Acer Aspire 5100", | ||
268 | .matches = { | ||
269 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
270 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5100"), | ||
271 | }, | ||
272 | .driver_data = &quirk_acer_travelmate_2490, | ||
273 | }, | ||
274 | { | ||
275 | .callback = dmi_matched, | ||
276 | .ident = "Acer Aspire 5610", | ||
277 | .matches = { | ||
278 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
279 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5610"), | ||
280 | }, | ||
281 | .driver_data = &quirk_acer_travelmate_2490, | ||
282 | }, | ||
283 | { | ||
284 | .callback = dmi_matched, | ||
285 | .ident = "Acer Aspire 5630", | ||
286 | .matches = { | ||
287 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
288 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5630"), | ||
289 | }, | ||
290 | .driver_data = &quirk_acer_travelmate_2490, | ||
291 | }, | ||
292 | { | ||
293 | .callback = dmi_matched, | ||
294 | .ident = "Acer Aspire 5650", | ||
295 | .matches = { | ||
296 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
297 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5650"), | ||
298 | }, | ||
299 | .driver_data = &quirk_acer_travelmate_2490, | ||
300 | }, | ||
301 | { | ||
302 | .callback = dmi_matched, | ||
303 | .ident = "Acer Aspire 5680", | ||
304 | .matches = { | ||
305 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
306 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5680"), | ||
307 | }, | ||
308 | .driver_data = &quirk_acer_travelmate_2490, | ||
309 | }, | ||
310 | { | ||
311 | .callback = dmi_matched, | ||
312 | .ident = "Acer Aspire 9110", | ||
313 | .matches = { | ||
314 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
315 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 9110"), | ||
316 | }, | ||
317 | .driver_data = &quirk_acer_travelmate_2490, | ||
318 | }, | ||
319 | { | ||
320 | .callback = dmi_matched, | ||
321 | .ident = "Acer TravelMate 2490", | ||
322 | .matches = { | ||
323 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
324 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2490"), | ||
325 | }, | ||
326 | .driver_data = &quirk_acer_travelmate_2490, | ||
327 | }, | ||
328 | { | ||
329 | .callback = dmi_matched, | ||
330 | .ident = "Acer TravelMate 4200", | ||
331 | .matches = { | ||
332 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
333 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 4200"), | ||
334 | }, | ||
335 | .driver_data = &quirk_acer_travelmate_2490, | ||
336 | }, | ||
337 | { | ||
338 | .callback = dmi_matched, | ||
339 | .ident = "Fujitsu Siemens Amilo Li 1718", | ||
340 | .matches = { | ||
341 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), | ||
342 | DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Li 1718"), | ||
343 | }, | ||
344 | .driver_data = &quirk_fujitsu_amilo_li_1718, | ||
345 | }, | ||
346 | { | ||
347 | .callback = dmi_matched, | ||
348 | .ident = "Medion MD 98300", | ||
349 | .matches = { | ||
350 | DMI_MATCH(DMI_SYS_VENDOR, "MEDION"), | ||
351 | DMI_MATCH(DMI_PRODUCT_NAME, "WAM2030"), | ||
352 | }, | ||
353 | .driver_data = &quirk_medion_md_98300, | ||
354 | }, | ||
355 | {} | ||
356 | }; | ||
357 | |||
358 | /* Find which quirks are needed for a particular vendor/ model pair */ | ||
359 | static void find_quirks(void) | ||
360 | { | ||
361 | if (!force_series) { | ||
362 | dmi_check_system(acer_quirks); | ||
363 | } else if (force_series == 2490) { | ||
364 | quirks = &quirk_acer_travelmate_2490; | ||
365 | } | ||
366 | |||
367 | if (quirks == NULL) | ||
368 | quirks = &quirk_unknown; | ||
369 | |||
370 | set_quirks(); | ||
371 | } | ||
372 | |||
373 | /* | ||
374 | * General interface convenience methods | ||
375 | */ | ||
376 | |||
377 | static bool has_cap(u32 cap) | ||
378 | { | ||
379 | if ((interface->capability & cap) != 0) | ||
380 | return 1; | ||
381 | |||
382 | return 0; | ||
383 | } | ||
384 | |||
385 | /* | ||
386 | * AMW0 (V1) interface | ||
387 | */ | ||
388 | struct wmab_args { | ||
389 | u32 eax; | ||
390 | u32 ebx; | ||
391 | u32 ecx; | ||
392 | u32 edx; | ||
393 | }; | ||
394 | |||
395 | struct wmab_ret { | ||
396 | u32 eax; | ||
397 | u32 ebx; | ||
398 | u32 ecx; | ||
399 | u32 edx; | ||
400 | u32 eex; | ||
401 | }; | ||
402 | |||
403 | static acpi_status wmab_execute(struct wmab_args *regbuf, | ||
404 | struct acpi_buffer *result) | ||
405 | { | ||
406 | struct acpi_buffer input; | ||
407 | acpi_status status; | ||
408 | input.length = sizeof(struct wmab_args); | ||
409 | input.pointer = (u8 *)regbuf; | ||
410 | |||
411 | status = wmi_evaluate_method(AMW0_GUID1, 1, 1, &input, result); | ||
412 | |||
413 | return status; | ||
414 | } | ||
415 | |||
416 | static acpi_status AMW0_get_u32(u32 *value, u32 cap, | ||
417 | struct wmi_interface *iface) | ||
418 | { | ||
419 | int err; | ||
420 | u8 result; | ||
421 | |||
422 | switch (cap) { | ||
423 | case ACER_CAP_MAILLED: | ||
424 | switch (quirks->mailled) { | ||
425 | default: | ||
426 | err = ec_read(0xA, &result); | ||
427 | if (err) | ||
428 | return AE_ERROR; | ||
429 | *value = (result >> 7) & 0x1; | ||
430 | return AE_OK; | ||
431 | } | ||
432 | break; | ||
433 | case ACER_CAP_WIRELESS: | ||
434 | switch (quirks->wireless) { | ||
435 | case 1: | ||
436 | err = ec_read(0x7B, &result); | ||
437 | if (err) | ||
438 | return AE_ERROR; | ||
439 | *value = result & 0x1; | ||
440 | return AE_OK; | ||
441 | case 2: | ||
442 | err = ec_read(0x71, &result); | ||
443 | if (err) | ||
444 | return AE_ERROR; | ||
445 | *value = result & 0x1; | ||
446 | return AE_OK; | ||
447 | default: | ||
448 | err = ec_read(0xA, &result); | ||
449 | if (err) | ||
450 | return AE_ERROR; | ||
451 | *value = (result >> 2) & 0x1; | ||
452 | return AE_OK; | ||
453 | } | ||
454 | break; | ||
455 | case ACER_CAP_BLUETOOTH: | ||
456 | switch (quirks->bluetooth) { | ||
457 | default: | ||
458 | err = ec_read(0xA, &result); | ||
459 | if (err) | ||
460 | return AE_ERROR; | ||
461 | *value = (result >> 4) & 0x1; | ||
462 | return AE_OK; | ||
463 | } | ||
464 | break; | ||
465 | case ACER_CAP_BRIGHTNESS: | ||
466 | switch (quirks->brightness) { | ||
467 | default: | ||
468 | err = ec_read(0x83, &result); | ||
469 | if (err) | ||
470 | return AE_ERROR; | ||
471 | *value = result; | ||
472 | return AE_OK; | ||
473 | } | ||
474 | break; | ||
475 | default: | ||
476 | return AE_ERROR; | ||
477 | } | ||
478 | return AE_OK; | ||
479 | } | ||
480 | |||
481 | static acpi_status AMW0_set_u32(u32 value, u32 cap, struct wmi_interface *iface) | ||
482 | { | ||
483 | struct wmab_args args; | ||
484 | |||
485 | args.eax = ACER_AMW0_WRITE; | ||
486 | args.ebx = value ? (1<<8) : 0; | ||
487 | args.ecx = args.edx = 0; | ||
488 | |||
489 | switch (cap) { | ||
490 | case ACER_CAP_MAILLED: | ||
491 | if (value > 1) | ||
492 | return AE_BAD_PARAMETER; | ||
493 | args.ebx |= ACER_AMW0_MAILLED_MASK; | ||
494 | break; | ||
495 | case ACER_CAP_WIRELESS: | ||
496 | if (value > 1) | ||
497 | return AE_BAD_PARAMETER; | ||
498 | args.ebx |= ACER_AMW0_WIRELESS_MASK; | ||
499 | break; | ||
500 | case ACER_CAP_BLUETOOTH: | ||
501 | if (value > 1) | ||
502 | return AE_BAD_PARAMETER; | ||
503 | args.ebx |= ACER_AMW0_BLUETOOTH_MASK; | ||
504 | break; | ||
505 | case ACER_CAP_BRIGHTNESS: | ||
506 | if (value > max_brightness) | ||
507 | return AE_BAD_PARAMETER; | ||
508 | switch (quirks->brightness) { | ||
509 | default: | ||
510 | return ec_write(0x83, value); | ||
511 | break; | ||
512 | } | ||
513 | default: | ||
514 | return AE_ERROR; | ||
515 | } | ||
516 | |||
517 | /* Actually do the set */ | ||
518 | return wmab_execute(&args, NULL); | ||
519 | } | ||
520 | |||
521 | static acpi_status AMW0_find_mailled(void) | ||
522 | { | ||
523 | struct wmab_args args; | ||
524 | struct wmab_ret ret; | ||
525 | acpi_status status = AE_OK; | ||
526 | struct acpi_buffer out = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
527 | union acpi_object *obj; | ||
528 | |||
529 | args.eax = 0x86; | ||
530 | args.ebx = args.ecx = args.edx = 0; | ||
531 | |||
532 | status = wmab_execute(&args, &out); | ||
533 | if (ACPI_FAILURE(status)) | ||
534 | return status; | ||
535 | |||
536 | obj = (union acpi_object *) out.pointer; | ||
537 | if (obj && obj->type == ACPI_TYPE_BUFFER && | ||
538 | obj->buffer.length == sizeof(struct wmab_ret)) { | ||
539 | ret = *((struct wmab_ret *) obj->buffer.pointer); | ||
540 | } else { | ||
541 | return AE_ERROR; | ||
542 | } | ||
543 | |||
544 | if (ret.eex & 0x1) | ||
545 | interface->capability |= ACER_CAP_MAILLED; | ||
546 | |||
547 | kfree(out.pointer); | ||
548 | |||
549 | return AE_OK; | ||
550 | } | ||
551 | |||
552 | static acpi_status AMW0_set_capabilities(void) | ||
553 | { | ||
554 | struct wmab_args args; | ||
555 | struct wmab_ret ret; | ||
556 | acpi_status status = AE_OK; | ||
557 | struct acpi_buffer out = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
558 | union acpi_object *obj; | ||
559 | |||
560 | /* | ||
561 | * On laptops with this strange GUID (non Acer), normal probing doesn't | ||
562 | * work. | ||
563 | */ | ||
564 | if (wmi_has_guid(AMW0_GUID2)) { | ||
565 | interface->capability |= ACER_CAP_WIRELESS; | ||
566 | return AE_OK; | ||
567 | } | ||
568 | |||
569 | args.eax = ACER_AMW0_WRITE; | ||
570 | args.ecx = args.edx = 0; | ||
571 | |||
572 | args.ebx = 0xa2 << 8; | ||
573 | args.ebx |= ACER_AMW0_WIRELESS_MASK; | ||
574 | |||
575 | status = wmab_execute(&args, &out); | ||
576 | if (ACPI_FAILURE(status)) | ||
577 | return status; | ||
578 | |||
579 | obj = (union acpi_object *) out.pointer; | ||
580 | if (obj && obj->type == ACPI_TYPE_BUFFER && | ||
581 | obj->buffer.length == sizeof(struct wmab_ret)) { | ||
582 | ret = *((struct wmab_ret *) obj->buffer.pointer); | ||
583 | } else { | ||
584 | return AE_ERROR; | ||
585 | } | ||
586 | |||
587 | if (ret.eax & 0x1) | ||
588 | interface->capability |= ACER_CAP_WIRELESS; | ||
589 | |||
590 | args.ebx = 2 << 8; | ||
591 | args.ebx |= ACER_AMW0_BLUETOOTH_MASK; | ||
592 | |||
593 | status = wmab_execute(&args, &out); | ||
594 | if (ACPI_FAILURE(status)) | ||
595 | return status; | ||
596 | |||
597 | obj = (union acpi_object *) out.pointer; | ||
598 | if (obj && obj->type == ACPI_TYPE_BUFFER | ||
599 | && obj->buffer.length == sizeof(struct wmab_ret)) { | ||
600 | ret = *((struct wmab_ret *) obj->buffer.pointer); | ||
601 | } else { | ||
602 | return AE_ERROR; | ||
603 | } | ||
604 | |||
605 | if (ret.eax & 0x1) | ||
606 | interface->capability |= ACER_CAP_BLUETOOTH; | ||
607 | |||
608 | kfree(out.pointer); | ||
609 | |||
610 | /* | ||
611 | * This appears to be safe to enable, since all Wistron based laptops | ||
612 | * appear to use the same EC register for brightness, even if they | ||
613 | * differ for wireless, etc | ||
614 | */ | ||
615 | if (quirks->brightness >= 0) | ||
616 | interface->capability |= ACER_CAP_BRIGHTNESS; | ||
617 | |||
618 | return AE_OK; | ||
619 | } | ||
620 | |||
621 | static struct wmi_interface AMW0_interface = { | ||
622 | .type = ACER_AMW0, | ||
623 | }; | ||
624 | |||
625 | static struct wmi_interface AMW0_V2_interface = { | ||
626 | .type = ACER_AMW0_V2, | ||
627 | }; | ||
628 | |||
629 | /* | ||
630 | * New interface (The WMID interface) | ||
631 | */ | ||
632 | static acpi_status | ||
633 | WMI_execute_u32(u32 method_id, u32 in, u32 *out) | ||
634 | { | ||
635 | struct acpi_buffer input = { (acpi_size) sizeof(u32), (void *)(&in) }; | ||
636 | struct acpi_buffer result = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
637 | union acpi_object *obj; | ||
638 | u32 tmp; | ||
639 | acpi_status status; | ||
640 | |||
641 | status = wmi_evaluate_method(WMID_GUID1, 1, method_id, &input, &result); | ||
642 | |||
643 | if (ACPI_FAILURE(status)) | ||
644 | return status; | ||
645 | |||
646 | obj = (union acpi_object *) result.pointer; | ||
647 | if (obj && obj->type == ACPI_TYPE_BUFFER && | ||
648 | obj->buffer.length == sizeof(u32)) { | ||
649 | tmp = *((u32 *) obj->buffer.pointer); | ||
650 | } else { | ||
651 | tmp = 0; | ||
652 | } | ||
653 | |||
654 | if (out) | ||
655 | *out = tmp; | ||
656 | |||
657 | kfree(result.pointer); | ||
658 | |||
659 | return status; | ||
660 | } | ||
661 | |||
662 | static acpi_status WMID_get_u32(u32 *value, u32 cap, | ||
663 | struct wmi_interface *iface) | ||
664 | { | ||
665 | acpi_status status; | ||
666 | u8 tmp; | ||
667 | u32 result, method_id = 0; | ||
668 | |||
669 | switch (cap) { | ||
670 | case ACER_CAP_WIRELESS: | ||
671 | method_id = ACER_WMID_GET_WIRELESS_METHODID; | ||
672 | break; | ||
673 | case ACER_CAP_BLUETOOTH: | ||
674 | method_id = ACER_WMID_GET_BLUETOOTH_METHODID; | ||
675 | break; | ||
676 | case ACER_CAP_BRIGHTNESS: | ||
677 | method_id = ACER_WMID_GET_BRIGHTNESS_METHODID; | ||
678 | break; | ||
679 | case ACER_CAP_THREEG: | ||
680 | method_id = ACER_WMID_GET_THREEG_METHODID; | ||
681 | break; | ||
682 | case ACER_CAP_MAILLED: | ||
683 | if (quirks->mailled == 1) { | ||
684 | ec_read(0x9f, &tmp); | ||
685 | *value = tmp & 0x1; | ||
686 | return 0; | ||
687 | } | ||
688 | default: | ||
689 | return AE_ERROR; | ||
690 | } | ||
691 | status = WMI_execute_u32(method_id, 0, &result); | ||
692 | |||
693 | if (ACPI_SUCCESS(status)) | ||
694 | *value = (u8)result; | ||
695 | |||
696 | return status; | ||
697 | } | ||
698 | |||
699 | static acpi_status WMID_set_u32(u32 value, u32 cap, struct wmi_interface *iface) | ||
700 | { | ||
701 | u32 method_id = 0; | ||
702 | char param; | ||
703 | |||
704 | switch (cap) { | ||
705 | case ACER_CAP_BRIGHTNESS: | ||
706 | if (value > max_brightness) | ||
707 | return AE_BAD_PARAMETER; | ||
708 | method_id = ACER_WMID_SET_BRIGHTNESS_METHODID; | ||
709 | break; | ||
710 | case ACER_CAP_WIRELESS: | ||
711 | if (value > 1) | ||
712 | return AE_BAD_PARAMETER; | ||
713 | method_id = ACER_WMID_SET_WIRELESS_METHODID; | ||
714 | break; | ||
715 | case ACER_CAP_BLUETOOTH: | ||
716 | if (value > 1) | ||
717 | return AE_BAD_PARAMETER; | ||
718 | method_id = ACER_WMID_SET_BLUETOOTH_METHODID; | ||
719 | break; | ||
720 | case ACER_CAP_THREEG: | ||
721 | if (value > 1) | ||
722 | return AE_BAD_PARAMETER; | ||
723 | method_id = ACER_WMID_SET_THREEG_METHODID; | ||
724 | break; | ||
725 | case ACER_CAP_MAILLED: | ||
726 | if (value > 1) | ||
727 | return AE_BAD_PARAMETER; | ||
728 | if (quirks->mailled == 1) { | ||
729 | param = value ? 0x92 : 0x93; | ||
730 | i8042_command(¶m, 0x1059); | ||
731 | return 0; | ||
732 | } | ||
733 | break; | ||
734 | default: | ||
735 | return AE_ERROR; | ||
736 | } | ||
737 | return WMI_execute_u32(method_id, (u32)value, NULL); | ||
738 | } | ||
739 | |||
740 | static acpi_status WMID_set_capabilities(void) | ||
741 | { | ||
742 | struct acpi_buffer out = {ACPI_ALLOCATE_BUFFER, NULL}; | ||
743 | union acpi_object *obj; | ||
744 | acpi_status status; | ||
745 | u32 devices; | ||
746 | |||
747 | status = wmi_query_block(WMID_GUID2, 1, &out); | ||
748 | if (ACPI_FAILURE(status)) | ||
749 | return status; | ||
750 | |||
751 | obj = (union acpi_object *) out.pointer; | ||
752 | if (obj && obj->type == ACPI_TYPE_BUFFER && | ||
753 | obj->buffer.length == sizeof(u32)) { | ||
754 | devices = *((u32 *) obj->buffer.pointer); | ||
755 | } else { | ||
756 | return AE_ERROR; | ||
757 | } | ||
758 | |||
759 | /* Not sure on the meaning of the relevant bits yet to detect these */ | ||
760 | interface->capability |= ACER_CAP_WIRELESS; | ||
761 | interface->capability |= ACER_CAP_THREEG; | ||
762 | |||
763 | /* WMID always provides brightness methods */ | ||
764 | interface->capability |= ACER_CAP_BRIGHTNESS; | ||
765 | |||
766 | if (devices & 0x10) | ||
767 | interface->capability |= ACER_CAP_BLUETOOTH; | ||
768 | |||
769 | if (!(devices & 0x20)) | ||
770 | max_brightness = 0x9; | ||
771 | |||
772 | return status; | ||
773 | } | ||
774 | |||
775 | static struct wmi_interface wmid_interface = { | ||
776 | .type = ACER_WMID, | ||
777 | }; | ||
778 | |||
779 | /* | ||
780 | * Generic Device (interface-independent) | ||
781 | */ | ||
782 | |||
783 | static acpi_status get_u32(u32 *value, u32 cap) | ||
784 | { | ||
785 | acpi_status status = AE_ERROR; | ||
786 | |||
787 | switch (interface->type) { | ||
788 | case ACER_AMW0: | ||
789 | status = AMW0_get_u32(value, cap, interface); | ||
790 | break; | ||
791 | case ACER_AMW0_V2: | ||
792 | if (cap == ACER_CAP_MAILLED) { | ||
793 | status = AMW0_get_u32(value, cap, interface); | ||
794 | break; | ||
795 | } | ||
796 | case ACER_WMID: | ||
797 | status = WMID_get_u32(value, cap, interface); | ||
798 | break; | ||
799 | } | ||
800 | |||
801 | return status; | ||
802 | } | ||
803 | |||
804 | static acpi_status set_u32(u32 value, u32 cap) | ||
805 | { | ||
806 | acpi_status status; | ||
807 | |||
808 | if (interface->capability & cap) { | ||
809 | switch (interface->type) { | ||
810 | case ACER_AMW0: | ||
811 | return AMW0_set_u32(value, cap, interface); | ||
812 | case ACER_AMW0_V2: | ||
813 | if (cap == ACER_CAP_MAILLED) | ||
814 | return AMW0_set_u32(value, cap, interface); | ||
815 | |||
816 | /* | ||
817 | * On some models, some WMID methods don't toggle | ||
818 | * properly. For those cases, we want to run the AMW0 | ||
819 | * method afterwards to be certain we've really toggled | ||
820 | * the device state. | ||
821 | */ | ||
822 | if (cap == ACER_CAP_WIRELESS || | ||
823 | cap == ACER_CAP_BLUETOOTH) { | ||
824 | status = WMID_set_u32(value, cap, interface); | ||
825 | if (ACPI_FAILURE(status)) | ||
826 | return status; | ||
827 | |||
828 | return AMW0_set_u32(value, cap, interface); | ||
829 | } | ||
830 | case ACER_WMID: | ||
831 | return WMID_set_u32(value, cap, interface); | ||
832 | default: | ||
833 | return AE_BAD_PARAMETER; | ||
834 | } | ||
835 | } | ||
836 | return AE_BAD_PARAMETER; | ||
837 | } | ||
838 | |||
839 | static void __init acer_commandline_init(void) | ||
840 | { | ||
841 | /* | ||
842 | * These will all fail silently if the value given is invalid, or the | ||
843 | * capability isn't available on the given interface | ||
844 | */ | ||
845 | set_u32(mailled, ACER_CAP_MAILLED); | ||
846 | set_u32(threeg, ACER_CAP_THREEG); | ||
847 | set_u32(brightness, ACER_CAP_BRIGHTNESS); | ||
848 | } | ||
849 | |||
850 | /* | ||
851 | * LED device (Mail LED only, no other LEDs known yet) | ||
852 | */ | ||
853 | static void mail_led_set(struct led_classdev *led_cdev, | ||
854 | enum led_brightness value) | ||
855 | { | ||
856 | set_u32(value, ACER_CAP_MAILLED); | ||
857 | } | ||
858 | |||
859 | static struct led_classdev mail_led = { | ||
860 | .name = "acer-wmi::mail", | ||
861 | .brightness_set = mail_led_set, | ||
862 | }; | ||
863 | |||
864 | static int __devinit acer_led_init(struct device *dev) | ||
865 | { | ||
866 | return led_classdev_register(dev, &mail_led); | ||
867 | } | ||
868 | |||
869 | static void acer_led_exit(void) | ||
870 | { | ||
871 | led_classdev_unregister(&mail_led); | ||
872 | } | ||
873 | |||
874 | /* | ||
875 | * Backlight device | ||
876 | */ | ||
877 | static struct backlight_device *acer_backlight_device; | ||
878 | |||
879 | static int read_brightness(struct backlight_device *bd) | ||
880 | { | ||
881 | u32 value; | ||
882 | get_u32(&value, ACER_CAP_BRIGHTNESS); | ||
883 | return value; | ||
884 | } | ||
885 | |||
886 | static int update_bl_status(struct backlight_device *bd) | ||
887 | { | ||
888 | int intensity = bd->props.brightness; | ||
889 | |||
890 | if (bd->props.power != FB_BLANK_UNBLANK) | ||
891 | intensity = 0; | ||
892 | if (bd->props.fb_blank != FB_BLANK_UNBLANK) | ||
893 | intensity = 0; | ||
894 | |||
895 | set_u32(intensity, ACER_CAP_BRIGHTNESS); | ||
896 | |||
897 | return 0; | ||
898 | } | ||
899 | |||
900 | static struct backlight_ops acer_bl_ops = { | ||
901 | .get_brightness = read_brightness, | ||
902 | .update_status = update_bl_status, | ||
903 | }; | ||
904 | |||
905 | static int __devinit acer_backlight_init(struct device *dev) | ||
906 | { | ||
907 | struct backlight_device *bd; | ||
908 | |||
909 | bd = backlight_device_register("acer-wmi", dev, NULL, &acer_bl_ops); | ||
910 | if (IS_ERR(bd)) { | ||
911 | printk(ACER_ERR "Could not register Acer backlight device\n"); | ||
912 | acer_backlight_device = NULL; | ||
913 | return PTR_ERR(bd); | ||
914 | } | ||
915 | |||
916 | acer_backlight_device = bd; | ||
917 | |||
918 | bd->props.power = FB_BLANK_UNBLANK; | ||
919 | bd->props.brightness = max_brightness; | ||
920 | bd->props.max_brightness = max_brightness; | ||
921 | backlight_update_status(bd); | ||
922 | return 0; | ||
923 | } | ||
924 | |||
925 | static void acer_backlight_exit(void) | ||
926 | { | ||
927 | backlight_device_unregister(acer_backlight_device); | ||
928 | } | ||
929 | |||
930 | /* | ||
931 | * Rfkill devices | ||
932 | */ | ||
933 | static void acer_rfkill_update(struct work_struct *ignored); | ||
934 | static DECLARE_DELAYED_WORK(acer_rfkill_work, acer_rfkill_update); | ||
935 | static void acer_rfkill_update(struct work_struct *ignored) | ||
936 | { | ||
937 | u32 state; | ||
938 | acpi_status status; | ||
939 | |||
940 | status = get_u32(&state, ACER_CAP_WIRELESS); | ||
941 | if (ACPI_SUCCESS(status)) | ||
942 | rfkill_force_state(wireless_rfkill, state ? | ||
943 | RFKILL_STATE_UNBLOCKED : RFKILL_STATE_SOFT_BLOCKED); | ||
944 | |||
945 | if (has_cap(ACER_CAP_BLUETOOTH)) { | ||
946 | status = get_u32(&state, ACER_CAP_BLUETOOTH); | ||
947 | if (ACPI_SUCCESS(status)) | ||
948 | rfkill_force_state(bluetooth_rfkill, state ? | ||
949 | RFKILL_STATE_UNBLOCKED : | ||
950 | RFKILL_STATE_SOFT_BLOCKED); | ||
951 | } | ||
952 | |||
953 | schedule_delayed_work(&acer_rfkill_work, round_jiffies_relative(HZ)); | ||
954 | } | ||
955 | |||
956 | static int acer_rfkill_set(void *data, enum rfkill_state state) | ||
957 | { | ||
958 | acpi_status status; | ||
959 | u32 *cap = data; | ||
960 | status = set_u32((u32) (state == RFKILL_STATE_UNBLOCKED), *cap); | ||
961 | if (ACPI_FAILURE(status)) | ||
962 | return -ENODEV; | ||
963 | return 0; | ||
964 | } | ||
965 | |||
966 | static struct rfkill * acer_rfkill_register(struct device *dev, | ||
967 | enum rfkill_type type, char *name, u32 cap) | ||
968 | { | ||
969 | int err; | ||
970 | u32 state; | ||
971 | u32 *data; | ||
972 | struct rfkill *rfkill_dev; | ||
973 | |||
974 | rfkill_dev = rfkill_allocate(dev, type); | ||
975 | if (!rfkill_dev) | ||
976 | return ERR_PTR(-ENOMEM); | ||
977 | rfkill_dev->name = name; | ||
978 | get_u32(&state, cap); | ||
979 | rfkill_dev->state = state ? RFKILL_STATE_UNBLOCKED : | ||
980 | RFKILL_STATE_SOFT_BLOCKED; | ||
981 | data = kzalloc(sizeof(u32), GFP_KERNEL); | ||
982 | if (!data) { | ||
983 | rfkill_free(rfkill_dev); | ||
984 | return ERR_PTR(-ENOMEM); | ||
985 | } | ||
986 | *data = cap; | ||
987 | rfkill_dev->data = data; | ||
988 | rfkill_dev->toggle_radio = acer_rfkill_set; | ||
989 | rfkill_dev->user_claim_unsupported = 1; | ||
990 | |||
991 | err = rfkill_register(rfkill_dev); | ||
992 | if (err) { | ||
993 | kfree(rfkill_dev->data); | ||
994 | rfkill_free(rfkill_dev); | ||
995 | return ERR_PTR(err); | ||
996 | } | ||
997 | return rfkill_dev; | ||
998 | } | ||
999 | |||
1000 | static int acer_rfkill_init(struct device *dev) | ||
1001 | { | ||
1002 | wireless_rfkill = acer_rfkill_register(dev, RFKILL_TYPE_WLAN, | ||
1003 | "acer-wireless", ACER_CAP_WIRELESS); | ||
1004 | if (IS_ERR(wireless_rfkill)) | ||
1005 | return PTR_ERR(wireless_rfkill); | ||
1006 | |||
1007 | if (has_cap(ACER_CAP_BLUETOOTH)) { | ||
1008 | bluetooth_rfkill = acer_rfkill_register(dev, | ||
1009 | RFKILL_TYPE_BLUETOOTH, "acer-bluetooth", | ||
1010 | ACER_CAP_BLUETOOTH); | ||
1011 | if (IS_ERR(bluetooth_rfkill)) { | ||
1012 | kfree(wireless_rfkill->data); | ||
1013 | rfkill_unregister(wireless_rfkill); | ||
1014 | return PTR_ERR(bluetooth_rfkill); | ||
1015 | } | ||
1016 | } | ||
1017 | |||
1018 | schedule_delayed_work(&acer_rfkill_work, round_jiffies_relative(HZ)); | ||
1019 | |||
1020 | return 0; | ||
1021 | } | ||
1022 | |||
1023 | static void acer_rfkill_exit(void) | ||
1024 | { | ||
1025 | cancel_delayed_work_sync(&acer_rfkill_work); | ||
1026 | kfree(wireless_rfkill->data); | ||
1027 | rfkill_unregister(wireless_rfkill); | ||
1028 | if (has_cap(ACER_CAP_BLUETOOTH)) { | ||
1029 | kfree(wireless_rfkill->data); | ||
1030 | rfkill_unregister(bluetooth_rfkill); | ||
1031 | } | ||
1032 | return; | ||
1033 | } | ||
1034 | |||
1035 | /* | ||
1036 | * sysfs interface | ||
1037 | */ | ||
1038 | static ssize_t show_bool_threeg(struct device *dev, | ||
1039 | struct device_attribute *attr, char *buf) | ||
1040 | { | ||
1041 | u32 result; \ | ||
1042 | acpi_status status = get_u32(&result, ACER_CAP_THREEG); | ||
1043 | if (ACPI_SUCCESS(status)) | ||
1044 | return sprintf(buf, "%u\n", result); | ||
1045 | return sprintf(buf, "Read error\n"); | ||
1046 | } | ||
1047 | |||
1048 | static ssize_t set_bool_threeg(struct device *dev, | ||
1049 | struct device_attribute *attr, const char *buf, size_t count) | ||
1050 | { | ||
1051 | u32 tmp = simple_strtoul(buf, NULL, 10); | ||
1052 | acpi_status status = set_u32(tmp, ACER_CAP_THREEG); | ||
1053 | if (ACPI_FAILURE(status)) | ||
1054 | return -EINVAL; | ||
1055 | return count; | ||
1056 | } | ||
1057 | static DEVICE_ATTR(threeg, S_IWUGO | S_IRUGO | S_IWUSR, show_bool_threeg, | ||
1058 | set_bool_threeg); | ||
1059 | |||
1060 | static ssize_t show_interface(struct device *dev, struct device_attribute *attr, | ||
1061 | char *buf) | ||
1062 | { | ||
1063 | switch (interface->type) { | ||
1064 | case ACER_AMW0: | ||
1065 | return sprintf(buf, "AMW0\n"); | ||
1066 | case ACER_AMW0_V2: | ||
1067 | return sprintf(buf, "AMW0 v2\n"); | ||
1068 | case ACER_WMID: | ||
1069 | return sprintf(buf, "WMID\n"); | ||
1070 | default: | ||
1071 | return sprintf(buf, "Error!\n"); | ||
1072 | } | ||
1073 | } | ||
1074 | |||
1075 | static DEVICE_ATTR(interface, S_IWUGO | S_IRUGO | S_IWUSR, | ||
1076 | show_interface, NULL); | ||
1077 | |||
1078 | /* | ||
1079 | * debugfs functions | ||
1080 | */ | ||
1081 | static u32 get_wmid_devices(void) | ||
1082 | { | ||
1083 | struct acpi_buffer out = {ACPI_ALLOCATE_BUFFER, NULL}; | ||
1084 | union acpi_object *obj; | ||
1085 | acpi_status status; | ||
1086 | |||
1087 | status = wmi_query_block(WMID_GUID2, 1, &out); | ||
1088 | if (ACPI_FAILURE(status)) | ||
1089 | return 0; | ||
1090 | |||
1091 | obj = (union acpi_object *) out.pointer; | ||
1092 | if (obj && obj->type == ACPI_TYPE_BUFFER && | ||
1093 | obj->buffer.length == sizeof(u32)) { | ||
1094 | return *((u32 *) obj->buffer.pointer); | ||
1095 | } else { | ||
1096 | return 0; | ||
1097 | } | ||
1098 | } | ||
1099 | |||
1100 | /* | ||
1101 | * Platform device | ||
1102 | */ | ||
1103 | static int __devinit acer_platform_probe(struct platform_device *device) | ||
1104 | { | ||
1105 | int err; | ||
1106 | |||
1107 | if (has_cap(ACER_CAP_MAILLED)) { | ||
1108 | err = acer_led_init(&device->dev); | ||
1109 | if (err) | ||
1110 | goto error_mailled; | ||
1111 | } | ||
1112 | |||
1113 | if (has_cap(ACER_CAP_BRIGHTNESS)) { | ||
1114 | err = acer_backlight_init(&device->dev); | ||
1115 | if (err) | ||
1116 | goto error_brightness; | ||
1117 | } | ||
1118 | |||
1119 | err = acer_rfkill_init(&device->dev); | ||
1120 | |||
1121 | return err; | ||
1122 | |||
1123 | error_brightness: | ||
1124 | acer_led_exit(); | ||
1125 | error_mailled: | ||
1126 | return err; | ||
1127 | } | ||
1128 | |||
1129 | static int acer_platform_remove(struct platform_device *device) | ||
1130 | { | ||
1131 | if (has_cap(ACER_CAP_MAILLED)) | ||
1132 | acer_led_exit(); | ||
1133 | if (has_cap(ACER_CAP_BRIGHTNESS)) | ||
1134 | acer_backlight_exit(); | ||
1135 | |||
1136 | acer_rfkill_exit(); | ||
1137 | return 0; | ||
1138 | } | ||
1139 | |||
1140 | static int acer_platform_suspend(struct platform_device *dev, | ||
1141 | pm_message_t state) | ||
1142 | { | ||
1143 | u32 value; | ||
1144 | struct acer_data *data = &interface->data; | ||
1145 | |||
1146 | if (!data) | ||
1147 | return -ENOMEM; | ||
1148 | |||
1149 | if (has_cap(ACER_CAP_MAILLED)) { | ||
1150 | get_u32(&value, ACER_CAP_MAILLED); | ||
1151 | data->mailled = value; | ||
1152 | } | ||
1153 | |||
1154 | if (has_cap(ACER_CAP_BRIGHTNESS)) { | ||
1155 | get_u32(&value, ACER_CAP_BRIGHTNESS); | ||
1156 | data->brightness = value; | ||
1157 | } | ||
1158 | |||
1159 | return 0; | ||
1160 | } | ||
1161 | |||
1162 | static int acer_platform_resume(struct platform_device *device) | ||
1163 | { | ||
1164 | struct acer_data *data = &interface->data; | ||
1165 | |||
1166 | if (!data) | ||
1167 | return -ENOMEM; | ||
1168 | |||
1169 | if (has_cap(ACER_CAP_MAILLED)) | ||
1170 | set_u32(data->mailled, ACER_CAP_MAILLED); | ||
1171 | |||
1172 | if (has_cap(ACER_CAP_BRIGHTNESS)) | ||
1173 | set_u32(data->brightness, ACER_CAP_BRIGHTNESS); | ||
1174 | |||
1175 | return 0; | ||
1176 | } | ||
1177 | |||
1178 | static struct platform_driver acer_platform_driver = { | ||
1179 | .driver = { | ||
1180 | .name = "acer-wmi", | ||
1181 | .owner = THIS_MODULE, | ||
1182 | }, | ||
1183 | .probe = acer_platform_probe, | ||
1184 | .remove = acer_platform_remove, | ||
1185 | .suspend = acer_platform_suspend, | ||
1186 | .resume = acer_platform_resume, | ||
1187 | }; | ||
1188 | |||
1189 | static struct platform_device *acer_platform_device; | ||
1190 | |||
1191 | static int remove_sysfs(struct platform_device *device) | ||
1192 | { | ||
1193 | if (has_cap(ACER_CAP_THREEG)) | ||
1194 | device_remove_file(&device->dev, &dev_attr_threeg); | ||
1195 | |||
1196 | device_remove_file(&device->dev, &dev_attr_interface); | ||
1197 | |||
1198 | return 0; | ||
1199 | } | ||
1200 | |||
1201 | static int create_sysfs(void) | ||
1202 | { | ||
1203 | int retval = -ENOMEM; | ||
1204 | |||
1205 | if (has_cap(ACER_CAP_THREEG)) { | ||
1206 | retval = device_create_file(&acer_platform_device->dev, | ||
1207 | &dev_attr_threeg); | ||
1208 | if (retval) | ||
1209 | goto error_sysfs; | ||
1210 | } | ||
1211 | |||
1212 | retval = device_create_file(&acer_platform_device->dev, | ||
1213 | &dev_attr_interface); | ||
1214 | if (retval) | ||
1215 | goto error_sysfs; | ||
1216 | |||
1217 | return 0; | ||
1218 | |||
1219 | error_sysfs: | ||
1220 | remove_sysfs(acer_platform_device); | ||
1221 | return retval; | ||
1222 | } | ||
1223 | |||
1224 | static void remove_debugfs(void) | ||
1225 | { | ||
1226 | debugfs_remove(interface->debug.devices); | ||
1227 | debugfs_remove(interface->debug.root); | ||
1228 | } | ||
1229 | |||
1230 | static int create_debugfs(void) | ||
1231 | { | ||
1232 | interface->debug.root = debugfs_create_dir("acer-wmi", NULL); | ||
1233 | if (!interface->debug.root) { | ||
1234 | printk(ACER_ERR "Failed to create debugfs directory"); | ||
1235 | return -ENOMEM; | ||
1236 | } | ||
1237 | |||
1238 | interface->debug.devices = debugfs_create_u32("devices", S_IRUGO, | ||
1239 | interface->debug.root, | ||
1240 | &interface->debug.wmid_devices); | ||
1241 | if (!interface->debug.devices) | ||
1242 | goto error_debugfs; | ||
1243 | |||
1244 | return 0; | ||
1245 | |||
1246 | error_debugfs: | ||
1247 | remove_debugfs(); | ||
1248 | return -ENOMEM; | ||
1249 | } | ||
1250 | |||
1251 | static int __init acer_wmi_init(void) | ||
1252 | { | ||
1253 | int err; | ||
1254 | |||
1255 | printk(ACER_INFO "Acer Laptop ACPI-WMI Extras\n"); | ||
1256 | |||
1257 | find_quirks(); | ||
1258 | |||
1259 | /* | ||
1260 | * Detect which ACPI-WMI interface we're using. | ||
1261 | */ | ||
1262 | if (wmi_has_guid(AMW0_GUID1) && wmi_has_guid(WMID_GUID1)) | ||
1263 | interface = &AMW0_V2_interface; | ||
1264 | |||
1265 | if (!wmi_has_guid(AMW0_GUID1) && wmi_has_guid(WMID_GUID1)) | ||
1266 | interface = &wmid_interface; | ||
1267 | |||
1268 | if (wmi_has_guid(WMID_GUID2) && interface) { | ||
1269 | if (ACPI_FAILURE(WMID_set_capabilities())) { | ||
1270 | printk(ACER_ERR "Unable to detect available WMID " | ||
1271 | "devices\n"); | ||
1272 | return -ENODEV; | ||
1273 | } | ||
1274 | } else if (!wmi_has_guid(WMID_GUID2) && interface) { | ||
1275 | printk(ACER_ERR "No WMID device detection method found\n"); | ||
1276 | return -ENODEV; | ||
1277 | } | ||
1278 | |||
1279 | if (wmi_has_guid(AMW0_GUID1) && !wmi_has_guid(WMID_GUID1)) { | ||
1280 | interface = &AMW0_interface; | ||
1281 | |||
1282 | if (ACPI_FAILURE(AMW0_set_capabilities())) { | ||
1283 | printk(ACER_ERR "Unable to detect available AMW0 " | ||
1284 | "devices\n"); | ||
1285 | return -ENODEV; | ||
1286 | } | ||
1287 | } | ||
1288 | |||
1289 | if (wmi_has_guid(AMW0_GUID1)) | ||
1290 | AMW0_find_mailled(); | ||
1291 | |||
1292 | if (!interface) { | ||
1293 | printk(ACER_ERR "No or unsupported WMI interface, unable to " | ||
1294 | "load\n"); | ||
1295 | return -ENODEV; | ||
1296 | } | ||
1297 | |||
1298 | set_quirks(); | ||
1299 | |||
1300 | if (!acpi_video_backlight_support() && has_cap(ACER_CAP_BRIGHTNESS)) { | ||
1301 | interface->capability &= ~ACER_CAP_BRIGHTNESS; | ||
1302 | printk(ACER_INFO "Brightness must be controlled by " | ||
1303 | "generic video driver\n"); | ||
1304 | } | ||
1305 | |||
1306 | if (platform_driver_register(&acer_platform_driver)) { | ||
1307 | printk(ACER_ERR "Unable to register platform driver.\n"); | ||
1308 | goto error_platform_register; | ||
1309 | } | ||
1310 | acer_platform_device = platform_device_alloc("acer-wmi", -1); | ||
1311 | platform_device_add(acer_platform_device); | ||
1312 | |||
1313 | err = create_sysfs(); | ||
1314 | if (err) | ||
1315 | return err; | ||
1316 | |||
1317 | if (wmi_has_guid(WMID_GUID2)) { | ||
1318 | interface->debug.wmid_devices = get_wmid_devices(); | ||
1319 | err = create_debugfs(); | ||
1320 | if (err) | ||
1321 | return err; | ||
1322 | } | ||
1323 | |||
1324 | /* Override any initial settings with values from the commandline */ | ||
1325 | acer_commandline_init(); | ||
1326 | |||
1327 | return 0; | ||
1328 | |||
1329 | error_platform_register: | ||
1330 | return -ENODEV; | ||
1331 | } | ||
1332 | |||
1333 | static void __exit acer_wmi_exit(void) | ||
1334 | { | ||
1335 | remove_sysfs(acer_platform_device); | ||
1336 | remove_debugfs(); | ||
1337 | platform_device_del(acer_platform_device); | ||
1338 | platform_driver_unregister(&acer_platform_driver); | ||
1339 | |||
1340 | printk(ACER_INFO "Acer Laptop WMI Extras unloaded\n"); | ||
1341 | return; | ||
1342 | } | ||
1343 | |||
1344 | module_init(acer_wmi_init); | ||
1345 | module_exit(acer_wmi_exit); | ||
diff --git a/drivers/platform/x86/asus-laptop.c b/drivers/platform/x86/asus-laptop.c new file mode 100644 index 000000000000..8fb8b3591048 --- /dev/null +++ b/drivers/platform/x86/asus-laptop.c | |||
@@ -0,0 +1,1266 @@ | |||
1 | /* | ||
2 | * asus-laptop.c - Asus Laptop Support | ||
3 | * | ||
4 | * | ||
5 | * Copyright (C) 2002-2005 Julien Lerouge, 2003-2006 Karol Kozimor | ||
6 | * Copyright (C) 2006-2007 Corentin Chary | ||
7 | * | ||
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. | ||
12 | * | ||
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. | ||
17 | * | ||
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 | ||
21 | * | ||
22 | * | ||
23 | * The development page for this driver is located at | ||
24 | * http://sourceforge.net/projects/acpi4asus/ | ||
25 | * | ||
26 | * Credits: | ||
27 | * Pontus Fuchs - Helper functions, cleanup | ||
28 | * Johann Wiesner - Small compile fixes | ||
29 | * John Belmonte - ACPI code for Toshiba laptop was a good starting point. | ||
30 | * Eric Burghard - LED display support for W1N | ||
31 | * Josh Green - Light Sens support | ||
32 | * Thomas Tuttle - His first patch for led support was very helpfull | ||
33 | * Sam Lin - GPS support | ||
34 | */ | ||
35 | |||
36 | #include <linux/kernel.h> | ||
37 | #include <linux/module.h> | ||
38 | #include <linux/init.h> | ||
39 | #include <linux/types.h> | ||
40 | #include <linux/err.h> | ||
41 | #include <linux/proc_fs.h> | ||
42 | #include <linux/backlight.h> | ||
43 | #include <linux/fb.h> | ||
44 | #include <linux/leds.h> | ||
45 | #include <linux/platform_device.h> | ||
46 | #include <acpi/acpi_drivers.h> | ||
47 | #include <acpi/acpi_bus.h> | ||
48 | #include <asm/uaccess.h> | ||
49 | |||
50 | #define ASUS_LAPTOP_VERSION "0.42" | ||
51 | |||
52 | #define ASUS_HOTK_NAME "Asus Laptop Support" | ||
53 | #define ASUS_HOTK_CLASS "hotkey" | ||
54 | #define ASUS_HOTK_DEVICE_NAME "Hotkey" | ||
55 | #define ASUS_HOTK_FILE "asus-laptop" | ||
56 | #define ASUS_HOTK_PREFIX "\\_SB.ATKD." | ||
57 | |||
58 | /* | ||
59 | * Some events we use, same for all Asus | ||
60 | */ | ||
61 | #define ATKD_BR_UP 0x10 | ||
62 | #define ATKD_BR_DOWN 0x20 | ||
63 | #define ATKD_LCD_ON 0x33 | ||
64 | #define ATKD_LCD_OFF 0x34 | ||
65 | |||
66 | /* | ||
67 | * Known bits returned by \_SB.ATKD.HWRS | ||
68 | */ | ||
69 | #define WL_HWRS 0x80 | ||
70 | #define BT_HWRS 0x100 | ||
71 | |||
72 | /* | ||
73 | * Flags for hotk status | ||
74 | * WL_ON and BT_ON are also used for wireless_status() | ||
75 | */ | ||
76 | #define WL_ON 0x01 //internal Wifi | ||
77 | #define BT_ON 0x02 //internal Bluetooth | ||
78 | #define MLED_ON 0x04 //mail LED | ||
79 | #define TLED_ON 0x08 //touchpad LED | ||
80 | #define RLED_ON 0x10 //Record LED | ||
81 | #define PLED_ON 0x20 //Phone LED | ||
82 | #define GLED_ON 0x40 //Gaming LED | ||
83 | #define LCD_ON 0x80 //LCD backlight | ||
84 | #define GPS_ON 0x100 //GPS | ||
85 | |||
86 | #define ASUS_LOG ASUS_HOTK_FILE ": " | ||
87 | #define ASUS_ERR KERN_ERR ASUS_LOG | ||
88 | #define ASUS_WARNING KERN_WARNING ASUS_LOG | ||
89 | #define ASUS_NOTICE KERN_NOTICE ASUS_LOG | ||
90 | #define ASUS_INFO KERN_INFO ASUS_LOG | ||
91 | #define ASUS_DEBUG KERN_DEBUG ASUS_LOG | ||
92 | |||
93 | MODULE_AUTHOR("Julien Lerouge, Karol Kozimor, Corentin Chary"); | ||
94 | MODULE_DESCRIPTION(ASUS_HOTK_NAME); | ||
95 | MODULE_LICENSE("GPL"); | ||
96 | |||
97 | /* WAPF defines the behavior of the Fn+Fx wlan key | ||
98 | * The significance of values is yet to be found, but | ||
99 | * most of the time: | ||
100 | * 0x0 will do nothing | ||
101 | * 0x1 will allow to control the device with Fn+Fx key. | ||
102 | * 0x4 will send an ACPI event (0x88) while pressing the Fn+Fx key | ||
103 | * 0x5 like 0x1 or 0x4 | ||
104 | * So, if something doesn't work as you want, just try other values =) | ||
105 | */ | ||
106 | static uint wapf = 1; | ||
107 | module_param(wapf, uint, 0644); | ||
108 | MODULE_PARM_DESC(wapf, "WAPF value"); | ||
109 | |||
110 | #define ASUS_HANDLE(object, paths...) \ | ||
111 | static acpi_handle object##_handle = NULL; \ | ||
112 | static char *object##_paths[] = { paths } | ||
113 | |||
114 | /* LED */ | ||
115 | ASUS_HANDLE(mled_set, ASUS_HOTK_PREFIX "MLED"); | ||
116 | ASUS_HANDLE(tled_set, ASUS_HOTK_PREFIX "TLED"); | ||
117 | ASUS_HANDLE(rled_set, ASUS_HOTK_PREFIX "RLED"); /* W1JC */ | ||
118 | ASUS_HANDLE(pled_set, ASUS_HOTK_PREFIX "PLED"); /* A7J */ | ||
119 | ASUS_HANDLE(gled_set, ASUS_HOTK_PREFIX "GLED"); /* G1, G2 (probably) */ | ||
120 | |||
121 | /* LEDD */ | ||
122 | ASUS_HANDLE(ledd_set, ASUS_HOTK_PREFIX "SLCM"); | ||
123 | |||
124 | /* Bluetooth and WLAN | ||
125 | * WLED and BLED are not handled like other XLED, because in some dsdt | ||
126 | * they also control the WLAN/Bluetooth device. | ||
127 | */ | ||
128 | ASUS_HANDLE(wl_switch, ASUS_HOTK_PREFIX "WLED"); | ||
129 | ASUS_HANDLE(bt_switch, ASUS_HOTK_PREFIX "BLED"); | ||
130 | ASUS_HANDLE(wireless_status, ASUS_HOTK_PREFIX "RSTS"); /* All new models */ | ||
131 | |||
132 | /* Brightness */ | ||
133 | ASUS_HANDLE(brightness_set, ASUS_HOTK_PREFIX "SPLV"); | ||
134 | ASUS_HANDLE(brightness_get, ASUS_HOTK_PREFIX "GPLV"); | ||
135 | |||
136 | /* Backlight */ | ||
137 | ASUS_HANDLE(lcd_switch, "\\_SB.PCI0.SBRG.EC0._Q10", /* All new models */ | ||
138 | "\\_SB.PCI0.ISA.EC0._Q10", /* A1x */ | ||
139 | "\\_SB.PCI0.PX40.ECD0._Q10", /* L3C */ | ||
140 | "\\_SB.PCI0.PX40.EC0.Q10", /* M1A */ | ||
141 | "\\_SB.PCI0.LPCB.EC0._Q10", /* P30 */ | ||
142 | "\\_SB.PCI0.LPCB.EC0._Q0E", /* P30/P35 */ | ||
143 | "\\_SB.PCI0.PX40.Q10", /* S1x */ | ||
144 | "\\Q10"); /* A2x, L2D, L3D, M2E */ | ||
145 | |||
146 | /* Display */ | ||
147 | ASUS_HANDLE(display_set, ASUS_HOTK_PREFIX "SDSP"); | ||
148 | ASUS_HANDLE(display_get, "\\_SB.PCI0.P0P1.VGA.GETD", /* A6B, A6K A6R A7D F3JM L4R M6R A3G | ||
149 | M6A M6V VX-1 V6J V6V W3Z */ | ||
150 | "\\_SB.PCI0.P0P2.VGA.GETD", /* A3E A4K, A4D A4L A6J A7J A8J Z71V M9V | ||
151 | S5A M5A z33A W1Jc W2V G1 */ | ||
152 | "\\_SB.PCI0.P0P3.VGA.GETD", /* A6V A6Q */ | ||
153 | "\\_SB.PCI0.P0PA.VGA.GETD", /* A6T, A6M */ | ||
154 | "\\_SB.PCI0.PCI1.VGAC.NMAP", /* L3C */ | ||
155 | "\\_SB.PCI0.VGA.GETD", /* Z96F */ | ||
156 | "\\ACTD", /* A2D */ | ||
157 | "\\ADVG", /* A4G Z71A W1N W5A W5F M2N M3N M5N M6N S1N S5N */ | ||
158 | "\\DNXT", /* P30 */ | ||
159 | "\\INFB", /* A2H D1 L2D L3D L3H L2E L5D L5C M1A M2E L4L W3V */ | ||
160 | "\\SSTE"); /* A3F A6F A3N A3L M6N W3N W6A */ | ||
161 | |||
162 | ASUS_HANDLE(ls_switch, ASUS_HOTK_PREFIX "ALSC"); /* Z71A Z71V */ | ||
163 | ASUS_HANDLE(ls_level, ASUS_HOTK_PREFIX "ALSL"); /* Z71A Z71V */ | ||
164 | |||
165 | /* GPS */ | ||
166 | /* R2H use different handle for GPS on/off */ | ||
167 | ASUS_HANDLE(gps_on, ASUS_HOTK_PREFIX "SDON"); /* R2H */ | ||
168 | ASUS_HANDLE(gps_off, ASUS_HOTK_PREFIX "SDOF"); /* R2H */ | ||
169 | ASUS_HANDLE(gps_status, ASUS_HOTK_PREFIX "GPST"); | ||
170 | |||
171 | /* | ||
172 | * This is the main structure, we can use it to store anything interesting | ||
173 | * about the hotk device | ||
174 | */ | ||
175 | struct asus_hotk { | ||
176 | char *name; //laptop name | ||
177 | struct acpi_device *device; //the device we are in | ||
178 | acpi_handle handle; //the handle of the hotk device | ||
179 | char status; //status of the hotk, for LEDs, ... | ||
180 | u32 ledd_status; //status of the LED display | ||
181 | u8 light_level; //light sensor level | ||
182 | u8 light_switch; //light sensor switch value | ||
183 | u16 event_count[128]; //count for each event TODO make this better | ||
184 | }; | ||
185 | |||
186 | /* | ||
187 | * This header is made available to allow proper configuration given model, | ||
188 | * revision number , ... this info cannot go in struct asus_hotk because it is | ||
189 | * available before the hotk | ||
190 | */ | ||
191 | static struct acpi_table_header *asus_info; | ||
192 | |||
193 | /* The actual device the driver binds to */ | ||
194 | static struct asus_hotk *hotk; | ||
195 | |||
196 | /* | ||
197 | * The hotkey driver declaration | ||
198 | */ | ||
199 | static const struct acpi_device_id asus_device_ids[] = { | ||
200 | {"ATK0100", 0}, | ||
201 | {"", 0}, | ||
202 | }; | ||
203 | MODULE_DEVICE_TABLE(acpi, asus_device_ids); | ||
204 | |||
205 | static int asus_hotk_add(struct acpi_device *device); | ||
206 | static int asus_hotk_remove(struct acpi_device *device, int type); | ||
207 | static struct acpi_driver asus_hotk_driver = { | ||
208 | .name = ASUS_HOTK_NAME, | ||
209 | .class = ASUS_HOTK_CLASS, | ||
210 | .ids = asus_device_ids, | ||
211 | .ops = { | ||
212 | .add = asus_hotk_add, | ||
213 | .remove = asus_hotk_remove, | ||
214 | }, | ||
215 | }; | ||
216 | |||
217 | /* The backlight device /sys/class/backlight */ | ||
218 | static struct backlight_device *asus_backlight_device; | ||
219 | |||
220 | /* | ||
221 | * The backlight class declaration | ||
222 | */ | ||
223 | static int read_brightness(struct backlight_device *bd); | ||
224 | static int update_bl_status(struct backlight_device *bd); | ||
225 | static struct backlight_ops asusbl_ops = { | ||
226 | .get_brightness = read_brightness, | ||
227 | .update_status = update_bl_status, | ||
228 | }; | ||
229 | |||
230 | /* These functions actually update the LED's, and are called from a | ||
231 | * workqueue. By doing this as separate work rather than when the LED | ||
232 | * subsystem asks, we avoid messing with the Asus ACPI stuff during a | ||
233 | * potentially bad time, such as a timer interrupt. */ | ||
234 | static struct workqueue_struct *led_workqueue; | ||
235 | |||
236 | #define ASUS_LED(object, ledname) \ | ||
237 | static void object##_led_set(struct led_classdev *led_cdev, \ | ||
238 | enum led_brightness value); \ | ||
239 | static void object##_led_update(struct work_struct *ignored); \ | ||
240 | static int object##_led_wk; \ | ||
241 | static DECLARE_WORK(object##_led_work, object##_led_update); \ | ||
242 | static struct led_classdev object##_led = { \ | ||
243 | .name = "asus::" ledname, \ | ||
244 | .brightness_set = object##_led_set, \ | ||
245 | } | ||
246 | |||
247 | ASUS_LED(mled, "mail"); | ||
248 | ASUS_LED(tled, "touchpad"); | ||
249 | ASUS_LED(rled, "record"); | ||
250 | ASUS_LED(pled, "phone"); | ||
251 | ASUS_LED(gled, "gaming"); | ||
252 | |||
253 | /* | ||
254 | * This function evaluates an ACPI method, given an int as parameter, the | ||
255 | * method is searched within the scope of the handle, can be NULL. The output | ||
256 | * of the method is written is output, which can also be NULL | ||
257 | * | ||
258 | * returns 0 if write is successful, -1 else. | ||
259 | */ | ||
260 | static int write_acpi_int(acpi_handle handle, const char *method, int val, | ||
261 | struct acpi_buffer *output) | ||
262 | { | ||
263 | struct acpi_object_list params; //list of input parameters (an int here) | ||
264 | union acpi_object in_obj; //the only param we use | ||
265 | acpi_status status; | ||
266 | |||
267 | if (!handle) | ||
268 | return 0; | ||
269 | |||
270 | params.count = 1; | ||
271 | params.pointer = &in_obj; | ||
272 | in_obj.type = ACPI_TYPE_INTEGER; | ||
273 | in_obj.integer.value = val; | ||
274 | |||
275 | status = acpi_evaluate_object(handle, (char *)method, ¶ms, output); | ||
276 | if (status == AE_OK) | ||
277 | return 0; | ||
278 | else | ||
279 | return -1; | ||
280 | } | ||
281 | |||
282 | static int read_wireless_status(int mask) | ||
283 | { | ||
284 | unsigned long long status; | ||
285 | acpi_status rv = AE_OK; | ||
286 | |||
287 | if (!wireless_status_handle) | ||
288 | return (hotk->status & mask) ? 1 : 0; | ||
289 | |||
290 | rv = acpi_evaluate_integer(wireless_status_handle, NULL, NULL, &status); | ||
291 | if (ACPI_FAILURE(rv)) | ||
292 | printk(ASUS_WARNING "Error reading Wireless status\n"); | ||
293 | else | ||
294 | return (status & mask) ? 1 : 0; | ||
295 | |||
296 | return (hotk->status & mask) ? 1 : 0; | ||
297 | } | ||
298 | |||
299 | static int read_gps_status(void) | ||
300 | { | ||
301 | unsigned long long status; | ||
302 | acpi_status rv = AE_OK; | ||
303 | |||
304 | rv = acpi_evaluate_integer(gps_status_handle, NULL, NULL, &status); | ||
305 | if (ACPI_FAILURE(rv)) | ||
306 | printk(ASUS_WARNING "Error reading GPS status\n"); | ||
307 | else | ||
308 | return status ? 1 : 0; | ||
309 | |||
310 | return (hotk->status & GPS_ON) ? 1 : 0; | ||
311 | } | ||
312 | |||
313 | /* Generic LED functions */ | ||
314 | static int read_status(int mask) | ||
315 | { | ||
316 | /* There is a special method for both wireless devices */ | ||
317 | if (mask == BT_ON || mask == WL_ON) | ||
318 | return read_wireless_status(mask); | ||
319 | else if (mask == GPS_ON) | ||
320 | return read_gps_status(); | ||
321 | |||
322 | return (hotk->status & mask) ? 1 : 0; | ||
323 | } | ||
324 | |||
325 | static void write_status(acpi_handle handle, int out, int mask) | ||
326 | { | ||
327 | hotk->status = (out) ? (hotk->status | mask) : (hotk->status & ~mask); | ||
328 | |||
329 | switch (mask) { | ||
330 | case MLED_ON: | ||
331 | out = !(out & 0x1); | ||
332 | break; | ||
333 | case GLED_ON: | ||
334 | out = (out & 0x1) + 1; | ||
335 | break; | ||
336 | case GPS_ON: | ||
337 | handle = (out) ? gps_on_handle : gps_off_handle; | ||
338 | out = 0x02; | ||
339 | break; | ||
340 | default: | ||
341 | out &= 0x1; | ||
342 | break; | ||
343 | } | ||
344 | |||
345 | if (write_acpi_int(handle, NULL, out, NULL)) | ||
346 | printk(ASUS_WARNING " write failed %x\n", mask); | ||
347 | } | ||
348 | |||
349 | /* /sys/class/led handlers */ | ||
350 | #define ASUS_LED_HANDLER(object, mask) \ | ||
351 | static void object##_led_set(struct led_classdev *led_cdev, \ | ||
352 | enum led_brightness value) \ | ||
353 | { \ | ||
354 | object##_led_wk = (value > 0) ? 1 : 0; \ | ||
355 | queue_work(led_workqueue, &object##_led_work); \ | ||
356 | } \ | ||
357 | static void object##_led_update(struct work_struct *ignored) \ | ||
358 | { \ | ||
359 | int value = object##_led_wk; \ | ||
360 | write_status(object##_set_handle, value, (mask)); \ | ||
361 | } | ||
362 | |||
363 | ASUS_LED_HANDLER(mled, MLED_ON); | ||
364 | ASUS_LED_HANDLER(pled, PLED_ON); | ||
365 | ASUS_LED_HANDLER(rled, RLED_ON); | ||
366 | ASUS_LED_HANDLER(tled, TLED_ON); | ||
367 | ASUS_LED_HANDLER(gled, GLED_ON); | ||
368 | |||
369 | static int get_lcd_state(void) | ||
370 | { | ||
371 | return read_status(LCD_ON); | ||
372 | } | ||
373 | |||
374 | static int set_lcd_state(int value) | ||
375 | { | ||
376 | int lcd = 0; | ||
377 | acpi_status status = 0; | ||
378 | |||
379 | lcd = value ? 1 : 0; | ||
380 | |||
381 | if (lcd == get_lcd_state()) | ||
382 | return 0; | ||
383 | |||
384 | if (lcd_switch_handle) { | ||
385 | status = acpi_evaluate_object(lcd_switch_handle, | ||
386 | NULL, NULL, NULL); | ||
387 | |||
388 | if (ACPI_FAILURE(status)) | ||
389 | printk(ASUS_WARNING "Error switching LCD\n"); | ||
390 | } | ||
391 | |||
392 | write_status(NULL, lcd, LCD_ON); | ||
393 | return 0; | ||
394 | } | ||
395 | |||
396 | static void lcd_blank(int blank) | ||
397 | { | ||
398 | struct backlight_device *bd = asus_backlight_device; | ||
399 | |||
400 | if (bd) { | ||
401 | bd->props.power = blank; | ||
402 | backlight_update_status(bd); | ||
403 | } | ||
404 | } | ||
405 | |||
406 | static int read_brightness(struct backlight_device *bd) | ||
407 | { | ||
408 | unsigned long long value; | ||
409 | acpi_status rv = AE_OK; | ||
410 | |||
411 | rv = acpi_evaluate_integer(brightness_get_handle, NULL, NULL, &value); | ||
412 | if (ACPI_FAILURE(rv)) | ||
413 | printk(ASUS_WARNING "Error reading brightness\n"); | ||
414 | |||
415 | return value; | ||
416 | } | ||
417 | |||
418 | static int set_brightness(struct backlight_device *bd, int value) | ||
419 | { | ||
420 | int ret = 0; | ||
421 | |||
422 | value = (0 < value) ? ((15 < value) ? 15 : value) : 0; | ||
423 | /* 0 <= value <= 15 */ | ||
424 | |||
425 | if (write_acpi_int(brightness_set_handle, NULL, value, NULL)) { | ||
426 | printk(ASUS_WARNING "Error changing brightness\n"); | ||
427 | ret = -EIO; | ||
428 | } | ||
429 | |||
430 | return ret; | ||
431 | } | ||
432 | |||
433 | static int update_bl_status(struct backlight_device *bd) | ||
434 | { | ||
435 | int rv; | ||
436 | int value = bd->props.brightness; | ||
437 | |||
438 | rv = set_brightness(bd, value); | ||
439 | if (rv) | ||
440 | return rv; | ||
441 | |||
442 | value = (bd->props.power == FB_BLANK_UNBLANK) ? 1 : 0; | ||
443 | return set_lcd_state(value); | ||
444 | } | ||
445 | |||
446 | /* | ||
447 | * Platform device handlers | ||
448 | */ | ||
449 | |||
450 | /* | ||
451 | * We write our info in page, we begin at offset off and cannot write more | ||
452 | * than count bytes. We set eof to 1 if we handle those 2 values. We return the | ||
453 | * number of bytes written in page | ||
454 | */ | ||
455 | static ssize_t show_infos(struct device *dev, | ||
456 | struct device_attribute *attr, char *page) | ||
457 | { | ||
458 | int len = 0; | ||
459 | unsigned long long temp; | ||
460 | char buf[16]; //enough for all info | ||
461 | acpi_status rv = AE_OK; | ||
462 | |||
463 | /* | ||
464 | * We use the easy way, we don't care of off and count, so we don't set eof | ||
465 | * to 1 | ||
466 | */ | ||
467 | |||
468 | len += sprintf(page, ASUS_HOTK_NAME " " ASUS_LAPTOP_VERSION "\n"); | ||
469 | len += sprintf(page + len, "Model reference : %s\n", hotk->name); | ||
470 | /* | ||
471 | * The SFUN method probably allows the original driver to get the list | ||
472 | * of features supported by a given model. For now, 0x0100 or 0x0800 | ||
473 | * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card. | ||
474 | * The significance of others is yet to be found. | ||
475 | */ | ||
476 | rv = acpi_evaluate_integer(hotk->handle, "SFUN", NULL, &temp); | ||
477 | if (!ACPI_FAILURE(rv)) | ||
478 | len += sprintf(page + len, "SFUN value : 0x%04x\n", | ||
479 | (uint) temp); | ||
480 | /* | ||
481 | * Another value for userspace: the ASYM method returns 0x02 for | ||
482 | * battery low and 0x04 for battery critical, its readings tend to be | ||
483 | * more accurate than those provided by _BST. | ||
484 | * Note: since not all the laptops provide this method, errors are | ||
485 | * silently ignored. | ||
486 | */ | ||
487 | rv = acpi_evaluate_integer(hotk->handle, "ASYM", NULL, &temp); | ||
488 | if (!ACPI_FAILURE(rv)) | ||
489 | len += sprintf(page + len, "ASYM value : 0x%04x\n", | ||
490 | (uint) temp); | ||
491 | if (asus_info) { | ||
492 | snprintf(buf, 16, "%d", asus_info->length); | ||
493 | len += sprintf(page + len, "DSDT length : %s\n", buf); | ||
494 | snprintf(buf, 16, "%d", asus_info->checksum); | ||
495 | len += sprintf(page + len, "DSDT checksum : %s\n", buf); | ||
496 | snprintf(buf, 16, "%d", asus_info->revision); | ||
497 | len += sprintf(page + len, "DSDT revision : %s\n", buf); | ||
498 | snprintf(buf, 7, "%s", asus_info->oem_id); | ||
499 | len += sprintf(page + len, "OEM id : %s\n", buf); | ||
500 | snprintf(buf, 9, "%s", asus_info->oem_table_id); | ||
501 | len += sprintf(page + len, "OEM table id : %s\n", buf); | ||
502 | snprintf(buf, 16, "%x", asus_info->oem_revision); | ||
503 | len += sprintf(page + len, "OEM revision : 0x%s\n", buf); | ||
504 | snprintf(buf, 5, "%s", asus_info->asl_compiler_id); | ||
505 | len += sprintf(page + len, "ASL comp vendor id : %s\n", buf); | ||
506 | snprintf(buf, 16, "%x", asus_info->asl_compiler_revision); | ||
507 | len += sprintf(page + len, "ASL comp revision : 0x%s\n", buf); | ||
508 | } | ||
509 | |||
510 | return len; | ||
511 | } | ||
512 | |||
513 | static int parse_arg(const char *buf, unsigned long count, int *val) | ||
514 | { | ||
515 | if (!count) | ||
516 | return 0; | ||
517 | if (count > 31) | ||
518 | return -EINVAL; | ||
519 | if (sscanf(buf, "%i", val) != 1) | ||
520 | return -EINVAL; | ||
521 | return count; | ||
522 | } | ||
523 | |||
524 | static ssize_t store_status(const char *buf, size_t count, | ||
525 | acpi_handle handle, int mask) | ||
526 | { | ||
527 | int rv, value; | ||
528 | int out = 0; | ||
529 | |||
530 | rv = parse_arg(buf, count, &value); | ||
531 | if (rv > 0) | ||
532 | out = value ? 1 : 0; | ||
533 | |||
534 | write_status(handle, out, mask); | ||
535 | |||
536 | return rv; | ||
537 | } | ||
538 | |||
539 | /* | ||
540 | * LEDD display | ||
541 | */ | ||
542 | static ssize_t show_ledd(struct device *dev, | ||
543 | struct device_attribute *attr, char *buf) | ||
544 | { | ||
545 | return sprintf(buf, "0x%08x\n", hotk->ledd_status); | ||
546 | } | ||
547 | |||
548 | static ssize_t store_ledd(struct device *dev, struct device_attribute *attr, | ||
549 | const char *buf, size_t count) | ||
550 | { | ||
551 | int rv, value; | ||
552 | |||
553 | rv = parse_arg(buf, count, &value); | ||
554 | if (rv > 0) { | ||
555 | if (write_acpi_int(ledd_set_handle, NULL, value, NULL)) | ||
556 | printk(ASUS_WARNING "LED display write failed\n"); | ||
557 | else | ||
558 | hotk->ledd_status = (u32) value; | ||
559 | } | ||
560 | return rv; | ||
561 | } | ||
562 | |||
563 | /* | ||
564 | * WLAN | ||
565 | */ | ||
566 | static ssize_t show_wlan(struct device *dev, | ||
567 | struct device_attribute *attr, char *buf) | ||
568 | { | ||
569 | return sprintf(buf, "%d\n", read_status(WL_ON)); | ||
570 | } | ||
571 | |||
572 | static ssize_t store_wlan(struct device *dev, struct device_attribute *attr, | ||
573 | const char *buf, size_t count) | ||
574 | { | ||
575 | return store_status(buf, count, wl_switch_handle, WL_ON); | ||
576 | } | ||
577 | |||
578 | /* | ||
579 | * Bluetooth | ||
580 | */ | ||
581 | static ssize_t show_bluetooth(struct device *dev, | ||
582 | struct device_attribute *attr, char *buf) | ||
583 | { | ||
584 | return sprintf(buf, "%d\n", read_status(BT_ON)); | ||
585 | } | ||
586 | |||
587 | static ssize_t store_bluetooth(struct device *dev, | ||
588 | struct device_attribute *attr, const char *buf, | ||
589 | size_t count) | ||
590 | { | ||
591 | return store_status(buf, count, bt_switch_handle, BT_ON); | ||
592 | } | ||
593 | |||
594 | /* | ||
595 | * Display | ||
596 | */ | ||
597 | static void set_display(int value) | ||
598 | { | ||
599 | /* no sanity check needed for now */ | ||
600 | if (write_acpi_int(display_set_handle, NULL, value, NULL)) | ||
601 | printk(ASUS_WARNING "Error setting display\n"); | ||
602 | return; | ||
603 | } | ||
604 | |||
605 | static int read_display(void) | ||
606 | { | ||
607 | unsigned long long value = 0; | ||
608 | acpi_status rv = AE_OK; | ||
609 | |||
610 | /* In most of the case, we know how to set the display, but sometime | ||
611 | we can't read it */ | ||
612 | if (display_get_handle) { | ||
613 | rv = acpi_evaluate_integer(display_get_handle, NULL, | ||
614 | NULL, &value); | ||
615 | if (ACPI_FAILURE(rv)) | ||
616 | printk(ASUS_WARNING "Error reading display status\n"); | ||
617 | } | ||
618 | |||
619 | value &= 0x0F; /* needed for some models, shouldn't hurt others */ | ||
620 | |||
621 | return value; | ||
622 | } | ||
623 | |||
624 | /* | ||
625 | * Now, *this* one could be more user-friendly, but so far, no-one has | ||
626 | * complained. The significance of bits is the same as in store_disp() | ||
627 | */ | ||
628 | static ssize_t show_disp(struct device *dev, | ||
629 | struct device_attribute *attr, char *buf) | ||
630 | { | ||
631 | return sprintf(buf, "%d\n", read_display()); | ||
632 | } | ||
633 | |||
634 | /* | ||
635 | * Experimental support for display switching. As of now: 1 should activate | ||
636 | * the LCD output, 2 should do for CRT, 4 for TV-Out and 8 for DVI. | ||
637 | * Any combination (bitwise) of these will suffice. I never actually tested 4 | ||
638 | * displays hooked up simultaneously, so be warned. See the acpi4asus README | ||
639 | * for more info. | ||
640 | */ | ||
641 | static ssize_t store_disp(struct device *dev, struct device_attribute *attr, | ||
642 | const char *buf, size_t count) | ||
643 | { | ||
644 | int rv, value; | ||
645 | |||
646 | rv = parse_arg(buf, count, &value); | ||
647 | if (rv > 0) | ||
648 | set_display(value); | ||
649 | return rv; | ||
650 | } | ||
651 | |||
652 | /* | ||
653 | * Light Sens | ||
654 | */ | ||
655 | static void set_light_sens_switch(int value) | ||
656 | { | ||
657 | if (write_acpi_int(ls_switch_handle, NULL, value, NULL)) | ||
658 | printk(ASUS_WARNING "Error setting light sensor switch\n"); | ||
659 | hotk->light_switch = value; | ||
660 | } | ||
661 | |||
662 | static ssize_t show_lssw(struct device *dev, | ||
663 | struct device_attribute *attr, char *buf) | ||
664 | { | ||
665 | return sprintf(buf, "%d\n", hotk->light_switch); | ||
666 | } | ||
667 | |||
668 | static ssize_t store_lssw(struct device *dev, struct device_attribute *attr, | ||
669 | const char *buf, size_t count) | ||
670 | { | ||
671 | int rv, value; | ||
672 | |||
673 | rv = parse_arg(buf, count, &value); | ||
674 | if (rv > 0) | ||
675 | set_light_sens_switch(value ? 1 : 0); | ||
676 | |||
677 | return rv; | ||
678 | } | ||
679 | |||
680 | static void set_light_sens_level(int value) | ||
681 | { | ||
682 | if (write_acpi_int(ls_level_handle, NULL, value, NULL)) | ||
683 | printk(ASUS_WARNING "Error setting light sensor level\n"); | ||
684 | hotk->light_level = value; | ||
685 | } | ||
686 | |||
687 | static ssize_t show_lslvl(struct device *dev, | ||
688 | struct device_attribute *attr, char *buf) | ||
689 | { | ||
690 | return sprintf(buf, "%d\n", hotk->light_level); | ||
691 | } | ||
692 | |||
693 | static ssize_t store_lslvl(struct device *dev, struct device_attribute *attr, | ||
694 | const char *buf, size_t count) | ||
695 | { | ||
696 | int rv, value; | ||
697 | |||
698 | rv = parse_arg(buf, count, &value); | ||
699 | if (rv > 0) { | ||
700 | value = (0 < value) ? ((15 < value) ? 15 : value) : 0; | ||
701 | /* 0 <= value <= 15 */ | ||
702 | set_light_sens_level(value); | ||
703 | } | ||
704 | |||
705 | return rv; | ||
706 | } | ||
707 | |||
708 | /* | ||
709 | * GPS | ||
710 | */ | ||
711 | static ssize_t show_gps(struct device *dev, | ||
712 | struct device_attribute *attr, char *buf) | ||
713 | { | ||
714 | return sprintf(buf, "%d\n", read_status(GPS_ON)); | ||
715 | } | ||
716 | |||
717 | static ssize_t store_gps(struct device *dev, struct device_attribute *attr, | ||
718 | const char *buf, size_t count) | ||
719 | { | ||
720 | return store_status(buf, count, NULL, GPS_ON); | ||
721 | } | ||
722 | |||
723 | static void asus_hotk_notify(acpi_handle handle, u32 event, void *data) | ||
724 | { | ||
725 | /* TODO Find a better way to handle events count. */ | ||
726 | if (!hotk) | ||
727 | return; | ||
728 | |||
729 | /* | ||
730 | * We need to tell the backlight device when the backlight power is | ||
731 | * switched | ||
732 | */ | ||
733 | if (event == ATKD_LCD_ON) { | ||
734 | write_status(NULL, 1, LCD_ON); | ||
735 | lcd_blank(FB_BLANK_UNBLANK); | ||
736 | } else if (event == ATKD_LCD_OFF) { | ||
737 | write_status(NULL, 0, LCD_ON); | ||
738 | lcd_blank(FB_BLANK_POWERDOWN); | ||
739 | } | ||
740 | |||
741 | acpi_bus_generate_proc_event(hotk->device, event, | ||
742 | hotk->event_count[event % 128]++); | ||
743 | |||
744 | return; | ||
745 | } | ||
746 | |||
747 | #define ASUS_CREATE_DEVICE_ATTR(_name) \ | ||
748 | struct device_attribute dev_attr_##_name = { \ | ||
749 | .attr = { \ | ||
750 | .name = __stringify(_name), \ | ||
751 | .mode = 0 }, \ | ||
752 | .show = NULL, \ | ||
753 | .store = NULL, \ | ||
754 | } | ||
755 | |||
756 | #define ASUS_SET_DEVICE_ATTR(_name, _mode, _show, _store) \ | ||
757 | do { \ | ||
758 | dev_attr_##_name.attr.mode = _mode; \ | ||
759 | dev_attr_##_name.show = _show; \ | ||
760 | dev_attr_##_name.store = _store; \ | ||
761 | } while(0) | ||
762 | |||
763 | static ASUS_CREATE_DEVICE_ATTR(infos); | ||
764 | static ASUS_CREATE_DEVICE_ATTR(wlan); | ||
765 | static ASUS_CREATE_DEVICE_ATTR(bluetooth); | ||
766 | static ASUS_CREATE_DEVICE_ATTR(display); | ||
767 | static ASUS_CREATE_DEVICE_ATTR(ledd); | ||
768 | static ASUS_CREATE_DEVICE_ATTR(ls_switch); | ||
769 | static ASUS_CREATE_DEVICE_ATTR(ls_level); | ||
770 | static ASUS_CREATE_DEVICE_ATTR(gps); | ||
771 | |||
772 | static struct attribute *asuspf_attributes[] = { | ||
773 | &dev_attr_infos.attr, | ||
774 | &dev_attr_wlan.attr, | ||
775 | &dev_attr_bluetooth.attr, | ||
776 | &dev_attr_display.attr, | ||
777 | &dev_attr_ledd.attr, | ||
778 | &dev_attr_ls_switch.attr, | ||
779 | &dev_attr_ls_level.attr, | ||
780 | &dev_attr_gps.attr, | ||
781 | NULL | ||
782 | }; | ||
783 | |||
784 | static struct attribute_group asuspf_attribute_group = { | ||
785 | .attrs = asuspf_attributes | ||
786 | }; | ||
787 | |||
788 | static struct platform_driver asuspf_driver = { | ||
789 | .driver = { | ||
790 | .name = ASUS_HOTK_FILE, | ||
791 | .owner = THIS_MODULE, | ||
792 | } | ||
793 | }; | ||
794 | |||
795 | static struct platform_device *asuspf_device; | ||
796 | |||
797 | static void asus_hotk_add_fs(void) | ||
798 | { | ||
799 | ASUS_SET_DEVICE_ATTR(infos, 0444, show_infos, NULL); | ||
800 | |||
801 | if (wl_switch_handle) | ||
802 | ASUS_SET_DEVICE_ATTR(wlan, 0644, show_wlan, store_wlan); | ||
803 | |||
804 | if (bt_switch_handle) | ||
805 | ASUS_SET_DEVICE_ATTR(bluetooth, 0644, | ||
806 | show_bluetooth, store_bluetooth); | ||
807 | |||
808 | if (display_set_handle && display_get_handle) | ||
809 | ASUS_SET_DEVICE_ATTR(display, 0644, show_disp, store_disp); | ||
810 | else if (display_set_handle) | ||
811 | ASUS_SET_DEVICE_ATTR(display, 0200, NULL, store_disp); | ||
812 | |||
813 | if (ledd_set_handle) | ||
814 | ASUS_SET_DEVICE_ATTR(ledd, 0644, show_ledd, store_ledd); | ||
815 | |||
816 | if (ls_switch_handle && ls_level_handle) { | ||
817 | ASUS_SET_DEVICE_ATTR(ls_level, 0644, show_lslvl, store_lslvl); | ||
818 | ASUS_SET_DEVICE_ATTR(ls_switch, 0644, show_lssw, store_lssw); | ||
819 | } | ||
820 | |||
821 | if (gps_status_handle && gps_on_handle && gps_off_handle) | ||
822 | ASUS_SET_DEVICE_ATTR(gps, 0644, show_gps, store_gps); | ||
823 | } | ||
824 | |||
825 | static int asus_handle_init(char *name, acpi_handle * handle, | ||
826 | char **paths, int num_paths) | ||
827 | { | ||
828 | int i; | ||
829 | acpi_status status; | ||
830 | |||
831 | for (i = 0; i < num_paths; i++) { | ||
832 | status = acpi_get_handle(NULL, paths[i], handle); | ||
833 | if (ACPI_SUCCESS(status)) | ||
834 | return 0; | ||
835 | } | ||
836 | |||
837 | *handle = NULL; | ||
838 | return -ENODEV; | ||
839 | } | ||
840 | |||
841 | #define ASUS_HANDLE_INIT(object) \ | ||
842 | asus_handle_init(#object, &object##_handle, object##_paths, \ | ||
843 | ARRAY_SIZE(object##_paths)) | ||
844 | |||
845 | /* | ||
846 | * This function is used to initialize the hotk with right values. In this | ||
847 | * method, we can make all the detection we want, and modify the hotk struct | ||
848 | */ | ||
849 | static int asus_hotk_get_info(void) | ||
850 | { | ||
851 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
852 | union acpi_object *model = NULL; | ||
853 | unsigned long long bsts_result, hwrs_result; | ||
854 | char *string = NULL; | ||
855 | acpi_status status; | ||
856 | |||
857 | /* | ||
858 | * Get DSDT headers early enough to allow for differentiating between | ||
859 | * models, but late enough to allow acpi_bus_register_driver() to fail | ||
860 | * before doing anything ACPI-specific. Should we encounter a machine, | ||
861 | * which needs special handling (i.e. its hotkey device has a different | ||
862 | * HID), this bit will be moved. A global variable asus_info contains | ||
863 | * the DSDT header. | ||
864 | */ | ||
865 | status = acpi_get_table(ACPI_SIG_DSDT, 1, &asus_info); | ||
866 | if (ACPI_FAILURE(status)) | ||
867 | printk(ASUS_WARNING "Couldn't get the DSDT table header\n"); | ||
868 | |||
869 | /* We have to write 0 on init this far for all ASUS models */ | ||
870 | if (write_acpi_int(hotk->handle, "INIT", 0, &buffer)) { | ||
871 | printk(ASUS_ERR "Hotkey initialization failed\n"); | ||
872 | return -ENODEV; | ||
873 | } | ||
874 | |||
875 | /* This needs to be called for some laptops to init properly */ | ||
876 | status = | ||
877 | acpi_evaluate_integer(hotk->handle, "BSTS", NULL, &bsts_result); | ||
878 | if (ACPI_FAILURE(status)) | ||
879 | printk(ASUS_WARNING "Error calling BSTS\n"); | ||
880 | else if (bsts_result) | ||
881 | printk(ASUS_NOTICE "BSTS called, 0x%02x returned\n", | ||
882 | (uint) bsts_result); | ||
883 | |||
884 | /* This too ... */ | ||
885 | write_acpi_int(hotk->handle, "CWAP", wapf, NULL); | ||
886 | |||
887 | /* | ||
888 | * Try to match the object returned by INIT to the specific model. | ||
889 | * Handle every possible object (or the lack of thereof) the DSDT | ||
890 | * writers might throw at us. When in trouble, we pass NULL to | ||
891 | * asus_model_match() and try something completely different. | ||
892 | */ | ||
893 | if (buffer.pointer) { | ||
894 | model = buffer.pointer; | ||
895 | switch (model->type) { | ||
896 | case ACPI_TYPE_STRING: | ||
897 | string = model->string.pointer; | ||
898 | break; | ||
899 | case ACPI_TYPE_BUFFER: | ||
900 | string = model->buffer.pointer; | ||
901 | break; | ||
902 | default: | ||
903 | string = ""; | ||
904 | break; | ||
905 | } | ||
906 | } | ||
907 | hotk->name = kstrdup(string, GFP_KERNEL); | ||
908 | if (!hotk->name) | ||
909 | return -ENOMEM; | ||
910 | |||
911 | if (*string) | ||
912 | printk(ASUS_NOTICE " %s model detected\n", string); | ||
913 | |||
914 | ASUS_HANDLE_INIT(mled_set); | ||
915 | ASUS_HANDLE_INIT(tled_set); | ||
916 | ASUS_HANDLE_INIT(rled_set); | ||
917 | ASUS_HANDLE_INIT(pled_set); | ||
918 | ASUS_HANDLE_INIT(gled_set); | ||
919 | |||
920 | ASUS_HANDLE_INIT(ledd_set); | ||
921 | |||
922 | /* | ||
923 | * The HWRS method return informations about the hardware. | ||
924 | * 0x80 bit is for WLAN, 0x100 for Bluetooth. | ||
925 | * The significance of others is yet to be found. | ||
926 | * If we don't find the method, we assume the device are present. | ||
927 | */ | ||
928 | status = | ||
929 | acpi_evaluate_integer(hotk->handle, "HRWS", NULL, &hwrs_result); | ||
930 | if (ACPI_FAILURE(status)) | ||
931 | hwrs_result = WL_HWRS | BT_HWRS; | ||
932 | |||
933 | if (hwrs_result & WL_HWRS) | ||
934 | ASUS_HANDLE_INIT(wl_switch); | ||
935 | if (hwrs_result & BT_HWRS) | ||
936 | ASUS_HANDLE_INIT(bt_switch); | ||
937 | |||
938 | ASUS_HANDLE_INIT(wireless_status); | ||
939 | |||
940 | ASUS_HANDLE_INIT(brightness_set); | ||
941 | ASUS_HANDLE_INIT(brightness_get); | ||
942 | |||
943 | ASUS_HANDLE_INIT(lcd_switch); | ||
944 | |||
945 | ASUS_HANDLE_INIT(display_set); | ||
946 | ASUS_HANDLE_INIT(display_get); | ||
947 | |||
948 | /* There is a lot of models with "ALSL", but a few get | ||
949 | a real light sens, so we need to check it. */ | ||
950 | if (!ASUS_HANDLE_INIT(ls_switch)) | ||
951 | ASUS_HANDLE_INIT(ls_level); | ||
952 | |||
953 | ASUS_HANDLE_INIT(gps_on); | ||
954 | ASUS_HANDLE_INIT(gps_off); | ||
955 | ASUS_HANDLE_INIT(gps_status); | ||
956 | |||
957 | kfree(model); | ||
958 | |||
959 | return AE_OK; | ||
960 | } | ||
961 | |||
962 | static int asus_hotk_check(void) | ||
963 | { | ||
964 | int result = 0; | ||
965 | |||
966 | result = acpi_bus_get_status(hotk->device); | ||
967 | if (result) | ||
968 | return result; | ||
969 | |||
970 | if (hotk->device->status.present) { | ||
971 | result = asus_hotk_get_info(); | ||
972 | } else { | ||
973 | printk(ASUS_ERR "Hotkey device not present, aborting\n"); | ||
974 | return -EINVAL; | ||
975 | } | ||
976 | |||
977 | return result; | ||
978 | } | ||
979 | |||
980 | static int asus_hotk_found; | ||
981 | |||
982 | static int asus_hotk_add(struct acpi_device *device) | ||
983 | { | ||
984 | acpi_status status = AE_OK; | ||
985 | int result; | ||
986 | |||
987 | if (!device) | ||
988 | return -EINVAL; | ||
989 | |||
990 | printk(ASUS_NOTICE "Asus Laptop Support version %s\n", | ||
991 | ASUS_LAPTOP_VERSION); | ||
992 | |||
993 | hotk = kzalloc(sizeof(struct asus_hotk), GFP_KERNEL); | ||
994 | if (!hotk) | ||
995 | return -ENOMEM; | ||
996 | |||
997 | hotk->handle = device->handle; | ||
998 | strcpy(acpi_device_name(device), ASUS_HOTK_DEVICE_NAME); | ||
999 | strcpy(acpi_device_class(device), ASUS_HOTK_CLASS); | ||
1000 | device->driver_data = hotk; | ||
1001 | hotk->device = device; | ||
1002 | |||
1003 | result = asus_hotk_check(); | ||
1004 | if (result) | ||
1005 | goto end; | ||
1006 | |||
1007 | asus_hotk_add_fs(); | ||
1008 | |||
1009 | /* | ||
1010 | * We install the handler, it will receive the hotk in parameter, so, we | ||
1011 | * could add other data to the hotk struct | ||
1012 | */ | ||
1013 | status = acpi_install_notify_handler(hotk->handle, ACPI_ALL_NOTIFY, | ||
1014 | asus_hotk_notify, hotk); | ||
1015 | if (ACPI_FAILURE(status)) | ||
1016 | printk(ASUS_ERR "Error installing notify handler\n"); | ||
1017 | |||
1018 | asus_hotk_found = 1; | ||
1019 | |||
1020 | /* WLED and BLED are on by default */ | ||
1021 | write_status(bt_switch_handle, 1, BT_ON); | ||
1022 | write_status(wl_switch_handle, 1, WL_ON); | ||
1023 | |||
1024 | /* If the h/w switch is off, we need to check the real status */ | ||
1025 | write_status(NULL, read_status(BT_ON), BT_ON); | ||
1026 | write_status(NULL, read_status(WL_ON), WL_ON); | ||
1027 | |||
1028 | /* LCD Backlight is on by default */ | ||
1029 | write_status(NULL, 1, LCD_ON); | ||
1030 | |||
1031 | /* LED display is off by default */ | ||
1032 | hotk->ledd_status = 0xFFF; | ||
1033 | |||
1034 | /* Set initial values of light sensor and level */ | ||
1035 | hotk->light_switch = 1; /* Default to light sensor disabled */ | ||
1036 | hotk->light_level = 0; /* level 5 for sensor sensitivity */ | ||
1037 | |||
1038 | if (ls_switch_handle) | ||
1039 | set_light_sens_switch(hotk->light_switch); | ||
1040 | |||
1041 | if (ls_level_handle) | ||
1042 | set_light_sens_level(hotk->light_level); | ||
1043 | |||
1044 | /* GPS is on by default */ | ||
1045 | write_status(NULL, 1, GPS_ON); | ||
1046 | |||
1047 | end: | ||
1048 | if (result) { | ||
1049 | kfree(hotk->name); | ||
1050 | kfree(hotk); | ||
1051 | } | ||
1052 | |||
1053 | return result; | ||
1054 | } | ||
1055 | |||
1056 | static int asus_hotk_remove(struct acpi_device *device, int type) | ||
1057 | { | ||
1058 | acpi_status status = 0; | ||
1059 | |||
1060 | if (!device || !acpi_driver_data(device)) | ||
1061 | return -EINVAL; | ||
1062 | |||
1063 | status = acpi_remove_notify_handler(hotk->handle, ACPI_ALL_NOTIFY, | ||
1064 | asus_hotk_notify); | ||
1065 | if (ACPI_FAILURE(status)) | ||
1066 | printk(ASUS_ERR "Error removing notify handler\n"); | ||
1067 | |||
1068 | kfree(hotk->name); | ||
1069 | kfree(hotk); | ||
1070 | |||
1071 | return 0; | ||
1072 | } | ||
1073 | |||
1074 | static void asus_backlight_exit(void) | ||
1075 | { | ||
1076 | if (asus_backlight_device) | ||
1077 | backlight_device_unregister(asus_backlight_device); | ||
1078 | } | ||
1079 | |||
1080 | #define ASUS_LED_UNREGISTER(object) \ | ||
1081 | if (object##_led.dev) \ | ||
1082 | led_classdev_unregister(&object##_led) | ||
1083 | |||
1084 | static void asus_led_exit(void) | ||
1085 | { | ||
1086 | destroy_workqueue(led_workqueue); | ||
1087 | ASUS_LED_UNREGISTER(mled); | ||
1088 | ASUS_LED_UNREGISTER(tled); | ||
1089 | ASUS_LED_UNREGISTER(pled); | ||
1090 | ASUS_LED_UNREGISTER(rled); | ||
1091 | ASUS_LED_UNREGISTER(gled); | ||
1092 | } | ||
1093 | |||
1094 | static void __exit asus_laptop_exit(void) | ||
1095 | { | ||
1096 | asus_backlight_exit(); | ||
1097 | asus_led_exit(); | ||
1098 | |||
1099 | acpi_bus_unregister_driver(&asus_hotk_driver); | ||
1100 | sysfs_remove_group(&asuspf_device->dev.kobj, &asuspf_attribute_group); | ||
1101 | platform_device_unregister(asuspf_device); | ||
1102 | platform_driver_unregister(&asuspf_driver); | ||
1103 | } | ||
1104 | |||
1105 | static int asus_backlight_init(struct device *dev) | ||
1106 | { | ||
1107 | struct backlight_device *bd; | ||
1108 | |||
1109 | if (brightness_set_handle && lcd_switch_handle) { | ||
1110 | bd = backlight_device_register(ASUS_HOTK_FILE, dev, | ||
1111 | NULL, &asusbl_ops); | ||
1112 | if (IS_ERR(bd)) { | ||
1113 | printk(ASUS_ERR | ||
1114 | "Could not register asus backlight device\n"); | ||
1115 | asus_backlight_device = NULL; | ||
1116 | return PTR_ERR(bd); | ||
1117 | } | ||
1118 | |||
1119 | asus_backlight_device = bd; | ||
1120 | |||
1121 | bd->props.max_brightness = 15; | ||
1122 | bd->props.brightness = read_brightness(NULL); | ||
1123 | bd->props.power = FB_BLANK_UNBLANK; | ||
1124 | backlight_update_status(bd); | ||
1125 | } | ||
1126 | return 0; | ||
1127 | } | ||
1128 | |||
1129 | static int asus_led_register(acpi_handle handle, | ||
1130 | struct led_classdev *ldev, struct device *dev) | ||
1131 | { | ||
1132 | if (!handle) | ||
1133 | return 0; | ||
1134 | |||
1135 | return led_classdev_register(dev, ldev); | ||
1136 | } | ||
1137 | |||
1138 | #define ASUS_LED_REGISTER(object, device) \ | ||
1139 | asus_led_register(object##_set_handle, &object##_led, device) | ||
1140 | |||
1141 | static int asus_led_init(struct device *dev) | ||
1142 | { | ||
1143 | int rv; | ||
1144 | |||
1145 | rv = ASUS_LED_REGISTER(mled, dev); | ||
1146 | if (rv) | ||
1147 | goto out; | ||
1148 | |||
1149 | rv = ASUS_LED_REGISTER(tled, dev); | ||
1150 | if (rv) | ||
1151 | goto out1; | ||
1152 | |||
1153 | rv = ASUS_LED_REGISTER(rled, dev); | ||
1154 | if (rv) | ||
1155 | goto out2; | ||
1156 | |||
1157 | rv = ASUS_LED_REGISTER(pled, dev); | ||
1158 | if (rv) | ||
1159 | goto out3; | ||
1160 | |||
1161 | rv = ASUS_LED_REGISTER(gled, dev); | ||
1162 | if (rv) | ||
1163 | goto out4; | ||
1164 | |||
1165 | led_workqueue = create_singlethread_workqueue("led_workqueue"); | ||
1166 | if (!led_workqueue) | ||
1167 | goto out5; | ||
1168 | |||
1169 | return 0; | ||
1170 | out5: | ||
1171 | rv = -ENOMEM; | ||
1172 | ASUS_LED_UNREGISTER(gled); | ||
1173 | out4: | ||
1174 | ASUS_LED_UNREGISTER(pled); | ||
1175 | out3: | ||
1176 | ASUS_LED_UNREGISTER(rled); | ||
1177 | out2: | ||
1178 | ASUS_LED_UNREGISTER(tled); | ||
1179 | out1: | ||
1180 | ASUS_LED_UNREGISTER(mled); | ||
1181 | out: | ||
1182 | return rv; | ||
1183 | } | ||
1184 | |||
1185 | static int __init asus_laptop_init(void) | ||
1186 | { | ||
1187 | struct device *dev; | ||
1188 | int result; | ||
1189 | |||
1190 | if (acpi_disabled) | ||
1191 | return -ENODEV; | ||
1192 | |||
1193 | result = acpi_bus_register_driver(&asus_hotk_driver); | ||
1194 | if (result < 0) | ||
1195 | return result; | ||
1196 | |||
1197 | /* | ||
1198 | * This is a bit of a kludge. We only want this module loaded | ||
1199 | * for ASUS systems, but there's currently no way to probe the | ||
1200 | * ACPI namespace for ASUS HIDs. So we just return failure if | ||
1201 | * we didn't find one, which will cause the module to be | ||
1202 | * unloaded. | ||
1203 | */ | ||
1204 | if (!asus_hotk_found) { | ||
1205 | acpi_bus_unregister_driver(&asus_hotk_driver); | ||
1206 | return -ENODEV; | ||
1207 | } | ||
1208 | |||
1209 | dev = acpi_get_physical_device(hotk->device->handle); | ||
1210 | |||
1211 | if (!acpi_video_backlight_support()) { | ||
1212 | result = asus_backlight_init(dev); | ||
1213 | if (result) | ||
1214 | goto fail_backlight; | ||
1215 | } else | ||
1216 | printk(ASUS_INFO "Brightness ignored, must be controlled by " | ||
1217 | "ACPI video driver\n"); | ||
1218 | |||
1219 | result = asus_led_init(dev); | ||
1220 | if (result) | ||
1221 | goto fail_led; | ||
1222 | |||
1223 | /* Register platform stuff */ | ||
1224 | result = platform_driver_register(&asuspf_driver); | ||
1225 | if (result) | ||
1226 | goto fail_platform_driver; | ||
1227 | |||
1228 | asuspf_device = platform_device_alloc(ASUS_HOTK_FILE, -1); | ||
1229 | if (!asuspf_device) { | ||
1230 | result = -ENOMEM; | ||
1231 | goto fail_platform_device1; | ||
1232 | } | ||
1233 | |||
1234 | result = platform_device_add(asuspf_device); | ||
1235 | if (result) | ||
1236 | goto fail_platform_device2; | ||
1237 | |||
1238 | result = sysfs_create_group(&asuspf_device->dev.kobj, | ||
1239 | &asuspf_attribute_group); | ||
1240 | if (result) | ||
1241 | goto fail_sysfs; | ||
1242 | |||
1243 | return 0; | ||
1244 | |||
1245 | fail_sysfs: | ||
1246 | platform_device_del(asuspf_device); | ||
1247 | |||
1248 | fail_platform_device2: | ||
1249 | platform_device_put(asuspf_device); | ||
1250 | |||
1251 | fail_platform_device1: | ||
1252 | platform_driver_unregister(&asuspf_driver); | ||
1253 | |||
1254 | fail_platform_driver: | ||
1255 | asus_led_exit(); | ||
1256 | |||
1257 | fail_led: | ||
1258 | asus_backlight_exit(); | ||
1259 | |||
1260 | fail_backlight: | ||
1261 | |||
1262 | return result; | ||
1263 | } | ||
1264 | |||
1265 | module_init(asus_laptop_init); | ||
1266 | module_exit(asus_laptop_exit); | ||
diff --git a/drivers/platform/x86/asus_acpi.c b/drivers/platform/x86/asus_acpi.c new file mode 100644 index 000000000000..1e74988c7b2d --- /dev/null +++ b/drivers/platform/x86/asus_acpi.c | |||
@@ -0,0 +1,1460 @@ | |||
1 | /* | ||
2 | * asus_acpi.c - Asus Laptop ACPI Extras | ||
3 | * | ||
4 | * | ||
5 | * Copyright (C) 2002-2005 Julien Lerouge, 2003-2006 Karol Kozimor | ||
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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
20 | * | ||
21 | * | ||
22 | * The development page for this driver is located at | ||
23 | * http://sourceforge.net/projects/acpi4asus/ | ||
24 | * | ||
25 | * Credits: | ||
26 | * Pontus Fuchs - Helper functions, cleanup | ||
27 | * Johann Wiesner - Small compile fixes | ||
28 | * John Belmonte - ACPI code for Toshiba laptop was a good starting point. | ||
29 | * �ic Burghard - LED display support for W1N | ||
30 | * | ||
31 | */ | ||
32 | |||
33 | #include <linux/kernel.h> | ||
34 | #include <linux/module.h> | ||
35 | #include <linux/init.h> | ||
36 | #include <linux/types.h> | ||
37 | #include <linux/proc_fs.h> | ||
38 | #include <linux/backlight.h> | ||
39 | #include <acpi/acpi_drivers.h> | ||
40 | #include <acpi/acpi_bus.h> | ||
41 | #include <asm/uaccess.h> | ||
42 | |||
43 | #define ASUS_ACPI_VERSION "0.30" | ||
44 | |||
45 | #define PROC_ASUS "asus" /* The directory */ | ||
46 | #define PROC_MLED "mled" | ||
47 | #define PROC_WLED "wled" | ||
48 | #define PROC_TLED "tled" | ||
49 | #define PROC_BT "bluetooth" | ||
50 | #define PROC_LEDD "ledd" | ||
51 | #define PROC_INFO "info" | ||
52 | #define PROC_LCD "lcd" | ||
53 | #define PROC_BRN "brn" | ||
54 | #define PROC_DISP "disp" | ||
55 | |||
56 | #define ACPI_HOTK_NAME "Asus Laptop ACPI Extras Driver" | ||
57 | #define ACPI_HOTK_CLASS "hotkey" | ||
58 | #define ACPI_HOTK_DEVICE_NAME "Hotkey" | ||
59 | |||
60 | /* | ||
61 | * Some events we use, same for all Asus | ||
62 | */ | ||
63 | #define BR_UP 0x10 | ||
64 | #define BR_DOWN 0x20 | ||
65 | |||
66 | /* | ||
67 | * Flags for hotk status | ||
68 | */ | ||
69 | #define MLED_ON 0x01 /* Mail LED */ | ||
70 | #define WLED_ON 0x02 /* Wireless LED */ | ||
71 | #define TLED_ON 0x04 /* Touchpad LED */ | ||
72 | #define BT_ON 0x08 /* Internal Bluetooth */ | ||
73 | |||
74 | MODULE_AUTHOR("Julien Lerouge, Karol Kozimor"); | ||
75 | MODULE_DESCRIPTION(ACPI_HOTK_NAME); | ||
76 | MODULE_LICENSE("GPL"); | ||
77 | |||
78 | static uid_t asus_uid; | ||
79 | static gid_t asus_gid; | ||
80 | module_param(asus_uid, uint, 0); | ||
81 | MODULE_PARM_DESC(asus_uid, "UID for entries in /proc/acpi/asus"); | ||
82 | module_param(asus_gid, uint, 0); | ||
83 | MODULE_PARM_DESC(asus_gid, "GID for entries in /proc/acpi/asus"); | ||
84 | |||
85 | /* For each model, all features implemented, | ||
86 | * those marked with R are relative to HOTK, A for absolute */ | ||
87 | struct model_data { | ||
88 | char *name; /* name of the laptop________________A */ | ||
89 | char *mt_mled; /* method to handle mled_____________R */ | ||
90 | char *mled_status; /* node to handle mled reading_______A */ | ||
91 | char *mt_wled; /* method to handle wled_____________R */ | ||
92 | char *wled_status; /* node to handle wled reading_______A */ | ||
93 | char *mt_tled; /* method to handle tled_____________R */ | ||
94 | char *tled_status; /* node to handle tled reading_______A */ | ||
95 | char *mt_ledd; /* method to handle LED display______R */ | ||
96 | char *mt_bt_switch; /* method to switch Bluetooth on/off_R */ | ||
97 | char *bt_status; /* no model currently supports this__? */ | ||
98 | char *mt_lcd_switch; /* method to turn LCD on/off_________A */ | ||
99 | char *lcd_status; /* node to read LCD panel state______A */ | ||
100 | char *brightness_up; /* method to set brightness up_______A */ | ||
101 | char *brightness_down; /* method to set brightness down ____A */ | ||
102 | char *brightness_set; /* method to set absolute brightness_R */ | ||
103 | char *brightness_get; /* method to get absolute brightness_R */ | ||
104 | char *brightness_status;/* node to get brightness____________A */ | ||
105 | char *display_set; /* method to set video output________R */ | ||
106 | char *display_get; /* method to get video output________R */ | ||
107 | }; | ||
108 | |||
109 | /* | ||
110 | * This is the main structure, we can use it to store anything interesting | ||
111 | * about the hotk device | ||
112 | */ | ||
113 | struct asus_hotk { | ||
114 | struct acpi_device *device; /* the device we are in */ | ||
115 | acpi_handle handle; /* the handle of the hotk device */ | ||
116 | char status; /* status of the hotk, for LEDs */ | ||
117 | u32 ledd_status; /* status of the LED display */ | ||
118 | struct model_data *methods; /* methods available on the laptop */ | ||
119 | u8 brightness; /* brightness level */ | ||
120 | enum { | ||
121 | A1x = 0, /* A1340D, A1300F */ | ||
122 | A2x, /* A2500H */ | ||
123 | A4G, /* A4700G */ | ||
124 | D1x, /* D1 */ | ||
125 | L2D, /* L2000D */ | ||
126 | L3C, /* L3800C */ | ||
127 | L3D, /* L3400D */ | ||
128 | L3H, /* L3H, L2000E, L5D */ | ||
129 | L4R, /* L4500R */ | ||
130 | L5x, /* L5800C */ | ||
131 | L8L, /* L8400L */ | ||
132 | M1A, /* M1300A */ | ||
133 | M2E, /* M2400E, L4400L */ | ||
134 | M6N, /* M6800N, W3400N */ | ||
135 | M6R, /* M6700R, A3000G */ | ||
136 | P30, /* Samsung P30 */ | ||
137 | S1x, /* S1300A, but also L1400B and M2400A (L84F) */ | ||
138 | S2x, /* S200 (J1 reported), Victor MP-XP7210 */ | ||
139 | W1N, /* W1000N */ | ||
140 | W5A, /* W5A */ | ||
141 | W3V, /* W3030V */ | ||
142 | xxN, /* M2400N, M3700N, M5200N, M6800N, | ||
143 | S1300N, S5200N*/ | ||
144 | A4S, /* Z81sp */ | ||
145 | F3Sa, /* (Centrino) */ | ||
146 | END_MODEL | ||
147 | } model; /* Models currently supported */ | ||
148 | u16 event_count[128]; /* Count for each event TODO make this better */ | ||
149 | }; | ||
150 | |||
151 | /* Here we go */ | ||
152 | #define A1x_PREFIX "\\_SB.PCI0.ISA.EC0." | ||
153 | #define L3C_PREFIX "\\_SB.PCI0.PX40.ECD0." | ||
154 | #define M1A_PREFIX "\\_SB.PCI0.PX40.EC0." | ||
155 | #define P30_PREFIX "\\_SB.PCI0.LPCB.EC0." | ||
156 | #define S1x_PREFIX "\\_SB.PCI0.PX40." | ||
157 | #define S2x_PREFIX A1x_PREFIX | ||
158 | #define xxN_PREFIX "\\_SB.PCI0.SBRG.EC0." | ||
159 | |||
160 | static struct model_data model_conf[END_MODEL] = { | ||
161 | /* | ||
162 | * TODO I have seen a SWBX and AIBX method on some models, like L1400B, | ||
163 | * it seems to be a kind of switch, but what for ? | ||
164 | */ | ||
165 | |||
166 | { | ||
167 | .name = "A1x", | ||
168 | .mt_mled = "MLED", | ||
169 | .mled_status = "\\MAIL", | ||
170 | .mt_lcd_switch = A1x_PREFIX "_Q10", | ||
171 | .lcd_status = "\\BKLI", | ||
172 | .brightness_up = A1x_PREFIX "_Q0E", | ||
173 | .brightness_down = A1x_PREFIX "_Q0F"}, | ||
174 | |||
175 | { | ||
176 | .name = "A2x", | ||
177 | .mt_mled = "MLED", | ||
178 | .mt_wled = "WLED", | ||
179 | .wled_status = "\\SG66", | ||
180 | .mt_lcd_switch = "\\Q10", | ||
181 | .lcd_status = "\\BAOF", | ||
182 | .brightness_set = "SPLV", | ||
183 | .brightness_get = "GPLV", | ||
184 | .display_set = "SDSP", | ||
185 | .display_get = "\\INFB"}, | ||
186 | |||
187 | { | ||
188 | .name = "A4G", | ||
189 | .mt_mled = "MLED", | ||
190 | /* WLED present, but not controlled by ACPI */ | ||
191 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
192 | .brightness_set = "SPLV", | ||
193 | .brightness_get = "GPLV", | ||
194 | .display_set = "SDSP", | ||
195 | .display_get = "\\ADVG"}, | ||
196 | |||
197 | { | ||
198 | .name = "D1x", | ||
199 | .mt_mled = "MLED", | ||
200 | .mt_lcd_switch = "\\Q0D", | ||
201 | .lcd_status = "\\GP11", | ||
202 | .brightness_up = "\\Q0C", | ||
203 | .brightness_down = "\\Q0B", | ||
204 | .brightness_status = "\\BLVL", | ||
205 | .display_set = "SDSP", | ||
206 | .display_get = "\\INFB"}, | ||
207 | |||
208 | { | ||
209 | .name = "L2D", | ||
210 | .mt_mled = "MLED", | ||
211 | .mled_status = "\\SGP6", | ||
212 | .mt_wled = "WLED", | ||
213 | .wled_status = "\\RCP3", | ||
214 | .mt_lcd_switch = "\\Q10", | ||
215 | .lcd_status = "\\SGP0", | ||
216 | .brightness_up = "\\Q0E", | ||
217 | .brightness_down = "\\Q0F", | ||
218 | .display_set = "SDSP", | ||
219 | .display_get = "\\INFB"}, | ||
220 | |||
221 | { | ||
222 | .name = "L3C", | ||
223 | .mt_mled = "MLED", | ||
224 | .mt_wled = "WLED", | ||
225 | .mt_lcd_switch = L3C_PREFIX "_Q10", | ||
226 | .lcd_status = "\\GL32", | ||
227 | .brightness_set = "SPLV", | ||
228 | .brightness_get = "GPLV", | ||
229 | .display_set = "SDSP", | ||
230 | .display_get = "\\_SB.PCI0.PCI1.VGAC.NMAP"}, | ||
231 | |||
232 | { | ||
233 | .name = "L3D", | ||
234 | .mt_mled = "MLED", | ||
235 | .mled_status = "\\MALD", | ||
236 | .mt_wled = "WLED", | ||
237 | .mt_lcd_switch = "\\Q10", | ||
238 | .lcd_status = "\\BKLG", | ||
239 | .brightness_set = "SPLV", | ||
240 | .brightness_get = "GPLV", | ||
241 | .display_set = "SDSP", | ||
242 | .display_get = "\\INFB"}, | ||
243 | |||
244 | { | ||
245 | .name = "L3H", | ||
246 | .mt_mled = "MLED", | ||
247 | .mt_wled = "WLED", | ||
248 | .mt_lcd_switch = "EHK", | ||
249 | .lcd_status = "\\_SB.PCI0.PM.PBC", | ||
250 | .brightness_set = "SPLV", | ||
251 | .brightness_get = "GPLV", | ||
252 | .display_set = "SDSP", | ||
253 | .display_get = "\\INFB"}, | ||
254 | |||
255 | { | ||
256 | .name = "L4R", | ||
257 | .mt_mled = "MLED", | ||
258 | .mt_wled = "WLED", | ||
259 | .wled_status = "\\_SB.PCI0.SBRG.SG13", | ||
260 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
261 | .lcd_status = "\\_SB.PCI0.SBSM.SEO4", | ||
262 | .brightness_set = "SPLV", | ||
263 | .brightness_get = "GPLV", | ||
264 | .display_set = "SDSP", | ||
265 | .display_get = "\\_SB.PCI0.P0P1.VGA.GETD"}, | ||
266 | |||
267 | { | ||
268 | .name = "L5x", | ||
269 | .mt_mled = "MLED", | ||
270 | /* WLED present, but not controlled by ACPI */ | ||
271 | .mt_tled = "TLED", | ||
272 | .mt_lcd_switch = "\\Q0D", | ||
273 | .lcd_status = "\\BAOF", | ||
274 | .brightness_set = "SPLV", | ||
275 | .brightness_get = "GPLV", | ||
276 | .display_set = "SDSP", | ||
277 | .display_get = "\\INFB"}, | ||
278 | |||
279 | { | ||
280 | .name = "L8L" | ||
281 | /* No features, but at least support the hotkeys */ | ||
282 | }, | ||
283 | |||
284 | { | ||
285 | .name = "M1A", | ||
286 | .mt_mled = "MLED", | ||
287 | .mt_lcd_switch = M1A_PREFIX "Q10", | ||
288 | .lcd_status = "\\PNOF", | ||
289 | .brightness_up = M1A_PREFIX "Q0E", | ||
290 | .brightness_down = M1A_PREFIX "Q0F", | ||
291 | .brightness_status = "\\BRIT", | ||
292 | .display_set = "SDSP", | ||
293 | .display_get = "\\INFB"}, | ||
294 | |||
295 | { | ||
296 | .name = "M2E", | ||
297 | .mt_mled = "MLED", | ||
298 | .mt_wled = "WLED", | ||
299 | .mt_lcd_switch = "\\Q10", | ||
300 | .lcd_status = "\\GP06", | ||
301 | .brightness_set = "SPLV", | ||
302 | .brightness_get = "GPLV", | ||
303 | .display_set = "SDSP", | ||
304 | .display_get = "\\INFB"}, | ||
305 | |||
306 | { | ||
307 | .name = "M6N", | ||
308 | .mt_mled = "MLED", | ||
309 | .mt_wled = "WLED", | ||
310 | .wled_status = "\\_SB.PCI0.SBRG.SG13", | ||
311 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
312 | .lcd_status = "\\_SB.BKLT", | ||
313 | .brightness_set = "SPLV", | ||
314 | .brightness_get = "GPLV", | ||
315 | .display_set = "SDSP", | ||
316 | .display_get = "\\SSTE"}, | ||
317 | |||
318 | { | ||
319 | .name = "M6R", | ||
320 | .mt_mled = "MLED", | ||
321 | .mt_wled = "WLED", | ||
322 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
323 | .lcd_status = "\\_SB.PCI0.SBSM.SEO4", | ||
324 | .brightness_set = "SPLV", | ||
325 | .brightness_get = "GPLV", | ||
326 | .display_set = "SDSP", | ||
327 | .display_get = "\\_SB.PCI0.P0P1.VGA.GETD"}, | ||
328 | |||
329 | { | ||
330 | .name = "P30", | ||
331 | .mt_wled = "WLED", | ||
332 | .mt_lcd_switch = P30_PREFIX "_Q0E", | ||
333 | .lcd_status = "\\BKLT", | ||
334 | .brightness_up = P30_PREFIX "_Q68", | ||
335 | .brightness_down = P30_PREFIX "_Q69", | ||
336 | .brightness_get = "GPLV", | ||
337 | .display_set = "SDSP", | ||
338 | .display_get = "\\DNXT"}, | ||
339 | |||
340 | { | ||
341 | .name = "S1x", | ||
342 | .mt_mled = "MLED", | ||
343 | .mled_status = "\\EMLE", | ||
344 | .mt_wled = "WLED", | ||
345 | .mt_lcd_switch = S1x_PREFIX "Q10", | ||
346 | .lcd_status = "\\PNOF", | ||
347 | .brightness_set = "SPLV", | ||
348 | .brightness_get = "GPLV"}, | ||
349 | |||
350 | { | ||
351 | .name = "S2x", | ||
352 | .mt_mled = "MLED", | ||
353 | .mled_status = "\\MAIL", | ||
354 | .mt_lcd_switch = S2x_PREFIX "_Q10", | ||
355 | .lcd_status = "\\BKLI", | ||
356 | .brightness_up = S2x_PREFIX "_Q0B", | ||
357 | .brightness_down = S2x_PREFIX "_Q0A"}, | ||
358 | |||
359 | { | ||
360 | .name = "W1N", | ||
361 | .mt_mled = "MLED", | ||
362 | .mt_wled = "WLED", | ||
363 | .mt_ledd = "SLCM", | ||
364 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
365 | .lcd_status = "\\BKLT", | ||
366 | .brightness_set = "SPLV", | ||
367 | .brightness_get = "GPLV", | ||
368 | .display_set = "SDSP", | ||
369 | .display_get = "\\ADVG"}, | ||
370 | |||
371 | { | ||
372 | .name = "W5A", | ||
373 | .mt_bt_switch = "BLED", | ||
374 | .mt_wled = "WLED", | ||
375 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
376 | .brightness_set = "SPLV", | ||
377 | .brightness_get = "GPLV", | ||
378 | .display_set = "SDSP", | ||
379 | .display_get = "\\ADVG"}, | ||
380 | |||
381 | { | ||
382 | .name = "W3V", | ||
383 | .mt_mled = "MLED", | ||
384 | .mt_wled = "WLED", | ||
385 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
386 | .lcd_status = "\\BKLT", | ||
387 | .brightness_set = "SPLV", | ||
388 | .brightness_get = "GPLV", | ||
389 | .display_set = "SDSP", | ||
390 | .display_get = "\\INFB"}, | ||
391 | |||
392 | { | ||
393 | .name = "xxN", | ||
394 | .mt_mled = "MLED", | ||
395 | /* WLED present, but not controlled by ACPI */ | ||
396 | .mt_lcd_switch = xxN_PREFIX "_Q10", | ||
397 | .lcd_status = "\\BKLT", | ||
398 | .brightness_set = "SPLV", | ||
399 | .brightness_get = "GPLV", | ||
400 | .display_set = "SDSP", | ||
401 | .display_get = "\\ADVG"}, | ||
402 | |||
403 | { | ||
404 | .name = "A4S", | ||
405 | .brightness_set = "SPLV", | ||
406 | .brightness_get = "GPLV", | ||
407 | .mt_bt_switch = "BLED", | ||
408 | .mt_wled = "WLED" | ||
409 | }, | ||
410 | |||
411 | { | ||
412 | .name = "F3Sa", | ||
413 | .mt_bt_switch = "BLED", | ||
414 | .mt_wled = "WLED", | ||
415 | .mt_mled = "MLED", | ||
416 | .brightness_get = "GPLV", | ||
417 | .brightness_set = "SPLV", | ||
418 | .mt_lcd_switch = "\\_SB.PCI0.SBRG.EC0._Q10", | ||
419 | .lcd_status = "\\_SB.PCI0.SBRG.EC0.RPIN", | ||
420 | .display_get = "\\ADVG", | ||
421 | .display_set = "SDSP", | ||
422 | }, | ||
423 | |||
424 | }; | ||
425 | |||
426 | /* procdir we use */ | ||
427 | static struct proc_dir_entry *asus_proc_dir; | ||
428 | |||
429 | static struct backlight_device *asus_backlight_device; | ||
430 | |||
431 | /* | ||
432 | * This header is made available to allow proper configuration given model, | ||
433 | * revision number , ... this info cannot go in struct asus_hotk because it is | ||
434 | * available before the hotk | ||
435 | */ | ||
436 | static struct acpi_table_header *asus_info; | ||
437 | |||
438 | /* The actual device the driver binds to */ | ||
439 | static struct asus_hotk *hotk; | ||
440 | |||
441 | /* | ||
442 | * The hotkey driver and autoloading declaration | ||
443 | */ | ||
444 | static int asus_hotk_add(struct acpi_device *device); | ||
445 | static int asus_hotk_remove(struct acpi_device *device, int type); | ||
446 | static const struct acpi_device_id asus_device_ids[] = { | ||
447 | {"ATK0100", 0}, | ||
448 | {"", 0}, | ||
449 | }; | ||
450 | MODULE_DEVICE_TABLE(acpi, asus_device_ids); | ||
451 | |||
452 | static struct acpi_driver asus_hotk_driver = { | ||
453 | .name = "asus_acpi", | ||
454 | .class = ACPI_HOTK_CLASS, | ||
455 | .ids = asus_device_ids, | ||
456 | .ops = { | ||
457 | .add = asus_hotk_add, | ||
458 | .remove = asus_hotk_remove, | ||
459 | }, | ||
460 | }; | ||
461 | |||
462 | /* | ||
463 | * This function evaluates an ACPI method, given an int as parameter, the | ||
464 | * method is searched within the scope of the handle, can be NULL. The output | ||
465 | * of the method is written is output, which can also be NULL | ||
466 | * | ||
467 | * returns 1 if write is successful, 0 else. | ||
468 | */ | ||
469 | static int write_acpi_int(acpi_handle handle, const char *method, int val, | ||
470 | struct acpi_buffer *output) | ||
471 | { | ||
472 | struct acpi_object_list params; /* list of input parameters (int) */ | ||
473 | union acpi_object in_obj; /* the only param we use */ | ||
474 | acpi_status status; | ||
475 | |||
476 | params.count = 1; | ||
477 | params.pointer = &in_obj; | ||
478 | in_obj.type = ACPI_TYPE_INTEGER; | ||
479 | in_obj.integer.value = val; | ||
480 | |||
481 | status = acpi_evaluate_object(handle, (char *)method, ¶ms, output); | ||
482 | return (status == AE_OK); | ||
483 | } | ||
484 | |||
485 | static int read_acpi_int(acpi_handle handle, const char *method, int *val) | ||
486 | { | ||
487 | struct acpi_buffer output; | ||
488 | union acpi_object out_obj; | ||
489 | acpi_status status; | ||
490 | |||
491 | output.length = sizeof(out_obj); | ||
492 | output.pointer = &out_obj; | ||
493 | |||
494 | status = acpi_evaluate_object(handle, (char *)method, NULL, &output); | ||
495 | *val = out_obj.integer.value; | ||
496 | return (status == AE_OK) && (out_obj.type == ACPI_TYPE_INTEGER); | ||
497 | } | ||
498 | |||
499 | /* | ||
500 | * We write our info in page, we begin at offset off and cannot write more | ||
501 | * than count bytes. We set eof to 1 if we handle those 2 values. We return the | ||
502 | * number of bytes written in page | ||
503 | */ | ||
504 | static int | ||
505 | proc_read_info(char *page, char **start, off_t off, int count, int *eof, | ||
506 | void *data) | ||
507 | { | ||
508 | int len = 0; | ||
509 | int temp; | ||
510 | char buf[16]; /* enough for all info */ | ||
511 | /* | ||
512 | * We use the easy way, we don't care of off and count, | ||
513 | * so we don't set eof to 1 | ||
514 | */ | ||
515 | |||
516 | len += sprintf(page, ACPI_HOTK_NAME " " ASUS_ACPI_VERSION "\n"); | ||
517 | len += sprintf(page + len, "Model reference : %s\n", | ||
518 | hotk->methods->name); | ||
519 | /* | ||
520 | * The SFUN method probably allows the original driver to get the list | ||
521 | * of features supported by a given model. For now, 0x0100 or 0x0800 | ||
522 | * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card. | ||
523 | * The significance of others is yet to be found. | ||
524 | */ | ||
525 | if (read_acpi_int(hotk->handle, "SFUN", &temp)) | ||
526 | len += | ||
527 | sprintf(page + len, "SFUN value : 0x%04x\n", temp); | ||
528 | /* | ||
529 | * Another value for userspace: the ASYM method returns 0x02 for | ||
530 | * battery low and 0x04 for battery critical, its readings tend to be | ||
531 | * more accurate than those provided by _BST. | ||
532 | * Note: since not all the laptops provide this method, errors are | ||
533 | * silently ignored. | ||
534 | */ | ||
535 | if (read_acpi_int(hotk->handle, "ASYM", &temp)) | ||
536 | len += | ||
537 | sprintf(page + len, "ASYM value : 0x%04x\n", temp); | ||
538 | if (asus_info) { | ||
539 | snprintf(buf, 16, "%d", asus_info->length); | ||
540 | len += sprintf(page + len, "DSDT length : %s\n", buf); | ||
541 | snprintf(buf, 16, "%d", asus_info->checksum); | ||
542 | len += sprintf(page + len, "DSDT checksum : %s\n", buf); | ||
543 | snprintf(buf, 16, "%d", asus_info->revision); | ||
544 | len += sprintf(page + len, "DSDT revision : %s\n", buf); | ||
545 | snprintf(buf, 7, "%s", asus_info->oem_id); | ||
546 | len += sprintf(page + len, "OEM id : %s\n", buf); | ||
547 | snprintf(buf, 9, "%s", asus_info->oem_table_id); | ||
548 | len += sprintf(page + len, "OEM table id : %s\n", buf); | ||
549 | snprintf(buf, 16, "%x", asus_info->oem_revision); | ||
550 | len += sprintf(page + len, "OEM revision : 0x%s\n", buf); | ||
551 | snprintf(buf, 5, "%s", asus_info->asl_compiler_id); | ||
552 | len += sprintf(page + len, "ASL comp vendor id : %s\n", buf); | ||
553 | snprintf(buf, 16, "%x", asus_info->asl_compiler_revision); | ||
554 | len += sprintf(page + len, "ASL comp revision : 0x%s\n", buf); | ||
555 | } | ||
556 | |||
557 | return len; | ||
558 | } | ||
559 | |||
560 | /* | ||
561 | * /proc handlers | ||
562 | * We write our info in page, we begin at offset off and cannot write more | ||
563 | * than count bytes. We set eof to 1 if we handle those 2 values. We return the | ||
564 | * number of bytes written in page | ||
565 | */ | ||
566 | |||
567 | /* Generic LED functions */ | ||
568 | static int read_led(const char *ledname, int ledmask) | ||
569 | { | ||
570 | if (ledname) { | ||
571 | int led_status; | ||
572 | |||
573 | if (read_acpi_int(NULL, ledname, &led_status)) | ||
574 | return led_status; | ||
575 | else | ||
576 | printk(KERN_WARNING "Asus ACPI: Error reading LED " | ||
577 | "status\n"); | ||
578 | } | ||
579 | return (hotk->status & ledmask) ? 1 : 0; | ||
580 | } | ||
581 | |||
582 | static int parse_arg(const char __user *buf, unsigned long count, int *val) | ||
583 | { | ||
584 | char s[32]; | ||
585 | if (!count) | ||
586 | return 0; | ||
587 | if (count > 31) | ||
588 | return -EINVAL; | ||
589 | if (copy_from_user(s, buf, count)) | ||
590 | return -EFAULT; | ||
591 | s[count] = 0; | ||
592 | if (sscanf(s, "%i", val) != 1) | ||
593 | return -EINVAL; | ||
594 | return count; | ||
595 | } | ||
596 | |||
597 | /* FIXME: kill extraneous args so it can be called independently */ | ||
598 | static int | ||
599 | write_led(const char __user *buffer, unsigned long count, | ||
600 | char *ledname, int ledmask, int invert) | ||
601 | { | ||
602 | int rv, value; | ||
603 | int led_out = 0; | ||
604 | |||
605 | rv = parse_arg(buffer, count, &value); | ||
606 | if (rv > 0) | ||
607 | led_out = value ? 1 : 0; | ||
608 | |||
609 | hotk->status = | ||
610 | (led_out) ? (hotk->status | ledmask) : (hotk->status & ~ledmask); | ||
611 | |||
612 | if (invert) /* invert target value */ | ||
613 | led_out = !led_out; | ||
614 | |||
615 | if (!write_acpi_int(hotk->handle, ledname, led_out, NULL)) | ||
616 | printk(KERN_WARNING "Asus ACPI: LED (%s) write failed\n", | ||
617 | ledname); | ||
618 | |||
619 | return rv; | ||
620 | } | ||
621 | |||
622 | /* | ||
623 | * Proc handlers for MLED | ||
624 | */ | ||
625 | static int | ||
626 | proc_read_mled(char *page, char **start, off_t off, int count, int *eof, | ||
627 | void *data) | ||
628 | { | ||
629 | return sprintf(page, "%d\n", | ||
630 | read_led(hotk->methods->mled_status, MLED_ON)); | ||
631 | } | ||
632 | |||
633 | static int | ||
634 | proc_write_mled(struct file *file, const char __user *buffer, | ||
635 | unsigned long count, void *data) | ||
636 | { | ||
637 | return write_led(buffer, count, hotk->methods->mt_mled, MLED_ON, 1); | ||
638 | } | ||
639 | |||
640 | /* | ||
641 | * Proc handlers for LED display | ||
642 | */ | ||
643 | static int | ||
644 | proc_read_ledd(char *page, char **start, off_t off, int count, int *eof, | ||
645 | void *data) | ||
646 | { | ||
647 | return sprintf(page, "0x%08x\n", hotk->ledd_status); | ||
648 | } | ||
649 | |||
650 | static int | ||
651 | proc_write_ledd(struct file *file, const char __user *buffer, | ||
652 | unsigned long count, void *data) | ||
653 | { | ||
654 | int rv, value; | ||
655 | |||
656 | rv = parse_arg(buffer, count, &value); | ||
657 | if (rv > 0) { | ||
658 | if (!write_acpi_int | ||
659 | (hotk->handle, hotk->methods->mt_ledd, value, NULL)) | ||
660 | printk(KERN_WARNING | ||
661 | "Asus ACPI: LED display write failed\n"); | ||
662 | else | ||
663 | hotk->ledd_status = (u32) value; | ||
664 | } | ||
665 | return rv; | ||
666 | } | ||
667 | |||
668 | /* | ||
669 | * Proc handlers for WLED | ||
670 | */ | ||
671 | static int | ||
672 | proc_read_wled(char *page, char **start, off_t off, int count, int *eof, | ||
673 | void *data) | ||
674 | { | ||
675 | return sprintf(page, "%d\n", | ||
676 | read_led(hotk->methods->wled_status, WLED_ON)); | ||
677 | } | ||
678 | |||
679 | static int | ||
680 | proc_write_wled(struct file *file, const char __user *buffer, | ||
681 | unsigned long count, void *data) | ||
682 | { | ||
683 | return write_led(buffer, count, hotk->methods->mt_wled, WLED_ON, 0); | ||
684 | } | ||
685 | |||
686 | /* | ||
687 | * Proc handlers for Bluetooth | ||
688 | */ | ||
689 | static int | ||
690 | proc_read_bluetooth(char *page, char **start, off_t off, int count, int *eof, | ||
691 | void *data) | ||
692 | { | ||
693 | return sprintf(page, "%d\n", read_led(hotk->methods->bt_status, BT_ON)); | ||
694 | } | ||
695 | |||
696 | static int | ||
697 | proc_write_bluetooth(struct file *file, const char __user *buffer, | ||
698 | unsigned long count, void *data) | ||
699 | { | ||
700 | /* Note: mt_bt_switch controls both internal Bluetooth adapter's | ||
701 | presence and its LED */ | ||
702 | return write_led(buffer, count, hotk->methods->mt_bt_switch, BT_ON, 0); | ||
703 | } | ||
704 | |||
705 | /* | ||
706 | * Proc handlers for TLED | ||
707 | */ | ||
708 | static int | ||
709 | proc_read_tled(char *page, char **start, off_t off, int count, int *eof, | ||
710 | void *data) | ||
711 | { | ||
712 | return sprintf(page, "%d\n", | ||
713 | read_led(hotk->methods->tled_status, TLED_ON)); | ||
714 | } | ||
715 | |||
716 | static int | ||
717 | proc_write_tled(struct file *file, const char __user *buffer, | ||
718 | unsigned long count, void *data) | ||
719 | { | ||
720 | return write_led(buffer, count, hotk->methods->mt_tled, TLED_ON, 0); | ||
721 | } | ||
722 | |||
723 | static int get_lcd_state(void) | ||
724 | { | ||
725 | int lcd = 0; | ||
726 | |||
727 | if (hotk->model == L3H) { | ||
728 | /* L3H and the like have to be handled differently */ | ||
729 | acpi_status status = 0; | ||
730 | struct acpi_object_list input; | ||
731 | union acpi_object mt_params[2]; | ||
732 | struct acpi_buffer output; | ||
733 | union acpi_object out_obj; | ||
734 | |||
735 | input.count = 2; | ||
736 | input.pointer = mt_params; | ||
737 | /* Note: the following values are partly guessed up, but | ||
738 | otherwise they seem to work */ | ||
739 | mt_params[0].type = ACPI_TYPE_INTEGER; | ||
740 | mt_params[0].integer.value = 0x02; | ||
741 | mt_params[1].type = ACPI_TYPE_INTEGER; | ||
742 | mt_params[1].integer.value = 0x02; | ||
743 | |||
744 | output.length = sizeof(out_obj); | ||
745 | output.pointer = &out_obj; | ||
746 | |||
747 | status = | ||
748 | acpi_evaluate_object(NULL, hotk->methods->lcd_status, | ||
749 | &input, &output); | ||
750 | if (status != AE_OK) | ||
751 | return -1; | ||
752 | if (out_obj.type == ACPI_TYPE_INTEGER) | ||
753 | /* That's what the AML code does */ | ||
754 | lcd = out_obj.integer.value >> 8; | ||
755 | } else if (hotk->model == F3Sa) { | ||
756 | unsigned long long tmp; | ||
757 | union acpi_object param; | ||
758 | struct acpi_object_list input; | ||
759 | acpi_status status; | ||
760 | |||
761 | /* Read pin 11 */ | ||
762 | param.type = ACPI_TYPE_INTEGER; | ||
763 | param.integer.value = 0x11; | ||
764 | input.count = 1; | ||
765 | input.pointer = ¶m; | ||
766 | |||
767 | status = acpi_evaluate_integer(NULL, hotk->methods->lcd_status, | ||
768 | &input, &tmp); | ||
769 | if (status != AE_OK) | ||
770 | return -1; | ||
771 | |||
772 | lcd = tmp; | ||
773 | } else { | ||
774 | /* We don't have to check anything if we are here */ | ||
775 | if (!read_acpi_int(NULL, hotk->methods->lcd_status, &lcd)) | ||
776 | printk(KERN_WARNING | ||
777 | "Asus ACPI: Error reading LCD status\n"); | ||
778 | |||
779 | if (hotk->model == L2D) | ||
780 | lcd = ~lcd; | ||
781 | } | ||
782 | |||
783 | return (lcd & 1); | ||
784 | } | ||
785 | |||
786 | static int set_lcd_state(int value) | ||
787 | { | ||
788 | int lcd = 0; | ||
789 | acpi_status status = 0; | ||
790 | |||
791 | lcd = value ? 1 : 0; | ||
792 | if (lcd != get_lcd_state()) { | ||
793 | /* switch */ | ||
794 | if (hotk->model != L3H) { | ||
795 | status = | ||
796 | acpi_evaluate_object(NULL, | ||
797 | hotk->methods->mt_lcd_switch, | ||
798 | NULL, NULL); | ||
799 | } else { | ||
800 | /* L3H and the like must be handled differently */ | ||
801 | if (!write_acpi_int | ||
802 | (hotk->handle, hotk->methods->mt_lcd_switch, 0x07, | ||
803 | NULL)) | ||
804 | status = AE_ERROR; | ||
805 | /* L3H's AML executes EHK (0x07) upon Fn+F7 keypress, | ||
806 | the exact behaviour is simulated here */ | ||
807 | } | ||
808 | if (ACPI_FAILURE(status)) | ||
809 | printk(KERN_WARNING "Asus ACPI: Error switching LCD\n"); | ||
810 | } | ||
811 | return 0; | ||
812 | |||
813 | } | ||
814 | |||
815 | static int | ||
816 | proc_read_lcd(char *page, char **start, off_t off, int count, int *eof, | ||
817 | void *data) | ||
818 | { | ||
819 | return sprintf(page, "%d\n", get_lcd_state()); | ||
820 | } | ||
821 | |||
822 | static int | ||
823 | proc_write_lcd(struct file *file, const char __user *buffer, | ||
824 | unsigned long count, void *data) | ||
825 | { | ||
826 | int rv, value; | ||
827 | |||
828 | rv = parse_arg(buffer, count, &value); | ||
829 | if (rv > 0) | ||
830 | set_lcd_state(value); | ||
831 | return rv; | ||
832 | } | ||
833 | |||
834 | static int read_brightness(struct backlight_device *bd) | ||
835 | { | ||
836 | int value; | ||
837 | |||
838 | if (hotk->methods->brightness_get) { /* SPLV/GPLV laptop */ | ||
839 | if (!read_acpi_int(hotk->handle, hotk->methods->brightness_get, | ||
840 | &value)) | ||
841 | printk(KERN_WARNING | ||
842 | "Asus ACPI: Error reading brightness\n"); | ||
843 | } else if (hotk->methods->brightness_status) { /* For D1 for example */ | ||
844 | if (!read_acpi_int(NULL, hotk->methods->brightness_status, | ||
845 | &value)) | ||
846 | printk(KERN_WARNING | ||
847 | "Asus ACPI: Error reading brightness\n"); | ||
848 | } else /* No GPLV method */ | ||
849 | value = hotk->brightness; | ||
850 | return value; | ||
851 | } | ||
852 | |||
853 | /* | ||
854 | * Change the brightness level | ||
855 | */ | ||
856 | static int set_brightness(int value) | ||
857 | { | ||
858 | acpi_status status = 0; | ||
859 | int ret = 0; | ||
860 | |||
861 | /* SPLV laptop */ | ||
862 | if (hotk->methods->brightness_set) { | ||
863 | if (!write_acpi_int(hotk->handle, hotk->methods->brightness_set, | ||
864 | value, NULL)) | ||
865 | printk(KERN_WARNING | ||
866 | "Asus ACPI: Error changing brightness\n"); | ||
867 | ret = -EIO; | ||
868 | goto out; | ||
869 | } | ||
870 | |||
871 | /* No SPLV method if we are here, act as appropriate */ | ||
872 | value -= read_brightness(NULL); | ||
873 | while (value != 0) { | ||
874 | status = acpi_evaluate_object(NULL, (value > 0) ? | ||
875 | hotk->methods->brightness_up : | ||
876 | hotk->methods->brightness_down, | ||
877 | NULL, NULL); | ||
878 | (value > 0) ? value-- : value++; | ||
879 | if (ACPI_FAILURE(status)) | ||
880 | printk(KERN_WARNING | ||
881 | "Asus ACPI: Error changing brightness\n"); | ||
882 | ret = -EIO; | ||
883 | } | ||
884 | out: | ||
885 | return ret; | ||
886 | } | ||
887 | |||
888 | static int set_brightness_status(struct backlight_device *bd) | ||
889 | { | ||
890 | return set_brightness(bd->props.brightness); | ||
891 | } | ||
892 | |||
893 | static int | ||
894 | proc_read_brn(char *page, char **start, off_t off, int count, int *eof, | ||
895 | void *data) | ||
896 | { | ||
897 | return sprintf(page, "%d\n", read_brightness(NULL)); | ||
898 | } | ||
899 | |||
900 | static int | ||
901 | proc_write_brn(struct file *file, const char __user *buffer, | ||
902 | unsigned long count, void *data) | ||
903 | { | ||
904 | int rv, value; | ||
905 | |||
906 | rv = parse_arg(buffer, count, &value); | ||
907 | if (rv > 0) { | ||
908 | value = (0 < value) ? ((15 < value) ? 15 : value) : 0; | ||
909 | /* 0 <= value <= 15 */ | ||
910 | set_brightness(value); | ||
911 | } | ||
912 | return rv; | ||
913 | } | ||
914 | |||
915 | static void set_display(int value) | ||
916 | { | ||
917 | /* no sanity check needed for now */ | ||
918 | if (!write_acpi_int(hotk->handle, hotk->methods->display_set, | ||
919 | value, NULL)) | ||
920 | printk(KERN_WARNING "Asus ACPI: Error setting display\n"); | ||
921 | return; | ||
922 | } | ||
923 | |||
924 | /* | ||
925 | * Now, *this* one could be more user-friendly, but so far, no-one has | ||
926 | * complained. The significance of bits is the same as in proc_write_disp() | ||
927 | */ | ||
928 | static int | ||
929 | proc_read_disp(char *page, char **start, off_t off, int count, int *eof, | ||
930 | void *data) | ||
931 | { | ||
932 | int value = 0; | ||
933 | |||
934 | if (!read_acpi_int(hotk->handle, hotk->methods->display_get, &value)) | ||
935 | printk(KERN_WARNING | ||
936 | "Asus ACPI: Error reading display status\n"); | ||
937 | value &= 0x07; /* needed for some models, shouldn't hurt others */ | ||
938 | return sprintf(page, "%d\n", value); | ||
939 | } | ||
940 | |||
941 | /* | ||
942 | * Experimental support for display switching. As of now: 1 should activate | ||
943 | * the LCD output, 2 should do for CRT, and 4 for TV-Out. Any combination | ||
944 | * (bitwise) of these will suffice. I never actually tested 3 displays hooked | ||
945 | * up simultaneously, so be warned. See the acpi4asus README for more info. | ||
946 | */ | ||
947 | static int | ||
948 | proc_write_disp(struct file *file, const char __user *buffer, | ||
949 | unsigned long count, void *data) | ||
950 | { | ||
951 | int rv, value; | ||
952 | |||
953 | rv = parse_arg(buffer, count, &value); | ||
954 | if (rv > 0) | ||
955 | set_display(value); | ||
956 | return rv; | ||
957 | } | ||
958 | |||
959 | typedef int (proc_readfunc) (char *page, char **start, off_t off, int count, | ||
960 | int *eof, void *data); | ||
961 | typedef int (proc_writefunc) (struct file *file, const char __user *buffer, | ||
962 | unsigned long count, void *data); | ||
963 | |||
964 | static int | ||
965 | asus_proc_add(char *name, proc_writefunc *writefunc, | ||
966 | proc_readfunc *readfunc, mode_t mode, | ||
967 | struct acpi_device *device) | ||
968 | { | ||
969 | struct proc_dir_entry *proc = | ||
970 | create_proc_entry(name, mode, acpi_device_dir(device)); | ||
971 | if (!proc) { | ||
972 | printk(KERN_WARNING " Unable to create %s fs entry\n", name); | ||
973 | return -1; | ||
974 | } | ||
975 | proc->write_proc = writefunc; | ||
976 | proc->read_proc = readfunc; | ||
977 | proc->data = acpi_driver_data(device); | ||
978 | proc->owner = THIS_MODULE; | ||
979 | proc->uid = asus_uid; | ||
980 | proc->gid = asus_gid; | ||
981 | return 0; | ||
982 | } | ||
983 | |||
984 | static int asus_hotk_add_fs(struct acpi_device *device) | ||
985 | { | ||
986 | struct proc_dir_entry *proc; | ||
987 | mode_t mode; | ||
988 | |||
989 | /* | ||
990 | * If parameter uid or gid is not changed, keep the default setting for | ||
991 | * our proc entries (-rw-rw-rw-) else, it means we care about security, | ||
992 | * and then set to -rw-rw---- | ||
993 | */ | ||
994 | |||
995 | if ((asus_uid == 0) && (asus_gid == 0)) { | ||
996 | mode = S_IFREG | S_IRUGO | S_IWUGO; | ||
997 | } else { | ||
998 | mode = S_IFREG | S_IRUSR | S_IRGRP | S_IWUSR | S_IWGRP; | ||
999 | printk(KERN_WARNING " asus_uid and asus_gid parameters are " | ||
1000 | "deprecated, use chown and chmod instead!\n"); | ||
1001 | } | ||
1002 | |||
1003 | acpi_device_dir(device) = asus_proc_dir; | ||
1004 | if (!acpi_device_dir(device)) | ||
1005 | return -ENODEV; | ||
1006 | |||
1007 | proc = create_proc_entry(PROC_INFO, mode, acpi_device_dir(device)); | ||
1008 | if (proc) { | ||
1009 | proc->read_proc = proc_read_info; | ||
1010 | proc->data = acpi_driver_data(device); | ||
1011 | proc->owner = THIS_MODULE; | ||
1012 | proc->uid = asus_uid; | ||
1013 | proc->gid = asus_gid; | ||
1014 | } else { | ||
1015 | printk(KERN_WARNING " Unable to create " PROC_INFO | ||
1016 | " fs entry\n"); | ||
1017 | } | ||
1018 | |||
1019 | if (hotk->methods->mt_wled) { | ||
1020 | asus_proc_add(PROC_WLED, &proc_write_wled, &proc_read_wled, | ||
1021 | mode, device); | ||
1022 | } | ||
1023 | |||
1024 | if (hotk->methods->mt_ledd) { | ||
1025 | asus_proc_add(PROC_LEDD, &proc_write_ledd, &proc_read_ledd, | ||
1026 | mode, device); | ||
1027 | } | ||
1028 | |||
1029 | if (hotk->methods->mt_mled) { | ||
1030 | asus_proc_add(PROC_MLED, &proc_write_mled, &proc_read_mled, | ||
1031 | mode, device); | ||
1032 | } | ||
1033 | |||
1034 | if (hotk->methods->mt_tled) { | ||
1035 | asus_proc_add(PROC_TLED, &proc_write_tled, &proc_read_tled, | ||
1036 | mode, device); | ||
1037 | } | ||
1038 | |||
1039 | if (hotk->methods->mt_bt_switch) { | ||
1040 | asus_proc_add(PROC_BT, &proc_write_bluetooth, | ||
1041 | &proc_read_bluetooth, mode, device); | ||
1042 | } | ||
1043 | |||
1044 | /* | ||
1045 | * We need both read node and write method as LCD switch is also | ||
1046 | * accessible from the keyboard | ||
1047 | */ | ||
1048 | if (hotk->methods->mt_lcd_switch && hotk->methods->lcd_status) { | ||
1049 | asus_proc_add(PROC_LCD, &proc_write_lcd, &proc_read_lcd, mode, | ||
1050 | device); | ||
1051 | } | ||
1052 | |||
1053 | if ((hotk->methods->brightness_up && hotk->methods->brightness_down) || | ||
1054 | (hotk->methods->brightness_get && hotk->methods->brightness_set)) { | ||
1055 | asus_proc_add(PROC_BRN, &proc_write_brn, &proc_read_brn, mode, | ||
1056 | device); | ||
1057 | } | ||
1058 | |||
1059 | if (hotk->methods->display_set) { | ||
1060 | asus_proc_add(PROC_DISP, &proc_write_disp, &proc_read_disp, | ||
1061 | mode, device); | ||
1062 | } | ||
1063 | |||
1064 | return 0; | ||
1065 | } | ||
1066 | |||
1067 | static int asus_hotk_remove_fs(struct acpi_device *device) | ||
1068 | { | ||
1069 | if (acpi_device_dir(device)) { | ||
1070 | remove_proc_entry(PROC_INFO, acpi_device_dir(device)); | ||
1071 | if (hotk->methods->mt_wled) | ||
1072 | remove_proc_entry(PROC_WLED, acpi_device_dir(device)); | ||
1073 | if (hotk->methods->mt_mled) | ||
1074 | remove_proc_entry(PROC_MLED, acpi_device_dir(device)); | ||
1075 | if (hotk->methods->mt_tled) | ||
1076 | remove_proc_entry(PROC_TLED, acpi_device_dir(device)); | ||
1077 | if (hotk->methods->mt_ledd) | ||
1078 | remove_proc_entry(PROC_LEDD, acpi_device_dir(device)); | ||
1079 | if (hotk->methods->mt_bt_switch) | ||
1080 | remove_proc_entry(PROC_BT, acpi_device_dir(device)); | ||
1081 | if (hotk->methods->mt_lcd_switch && hotk->methods->lcd_status) | ||
1082 | remove_proc_entry(PROC_LCD, acpi_device_dir(device)); | ||
1083 | if ((hotk->methods->brightness_up | ||
1084 | && hotk->methods->brightness_down) | ||
1085 | || (hotk->methods->brightness_get | ||
1086 | && hotk->methods->brightness_set)) | ||
1087 | remove_proc_entry(PROC_BRN, acpi_device_dir(device)); | ||
1088 | if (hotk->methods->display_set) | ||
1089 | remove_proc_entry(PROC_DISP, acpi_device_dir(device)); | ||
1090 | } | ||
1091 | return 0; | ||
1092 | } | ||
1093 | |||
1094 | static void asus_hotk_notify(acpi_handle handle, u32 event, void *data) | ||
1095 | { | ||
1096 | /* TODO Find a better way to handle events count. */ | ||
1097 | if (!hotk) | ||
1098 | return; | ||
1099 | |||
1100 | if ((event & ~((u32) BR_UP)) < 16) | ||
1101 | hotk->brightness = (event & ~((u32) BR_UP)); | ||
1102 | else if ((event & ~((u32) BR_DOWN)) < 16) | ||
1103 | hotk->brightness = (event & ~((u32) BR_DOWN)); | ||
1104 | |||
1105 | acpi_bus_generate_proc_event(hotk->device, event, | ||
1106 | hotk->event_count[event % 128]++); | ||
1107 | |||
1108 | return; | ||
1109 | } | ||
1110 | |||
1111 | /* | ||
1112 | * Match the model string to the list of supported models. Return END_MODEL if | ||
1113 | * no match or model is NULL. | ||
1114 | */ | ||
1115 | static int asus_model_match(char *model) | ||
1116 | { | ||
1117 | if (model == NULL) | ||
1118 | return END_MODEL; | ||
1119 | |||
1120 | if (strncmp(model, "L3D", 3) == 0) | ||
1121 | return L3D; | ||
1122 | else if (strncmp(model, "L2E", 3) == 0 || | ||
1123 | strncmp(model, "L3H", 3) == 0 || strncmp(model, "L5D", 3) == 0) | ||
1124 | return L3H; | ||
1125 | else if (strncmp(model, "L3", 2) == 0 || strncmp(model, "L2B", 3) == 0) | ||
1126 | return L3C; | ||
1127 | else if (strncmp(model, "L8L", 3) == 0) | ||
1128 | return L8L; | ||
1129 | else if (strncmp(model, "L4R", 3) == 0) | ||
1130 | return L4R; | ||
1131 | else if (strncmp(model, "M6N", 3) == 0 || strncmp(model, "W3N", 3) == 0) | ||
1132 | return M6N; | ||
1133 | else if (strncmp(model, "M6R", 3) == 0 || strncmp(model, "A3G", 3) == 0) | ||
1134 | return M6R; | ||
1135 | else if (strncmp(model, "M2N", 3) == 0 || | ||
1136 | strncmp(model, "M3N", 3) == 0 || | ||
1137 | strncmp(model, "M5N", 3) == 0 || | ||
1138 | strncmp(model, "M6N", 3) == 0 || | ||
1139 | strncmp(model, "S1N", 3) == 0 || | ||
1140 | strncmp(model, "S5N", 3) == 0 || strncmp(model, "W1N", 3) == 0) | ||
1141 | return xxN; | ||
1142 | else if (strncmp(model, "M1", 2) == 0) | ||
1143 | return M1A; | ||
1144 | else if (strncmp(model, "M2", 2) == 0 || strncmp(model, "L4E", 3) == 0) | ||
1145 | return M2E; | ||
1146 | else if (strncmp(model, "L2", 2) == 0) | ||
1147 | return L2D; | ||
1148 | else if (strncmp(model, "L8", 2) == 0) | ||
1149 | return S1x; | ||
1150 | else if (strncmp(model, "D1", 2) == 0) | ||
1151 | return D1x; | ||
1152 | else if (strncmp(model, "A1", 2) == 0) | ||
1153 | return A1x; | ||
1154 | else if (strncmp(model, "A2", 2) == 0) | ||
1155 | return A2x; | ||
1156 | else if (strncmp(model, "J1", 2) == 0) | ||
1157 | return S2x; | ||
1158 | else if (strncmp(model, "L5", 2) == 0) | ||
1159 | return L5x; | ||
1160 | else if (strncmp(model, "A4G", 3) == 0) | ||
1161 | return A4G; | ||
1162 | else if (strncmp(model, "W1N", 3) == 0) | ||
1163 | return W1N; | ||
1164 | else if (strncmp(model, "W3V", 3) == 0) | ||
1165 | return W3V; | ||
1166 | else if (strncmp(model, "W5A", 3) == 0) | ||
1167 | return W5A; | ||
1168 | else if (strncmp(model, "A4S", 3) == 0) | ||
1169 | return A4S; | ||
1170 | else if (strncmp(model, "F3Sa", 4) == 0) | ||
1171 | return F3Sa; | ||
1172 | else | ||
1173 | return END_MODEL; | ||
1174 | } | ||
1175 | |||
1176 | /* | ||
1177 | * This function is used to initialize the hotk with right values. In this | ||
1178 | * method, we can make all the detection we want, and modify the hotk struct | ||
1179 | */ | ||
1180 | static int asus_hotk_get_info(void) | ||
1181 | { | ||
1182 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
1183 | union acpi_object *model = NULL; | ||
1184 | int bsts_result; | ||
1185 | char *string = NULL; | ||
1186 | acpi_status status; | ||
1187 | |||
1188 | /* | ||
1189 | * Get DSDT headers early enough to allow for differentiating between | ||
1190 | * models, but late enough to allow acpi_bus_register_driver() to fail | ||
1191 | * before doing anything ACPI-specific. Should we encounter a machine, | ||
1192 | * which needs special handling (i.e. its hotkey device has a different | ||
1193 | * HID), this bit will be moved. A global variable asus_info contains | ||
1194 | * the DSDT header. | ||
1195 | */ | ||
1196 | status = acpi_get_table(ACPI_SIG_DSDT, 1, &asus_info); | ||
1197 | if (ACPI_FAILURE(status)) | ||
1198 | printk(KERN_WARNING " Couldn't get the DSDT table header\n"); | ||
1199 | |||
1200 | /* We have to write 0 on init this far for all ASUS models */ | ||
1201 | if (!write_acpi_int(hotk->handle, "INIT", 0, &buffer)) { | ||
1202 | printk(KERN_ERR " Hotkey initialization failed\n"); | ||
1203 | return -ENODEV; | ||
1204 | } | ||
1205 | |||
1206 | /* This needs to be called for some laptops to init properly */ | ||
1207 | if (!read_acpi_int(hotk->handle, "BSTS", &bsts_result)) | ||
1208 | printk(KERN_WARNING " Error calling BSTS\n"); | ||
1209 | else if (bsts_result) | ||
1210 | printk(KERN_NOTICE " BSTS called, 0x%02x returned\n", | ||
1211 | bsts_result); | ||
1212 | |||
1213 | /* | ||
1214 | * Try to match the object returned by INIT to the specific model. | ||
1215 | * Handle every possible object (or the lack of thereof) the DSDT | ||
1216 | * writers might throw at us. When in trouble, we pass NULL to | ||
1217 | * asus_model_match() and try something completely different. | ||
1218 | */ | ||
1219 | if (buffer.pointer) { | ||
1220 | model = buffer.pointer; | ||
1221 | switch (model->type) { | ||
1222 | case ACPI_TYPE_STRING: | ||
1223 | string = model->string.pointer; | ||
1224 | break; | ||
1225 | case ACPI_TYPE_BUFFER: | ||
1226 | string = model->buffer.pointer; | ||
1227 | break; | ||
1228 | default: | ||
1229 | kfree(model); | ||
1230 | model = NULL; | ||
1231 | break; | ||
1232 | } | ||
1233 | } | ||
1234 | hotk->model = asus_model_match(string); | ||
1235 | if (hotk->model == END_MODEL) { /* match failed */ | ||
1236 | if (asus_info && | ||
1237 | strncmp(asus_info->oem_table_id, "ODEM", 4) == 0) { | ||
1238 | hotk->model = P30; | ||
1239 | printk(KERN_NOTICE | ||
1240 | " Samsung P30 detected, supported\n"); | ||
1241 | } else { | ||
1242 | hotk->model = M2E; | ||
1243 | printk(KERN_NOTICE " unsupported model %s, trying " | ||
1244 | "default values\n", string); | ||
1245 | printk(KERN_NOTICE | ||
1246 | " send /proc/acpi/dsdt to the developers\n"); | ||
1247 | kfree(model); | ||
1248 | return -ENODEV; | ||
1249 | } | ||
1250 | hotk->methods = &model_conf[hotk->model]; | ||
1251 | return AE_OK; | ||
1252 | } | ||
1253 | hotk->methods = &model_conf[hotk->model]; | ||
1254 | printk(KERN_NOTICE " %s model detected, supported\n", string); | ||
1255 | |||
1256 | /* Sort of per-model blacklist */ | ||
1257 | if (strncmp(string, "L2B", 3) == 0) | ||
1258 | hotk->methods->lcd_status = NULL; | ||
1259 | /* L2B is similar enough to L3C to use its settings, with this only | ||
1260 | exception */ | ||
1261 | else if (strncmp(string, "A3G", 3) == 0) | ||
1262 | hotk->methods->lcd_status = "\\BLFG"; | ||
1263 | /* A3G is like M6R */ | ||
1264 | else if (strncmp(string, "S5N", 3) == 0 || | ||
1265 | strncmp(string, "M5N", 3) == 0 || | ||
1266 | strncmp(string, "W3N", 3) == 0) | ||
1267 | hotk->methods->mt_mled = NULL; | ||
1268 | /* S5N, M5N and W3N have no MLED */ | ||
1269 | else if (strncmp(string, "L5D", 3) == 0) | ||
1270 | hotk->methods->mt_wled = NULL; | ||
1271 | /* L5D's WLED is not controlled by ACPI */ | ||
1272 | else if (strncmp(string, "M2N", 3) == 0 || | ||
1273 | strncmp(string, "W3V", 3) == 0 || | ||
1274 | strncmp(string, "S1N", 3) == 0) | ||
1275 | hotk->methods->mt_wled = "WLED"; | ||
1276 | /* M2N, S1N and W3V have a usable WLED */ | ||
1277 | else if (asus_info) { | ||
1278 | if (strncmp(asus_info->oem_table_id, "L1", 2) == 0) | ||
1279 | hotk->methods->mled_status = NULL; | ||
1280 | /* S1300A reports L84F, but L1400B too, account for that */ | ||
1281 | } | ||
1282 | |||
1283 | kfree(model); | ||
1284 | |||
1285 | return AE_OK; | ||
1286 | } | ||
1287 | |||
1288 | static int asus_hotk_check(void) | ||
1289 | { | ||
1290 | int result = 0; | ||
1291 | |||
1292 | result = acpi_bus_get_status(hotk->device); | ||
1293 | if (result) | ||
1294 | return result; | ||
1295 | |||
1296 | if (hotk->device->status.present) { | ||
1297 | result = asus_hotk_get_info(); | ||
1298 | } else { | ||
1299 | printk(KERN_ERR " Hotkey device not present, aborting\n"); | ||
1300 | return -EINVAL; | ||
1301 | } | ||
1302 | |||
1303 | return result; | ||
1304 | } | ||
1305 | |||
1306 | static int asus_hotk_found; | ||
1307 | |||
1308 | static int asus_hotk_add(struct acpi_device *device) | ||
1309 | { | ||
1310 | acpi_status status = AE_OK; | ||
1311 | int result; | ||
1312 | |||
1313 | if (!device) | ||
1314 | return -EINVAL; | ||
1315 | |||
1316 | printk(KERN_NOTICE "Asus Laptop ACPI Extras version %s\n", | ||
1317 | ASUS_ACPI_VERSION); | ||
1318 | |||
1319 | hotk = kzalloc(sizeof(struct asus_hotk), GFP_KERNEL); | ||
1320 | if (!hotk) | ||
1321 | return -ENOMEM; | ||
1322 | |||
1323 | hotk->handle = device->handle; | ||
1324 | strcpy(acpi_device_name(device), ACPI_HOTK_DEVICE_NAME); | ||
1325 | strcpy(acpi_device_class(device), ACPI_HOTK_CLASS); | ||
1326 | device->driver_data = hotk; | ||
1327 | hotk->device = device; | ||
1328 | |||
1329 | result = asus_hotk_check(); | ||
1330 | if (result) | ||
1331 | goto end; | ||
1332 | |||
1333 | result = asus_hotk_add_fs(device); | ||
1334 | if (result) | ||
1335 | goto end; | ||
1336 | |||
1337 | /* | ||
1338 | * We install the handler, it will receive the hotk in parameter, so, we | ||
1339 | * could add other data to the hotk struct | ||
1340 | */ | ||
1341 | status = acpi_install_notify_handler(hotk->handle, ACPI_SYSTEM_NOTIFY, | ||
1342 | asus_hotk_notify, hotk); | ||
1343 | if (ACPI_FAILURE(status)) | ||
1344 | printk(KERN_ERR " Error installing notify handler\n"); | ||
1345 | |||
1346 | /* For laptops without GPLV: init the hotk->brightness value */ | ||
1347 | if ((!hotk->methods->brightness_get) | ||
1348 | && (!hotk->methods->brightness_status) | ||
1349 | && (hotk->methods->brightness_up && hotk->methods->brightness_down)) { | ||
1350 | status = | ||
1351 | acpi_evaluate_object(NULL, hotk->methods->brightness_down, | ||
1352 | NULL, NULL); | ||
1353 | if (ACPI_FAILURE(status)) | ||
1354 | printk(KERN_WARNING " Error changing brightness\n"); | ||
1355 | else { | ||
1356 | status = | ||
1357 | acpi_evaluate_object(NULL, | ||
1358 | hotk->methods->brightness_up, | ||
1359 | NULL, NULL); | ||
1360 | if (ACPI_FAILURE(status)) | ||
1361 | printk(KERN_WARNING " Strange, error changing" | ||
1362 | " brightness\n"); | ||
1363 | } | ||
1364 | } | ||
1365 | |||
1366 | asus_hotk_found = 1; | ||
1367 | |||
1368 | /* LED display is off by default */ | ||
1369 | hotk->ledd_status = 0xFFF; | ||
1370 | |||
1371 | end: | ||
1372 | if (result) | ||
1373 | kfree(hotk); | ||
1374 | |||
1375 | return result; | ||
1376 | } | ||
1377 | |||
1378 | static int asus_hotk_remove(struct acpi_device *device, int type) | ||
1379 | { | ||
1380 | acpi_status status = 0; | ||
1381 | |||
1382 | if (!device || !acpi_driver_data(device)) | ||
1383 | return -EINVAL; | ||
1384 | |||
1385 | status = acpi_remove_notify_handler(hotk->handle, ACPI_SYSTEM_NOTIFY, | ||
1386 | asus_hotk_notify); | ||
1387 | if (ACPI_FAILURE(status)) | ||
1388 | printk(KERN_ERR "Asus ACPI: Error removing notify handler\n"); | ||
1389 | |||
1390 | asus_hotk_remove_fs(device); | ||
1391 | |||
1392 | kfree(hotk); | ||
1393 | |||
1394 | return 0; | ||
1395 | } | ||
1396 | |||
1397 | static struct backlight_ops asus_backlight_data = { | ||
1398 | .get_brightness = read_brightness, | ||
1399 | .update_status = set_brightness_status, | ||
1400 | }; | ||
1401 | |||
1402 | static void asus_acpi_exit(void) | ||
1403 | { | ||
1404 | if (asus_backlight_device) | ||
1405 | backlight_device_unregister(asus_backlight_device); | ||
1406 | |||
1407 | acpi_bus_unregister_driver(&asus_hotk_driver); | ||
1408 | remove_proc_entry(PROC_ASUS, acpi_root_dir); | ||
1409 | |||
1410 | return; | ||
1411 | } | ||
1412 | |||
1413 | static int __init asus_acpi_init(void) | ||
1414 | { | ||
1415 | int result; | ||
1416 | |||
1417 | if (acpi_disabled) | ||
1418 | return -ENODEV; | ||
1419 | |||
1420 | asus_proc_dir = proc_mkdir(PROC_ASUS, acpi_root_dir); | ||
1421 | if (!asus_proc_dir) { | ||
1422 | printk(KERN_ERR "Asus ACPI: Unable to create /proc entry\n"); | ||
1423 | return -ENODEV; | ||
1424 | } | ||
1425 | asus_proc_dir->owner = THIS_MODULE; | ||
1426 | |||
1427 | result = acpi_bus_register_driver(&asus_hotk_driver); | ||
1428 | if (result < 0) { | ||
1429 | remove_proc_entry(PROC_ASUS, acpi_root_dir); | ||
1430 | return result; | ||
1431 | } | ||
1432 | |||
1433 | /* | ||
1434 | * This is a bit of a kludge. We only want this module loaded | ||
1435 | * for ASUS systems, but there's currently no way to probe the | ||
1436 | * ACPI namespace for ASUS HIDs. So we just return failure if | ||
1437 | * we didn't find one, which will cause the module to be | ||
1438 | * unloaded. | ||
1439 | */ | ||
1440 | if (!asus_hotk_found) { | ||
1441 | acpi_bus_unregister_driver(&asus_hotk_driver); | ||
1442 | remove_proc_entry(PROC_ASUS, acpi_root_dir); | ||
1443 | return -ENODEV; | ||
1444 | } | ||
1445 | |||
1446 | asus_backlight_device = backlight_device_register("asus", NULL, NULL, | ||
1447 | &asus_backlight_data); | ||
1448 | if (IS_ERR(asus_backlight_device)) { | ||
1449 | printk(KERN_ERR "Could not register asus backlight device\n"); | ||
1450 | asus_backlight_device = NULL; | ||
1451 | asus_acpi_exit(); | ||
1452 | return -ENODEV; | ||
1453 | } | ||
1454 | asus_backlight_device->props.max_brightness = 15; | ||
1455 | |||
1456 | return 0; | ||
1457 | } | ||
1458 | |||
1459 | module_init(asus_acpi_init); | ||
1460 | module_exit(asus_acpi_exit); | ||
diff --git a/drivers/platform/x86/compal-laptop.c b/drivers/platform/x86/compal-laptop.c new file mode 100644 index 000000000000..11003bba10d3 --- /dev/null +++ b/drivers/platform/x86/compal-laptop.c | |||
@@ -0,0 +1,406 @@ | |||
1 | /*-*-linux-c-*-*/ | ||
2 | |||
3 | /* | ||
4 | Copyright (C) 2008 Cezary Jackiewicz <cezary.jackiewicz (at) gmail.com> | ||
5 | |||
6 | based on MSI driver | ||
7 | |||
8 | Copyright (C) 2006 Lennart Poettering <mzxreary (at) 0pointer (dot) de> | ||
9 | |||
10 | This program is free software; you can redistribute it and/or modify | ||
11 | it under the terms of the GNU General Public License as published by | ||
12 | the Free Software Foundation; either version 2 of the License, or | ||
13 | (at your option) any later version. | ||
14 | |||
15 | This program is distributed in the hope that it will be useful, but | ||
16 | WITHOUT ANY WARRANTY; without even the implied warranty of | ||
17 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
18 | General Public License for more details. | ||
19 | |||
20 | You should have received a copy of the GNU General Public License | ||
21 | along with this program; if not, write to the Free Software | ||
22 | Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
23 | 02110-1301, USA. | ||
24 | */ | ||
25 | |||
26 | /* | ||
27 | * comapl-laptop.c - Compal laptop support. | ||
28 | * | ||
29 | * This driver exports a few files in /sys/devices/platform/compal-laptop/: | ||
30 | * | ||
31 | * wlan - wlan subsystem state: contains 0 or 1 (rw) | ||
32 | * | ||
33 | * bluetooth - Bluetooth subsystem state: contains 0 or 1 (rw) | ||
34 | * | ||
35 | * raw - raw value taken from embedded controller register (ro) | ||
36 | * | ||
37 | * In addition to these platform device attributes the driver | ||
38 | * registers itself in the Linux backlight control subsystem and is | ||
39 | * available to userspace under /sys/class/backlight/compal-laptop/. | ||
40 | * | ||
41 | * This driver might work on other laptops produced by Compal. If you | ||
42 | * want to try it you can pass force=1 as argument to the module which | ||
43 | * will force it to load even when the DMI data doesn't identify the | ||
44 | * laptop as FL9x. | ||
45 | */ | ||
46 | |||
47 | #include <linux/module.h> | ||
48 | #include <linux/kernel.h> | ||
49 | #include <linux/init.h> | ||
50 | #include <linux/acpi.h> | ||
51 | #include <linux/dmi.h> | ||
52 | #include <linux/backlight.h> | ||
53 | #include <linux/platform_device.h> | ||
54 | #include <linux/autoconf.h> | ||
55 | |||
56 | #define COMPAL_DRIVER_VERSION "0.2.6" | ||
57 | |||
58 | #define COMPAL_LCD_LEVEL_MAX 8 | ||
59 | |||
60 | #define COMPAL_EC_COMMAND_WIRELESS 0xBB | ||
61 | #define COMPAL_EC_COMMAND_LCD_LEVEL 0xB9 | ||
62 | |||
63 | #define KILLSWITCH_MASK 0x10 | ||
64 | #define WLAN_MASK 0x01 | ||
65 | #define BT_MASK 0x02 | ||
66 | |||
67 | static int force; | ||
68 | module_param(force, bool, 0); | ||
69 | MODULE_PARM_DESC(force, "Force driver load, ignore DMI data"); | ||
70 | |||
71 | /* Hardware access */ | ||
72 | |||
73 | static int set_lcd_level(int level) | ||
74 | { | ||
75 | if (level < 0 || level >= COMPAL_LCD_LEVEL_MAX) | ||
76 | return -EINVAL; | ||
77 | |||
78 | ec_write(COMPAL_EC_COMMAND_LCD_LEVEL, level); | ||
79 | |||
80 | return 0; | ||
81 | } | ||
82 | |||
83 | static int get_lcd_level(void) | ||
84 | { | ||
85 | u8 result; | ||
86 | |||
87 | ec_read(COMPAL_EC_COMMAND_LCD_LEVEL, &result); | ||
88 | |||
89 | return (int) result; | ||
90 | } | ||
91 | |||
92 | static int set_wlan_state(int state) | ||
93 | { | ||
94 | u8 result, value; | ||
95 | |||
96 | ec_read(COMPAL_EC_COMMAND_WIRELESS, &result); | ||
97 | |||
98 | if ((result & KILLSWITCH_MASK) == 0) | ||
99 | return -EINVAL; | ||
100 | else { | ||
101 | if (state) | ||
102 | value = (u8) (result | WLAN_MASK); | ||
103 | else | ||
104 | value = (u8) (result & ~WLAN_MASK); | ||
105 | ec_write(COMPAL_EC_COMMAND_WIRELESS, value); | ||
106 | } | ||
107 | |||
108 | return 0; | ||
109 | } | ||
110 | |||
111 | static int set_bluetooth_state(int state) | ||
112 | { | ||
113 | u8 result, value; | ||
114 | |||
115 | ec_read(COMPAL_EC_COMMAND_WIRELESS, &result); | ||
116 | |||
117 | if ((result & KILLSWITCH_MASK) == 0) | ||
118 | return -EINVAL; | ||
119 | else { | ||
120 | if (state) | ||
121 | value = (u8) (result | BT_MASK); | ||
122 | else | ||
123 | value = (u8) (result & ~BT_MASK); | ||
124 | ec_write(COMPAL_EC_COMMAND_WIRELESS, value); | ||
125 | } | ||
126 | |||
127 | return 0; | ||
128 | } | ||
129 | |||
130 | static int get_wireless_state(int *wlan, int *bluetooth) | ||
131 | { | ||
132 | u8 result; | ||
133 | |||
134 | ec_read(COMPAL_EC_COMMAND_WIRELESS, &result); | ||
135 | |||
136 | if (wlan) { | ||
137 | if ((result & KILLSWITCH_MASK) == 0) | ||
138 | *wlan = 0; | ||
139 | else | ||
140 | *wlan = result & WLAN_MASK; | ||
141 | } | ||
142 | |||
143 | if (bluetooth) { | ||
144 | if ((result & KILLSWITCH_MASK) == 0) | ||
145 | *bluetooth = 0; | ||
146 | else | ||
147 | *bluetooth = (result & BT_MASK) >> 1; | ||
148 | } | ||
149 | |||
150 | return 0; | ||
151 | } | ||
152 | |||
153 | /* Backlight device stuff */ | ||
154 | |||
155 | static int bl_get_brightness(struct backlight_device *b) | ||
156 | { | ||
157 | return get_lcd_level(); | ||
158 | } | ||
159 | |||
160 | |||
161 | static int bl_update_status(struct backlight_device *b) | ||
162 | { | ||
163 | return set_lcd_level(b->props.brightness); | ||
164 | } | ||
165 | |||
166 | static struct backlight_ops compalbl_ops = { | ||
167 | .get_brightness = bl_get_brightness, | ||
168 | .update_status = bl_update_status, | ||
169 | }; | ||
170 | |||
171 | static struct backlight_device *compalbl_device; | ||
172 | |||
173 | /* Platform device */ | ||
174 | |||
175 | static ssize_t show_wlan(struct device *dev, | ||
176 | struct device_attribute *attr, char *buf) | ||
177 | { | ||
178 | int ret, enabled; | ||
179 | |||
180 | ret = get_wireless_state(&enabled, NULL); | ||
181 | if (ret < 0) | ||
182 | return ret; | ||
183 | |||
184 | return sprintf(buf, "%i\n", enabled); | ||
185 | } | ||
186 | |||
187 | static ssize_t show_raw(struct device *dev, | ||
188 | struct device_attribute *attr, char *buf) | ||
189 | { | ||
190 | u8 result; | ||
191 | |||
192 | ec_read(COMPAL_EC_COMMAND_WIRELESS, &result); | ||
193 | |||
194 | return sprintf(buf, "%i\n", result); | ||
195 | } | ||
196 | |||
197 | static ssize_t show_bluetooth(struct device *dev, | ||
198 | struct device_attribute *attr, char *buf) | ||
199 | { | ||
200 | int ret, enabled; | ||
201 | |||
202 | ret = get_wireless_state(NULL, &enabled); | ||
203 | if (ret < 0) | ||
204 | return ret; | ||
205 | |||
206 | return sprintf(buf, "%i\n", enabled); | ||
207 | } | ||
208 | |||
209 | static ssize_t store_wlan_state(struct device *dev, | ||
210 | struct device_attribute *attr, const char *buf, size_t count) | ||
211 | { | ||
212 | int state, ret; | ||
213 | |||
214 | if (sscanf(buf, "%i", &state) != 1 || (state < 0 || state > 1)) | ||
215 | return -EINVAL; | ||
216 | |||
217 | ret = set_wlan_state(state); | ||
218 | if (ret < 0) | ||
219 | return ret; | ||
220 | |||
221 | return count; | ||
222 | } | ||
223 | |||
224 | static ssize_t store_bluetooth_state(struct device *dev, | ||
225 | struct device_attribute *attr, const char *buf, size_t count) | ||
226 | { | ||
227 | int state, ret; | ||
228 | |||
229 | if (sscanf(buf, "%i", &state) != 1 || (state < 0 || state > 1)) | ||
230 | return -EINVAL; | ||
231 | |||
232 | ret = set_bluetooth_state(state); | ||
233 | if (ret < 0) | ||
234 | return ret; | ||
235 | |||
236 | return count; | ||
237 | } | ||
238 | |||
239 | static DEVICE_ATTR(bluetooth, 0644, show_bluetooth, store_bluetooth_state); | ||
240 | static DEVICE_ATTR(wlan, 0644, show_wlan, store_wlan_state); | ||
241 | static DEVICE_ATTR(raw, 0444, show_raw, NULL); | ||
242 | |||
243 | static struct attribute *compal_attributes[] = { | ||
244 | &dev_attr_bluetooth.attr, | ||
245 | &dev_attr_wlan.attr, | ||
246 | &dev_attr_raw.attr, | ||
247 | NULL | ||
248 | }; | ||
249 | |||
250 | static struct attribute_group compal_attribute_group = { | ||
251 | .attrs = compal_attributes | ||
252 | }; | ||
253 | |||
254 | static struct platform_driver compal_driver = { | ||
255 | .driver = { | ||
256 | .name = "compal-laptop", | ||
257 | .owner = THIS_MODULE, | ||
258 | } | ||
259 | }; | ||
260 | |||
261 | static struct platform_device *compal_device; | ||
262 | |||
263 | /* Initialization */ | ||
264 | |||
265 | static int dmi_check_cb(const struct dmi_system_id *id) | ||
266 | { | ||
267 | printk(KERN_INFO "compal-laptop: Identified laptop model '%s'.\n", | ||
268 | id->ident); | ||
269 | |||
270 | return 0; | ||
271 | } | ||
272 | |||
273 | static struct dmi_system_id __initdata compal_dmi_table[] = { | ||
274 | { | ||
275 | .ident = "FL90/IFL90", | ||
276 | .matches = { | ||
277 | DMI_MATCH(DMI_BOARD_NAME, "IFL90"), | ||
278 | DMI_MATCH(DMI_BOARD_VERSION, "IFT00"), | ||
279 | }, | ||
280 | .callback = dmi_check_cb | ||
281 | }, | ||
282 | { | ||
283 | .ident = "FL90/IFL90", | ||
284 | .matches = { | ||
285 | DMI_MATCH(DMI_BOARD_NAME, "IFL90"), | ||
286 | DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"), | ||
287 | }, | ||
288 | .callback = dmi_check_cb | ||
289 | }, | ||
290 | { | ||
291 | .ident = "FL91/IFL91", | ||
292 | .matches = { | ||
293 | DMI_MATCH(DMI_BOARD_NAME, "IFL91"), | ||
294 | DMI_MATCH(DMI_BOARD_VERSION, "IFT00"), | ||
295 | }, | ||
296 | .callback = dmi_check_cb | ||
297 | }, | ||
298 | { | ||
299 | .ident = "FL92/JFL92", | ||
300 | .matches = { | ||
301 | DMI_MATCH(DMI_BOARD_NAME, "JFL92"), | ||
302 | DMI_MATCH(DMI_BOARD_VERSION, "IFT00"), | ||
303 | }, | ||
304 | .callback = dmi_check_cb | ||
305 | }, | ||
306 | { | ||
307 | .ident = "FT00/IFT00", | ||
308 | .matches = { | ||
309 | DMI_MATCH(DMI_BOARD_NAME, "IFT00"), | ||
310 | DMI_MATCH(DMI_BOARD_VERSION, "IFT00"), | ||
311 | }, | ||
312 | .callback = dmi_check_cb | ||
313 | }, | ||
314 | { } | ||
315 | }; | ||
316 | |||
317 | static int __init compal_init(void) | ||
318 | { | ||
319 | int ret; | ||
320 | |||
321 | if (acpi_disabled) | ||
322 | return -ENODEV; | ||
323 | |||
324 | if (!force && !dmi_check_system(compal_dmi_table)) | ||
325 | return -ENODEV; | ||
326 | |||
327 | /* Register backlight stuff */ | ||
328 | |||
329 | if (!acpi_video_backlight_support()) { | ||
330 | compalbl_device = backlight_device_register("compal-laptop", NULL, NULL, | ||
331 | &compalbl_ops); | ||
332 | if (IS_ERR(compalbl_device)) | ||
333 | return PTR_ERR(compalbl_device); | ||
334 | |||
335 | compalbl_device->props.max_brightness = COMPAL_LCD_LEVEL_MAX-1; | ||
336 | } | ||
337 | |||
338 | ret = platform_driver_register(&compal_driver); | ||
339 | if (ret) | ||
340 | goto fail_backlight; | ||
341 | |||
342 | /* Register platform stuff */ | ||
343 | |||
344 | compal_device = platform_device_alloc("compal-laptop", -1); | ||
345 | if (!compal_device) { | ||
346 | ret = -ENOMEM; | ||
347 | goto fail_platform_driver; | ||
348 | } | ||
349 | |||
350 | ret = platform_device_add(compal_device); | ||
351 | if (ret) | ||
352 | goto fail_platform_device1; | ||
353 | |||
354 | ret = sysfs_create_group(&compal_device->dev.kobj, | ||
355 | &compal_attribute_group); | ||
356 | if (ret) | ||
357 | goto fail_platform_device2; | ||
358 | |||
359 | printk(KERN_INFO "compal-laptop: driver "COMPAL_DRIVER_VERSION | ||
360 | " successfully loaded.\n"); | ||
361 | |||
362 | return 0; | ||
363 | |||
364 | fail_platform_device2: | ||
365 | |||
366 | platform_device_del(compal_device); | ||
367 | |||
368 | fail_platform_device1: | ||
369 | |||
370 | platform_device_put(compal_device); | ||
371 | |||
372 | fail_platform_driver: | ||
373 | |||
374 | platform_driver_unregister(&compal_driver); | ||
375 | |||
376 | fail_backlight: | ||
377 | |||
378 | backlight_device_unregister(compalbl_device); | ||
379 | |||
380 | return ret; | ||
381 | } | ||
382 | |||
383 | static void __exit compal_cleanup(void) | ||
384 | { | ||
385 | |||
386 | sysfs_remove_group(&compal_device->dev.kobj, &compal_attribute_group); | ||
387 | platform_device_unregister(compal_device); | ||
388 | platform_driver_unregister(&compal_driver); | ||
389 | backlight_device_unregister(compalbl_device); | ||
390 | |||
391 | printk(KERN_INFO "compal-laptop: driver unloaded.\n"); | ||
392 | } | ||
393 | |||
394 | module_init(compal_init); | ||
395 | module_exit(compal_cleanup); | ||
396 | |||
397 | MODULE_AUTHOR("Cezary Jackiewicz"); | ||
398 | MODULE_DESCRIPTION("Compal Laptop Support"); | ||
399 | MODULE_VERSION(COMPAL_DRIVER_VERSION); | ||
400 | MODULE_LICENSE("GPL"); | ||
401 | |||
402 | MODULE_ALIAS("dmi:*:rnIFL90:rvrIFT00:*"); | ||
403 | MODULE_ALIAS("dmi:*:rnIFL90:rvrREFERENCE:*"); | ||
404 | MODULE_ALIAS("dmi:*:rnIFL91:rvrIFT00:*"); | ||
405 | MODULE_ALIAS("dmi:*:rnJFL92:rvrIFT00:*"); | ||
406 | MODULE_ALIAS("dmi:*:rnIFT00:rvrIFT00:*"); | ||
diff --git a/drivers/platform/x86/eeepc-laptop.c b/drivers/platform/x86/eeepc-laptop.c new file mode 100644 index 000000000000..02fe2b8b8939 --- /dev/null +++ b/drivers/platform/x86/eeepc-laptop.c | |||
@@ -0,0 +1,872 @@ | |||
1 | /* | ||
2 | * eepc-laptop.c - Asus Eee PC extras | ||
3 | * | ||
4 | * Based on asus_acpi.c as patched for the Eee PC by Asus: | ||
5 | * ftp://ftp.asus.com/pub/ASUS/EeePC/701/ASUS_ACPI_071126.rar | ||
6 | * Based on eee.c from eeepc-linux | ||
7 | * | ||
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. | ||
12 | * | ||
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. | ||
17 | */ | ||
18 | |||
19 | #include <linux/kernel.h> | ||
20 | #include <linux/module.h> | ||
21 | #include <linux/init.h> | ||
22 | #include <linux/types.h> | ||
23 | #include <linux/platform_device.h> | ||
24 | #include <linux/backlight.h> | ||
25 | #include <linux/fb.h> | ||
26 | #include <linux/hwmon.h> | ||
27 | #include <linux/hwmon-sysfs.h> | ||
28 | #include <acpi/acpi_drivers.h> | ||
29 | #include <acpi/acpi_bus.h> | ||
30 | #include <linux/uaccess.h> | ||
31 | #include <linux/input.h> | ||
32 | #include <linux/rfkill.h> | ||
33 | |||
34 | #define EEEPC_LAPTOP_VERSION "0.1" | ||
35 | |||
36 | #define EEEPC_HOTK_NAME "Eee PC Hotkey Driver" | ||
37 | #define EEEPC_HOTK_FILE "eeepc" | ||
38 | #define EEEPC_HOTK_CLASS "hotkey" | ||
39 | #define EEEPC_HOTK_DEVICE_NAME "Hotkey" | ||
40 | #define EEEPC_HOTK_HID "ASUS010" | ||
41 | |||
42 | #define EEEPC_LOG EEEPC_HOTK_FILE ": " | ||
43 | #define EEEPC_ERR KERN_ERR EEEPC_LOG | ||
44 | #define EEEPC_WARNING KERN_WARNING EEEPC_LOG | ||
45 | #define EEEPC_NOTICE KERN_NOTICE EEEPC_LOG | ||
46 | #define EEEPC_INFO KERN_INFO EEEPC_LOG | ||
47 | |||
48 | /* | ||
49 | * Definitions for Asus EeePC | ||
50 | */ | ||
51 | #define NOTIFY_WLAN_ON 0x10 | ||
52 | #define NOTIFY_BRN_MIN 0x20 | ||
53 | #define NOTIFY_BRN_MAX 0x2f | ||
54 | |||
55 | enum { | ||
56 | DISABLE_ASL_WLAN = 0x0001, | ||
57 | DISABLE_ASL_BLUETOOTH = 0x0002, | ||
58 | DISABLE_ASL_IRDA = 0x0004, | ||
59 | DISABLE_ASL_CAMERA = 0x0008, | ||
60 | DISABLE_ASL_TV = 0x0010, | ||
61 | DISABLE_ASL_GPS = 0x0020, | ||
62 | DISABLE_ASL_DISPLAYSWITCH = 0x0040, | ||
63 | DISABLE_ASL_MODEM = 0x0080, | ||
64 | DISABLE_ASL_CARDREADER = 0x0100 | ||
65 | }; | ||
66 | |||
67 | enum { | ||
68 | CM_ASL_WLAN = 0, | ||
69 | CM_ASL_BLUETOOTH, | ||
70 | CM_ASL_IRDA, | ||
71 | CM_ASL_1394, | ||
72 | CM_ASL_CAMERA, | ||
73 | CM_ASL_TV, | ||
74 | CM_ASL_GPS, | ||
75 | CM_ASL_DVDROM, | ||
76 | CM_ASL_DISPLAYSWITCH, | ||
77 | CM_ASL_PANELBRIGHT, | ||
78 | CM_ASL_BIOSFLASH, | ||
79 | CM_ASL_ACPIFLASH, | ||
80 | CM_ASL_CPUFV, | ||
81 | CM_ASL_CPUTEMPERATURE, | ||
82 | CM_ASL_FANCPU, | ||
83 | CM_ASL_FANCHASSIS, | ||
84 | CM_ASL_USBPORT1, | ||
85 | CM_ASL_USBPORT2, | ||
86 | CM_ASL_USBPORT3, | ||
87 | CM_ASL_MODEM, | ||
88 | CM_ASL_CARDREADER, | ||
89 | CM_ASL_LID | ||
90 | }; | ||
91 | |||
92 | static const char *cm_getv[] = { | ||
93 | "WLDG", NULL, NULL, NULL, | ||
94 | "CAMG", NULL, NULL, NULL, | ||
95 | NULL, "PBLG", NULL, NULL, | ||
96 | "CFVG", NULL, NULL, NULL, | ||
97 | "USBG", NULL, NULL, "MODG", | ||
98 | "CRDG", "LIDG" | ||
99 | }; | ||
100 | |||
101 | static const char *cm_setv[] = { | ||
102 | "WLDS", NULL, NULL, NULL, | ||
103 | "CAMS", NULL, NULL, NULL, | ||
104 | "SDSP", "PBLS", "HDPS", NULL, | ||
105 | "CFVS", NULL, NULL, NULL, | ||
106 | "USBG", NULL, NULL, "MODS", | ||
107 | "CRDS", NULL | ||
108 | }; | ||
109 | |||
110 | #define EEEPC_EC "\\_SB.PCI0.SBRG.EC0." | ||
111 | |||
112 | #define EEEPC_EC_FAN_PWM EEEPC_EC "SC02" /* Fan PWM duty cycle (%) */ | ||
113 | #define EEEPC_EC_SC02 0x63 | ||
114 | #define EEEPC_EC_FAN_HRPM EEEPC_EC "SC05" /* High byte, fan speed (RPM) */ | ||
115 | #define EEEPC_EC_FAN_LRPM EEEPC_EC "SC06" /* Low byte, fan speed (RPM) */ | ||
116 | #define EEEPC_EC_FAN_CTRL EEEPC_EC "SFB3" /* Byte containing SF25 */ | ||
117 | #define EEEPC_EC_SFB3 0xD3 | ||
118 | |||
119 | /* | ||
120 | * This is the main structure, we can use it to store useful information | ||
121 | * about the hotk device | ||
122 | */ | ||
123 | struct eeepc_hotk { | ||
124 | struct acpi_device *device; /* the device we are in */ | ||
125 | acpi_handle handle; /* the handle of the hotk device */ | ||
126 | u32 cm_supported; /* the control methods supported | ||
127 | by this BIOS */ | ||
128 | uint init_flag; /* Init flags */ | ||
129 | u16 event_count[128]; /* count for each event */ | ||
130 | struct input_dev *inputdev; | ||
131 | u16 *keycode_map; | ||
132 | struct rfkill *eeepc_wlan_rfkill; | ||
133 | struct rfkill *eeepc_bluetooth_rfkill; | ||
134 | }; | ||
135 | |||
136 | /* The actual device the driver binds to */ | ||
137 | static struct eeepc_hotk *ehotk; | ||
138 | |||
139 | /* Platform device/driver */ | ||
140 | static struct platform_driver platform_driver = { | ||
141 | .driver = { | ||
142 | .name = EEEPC_HOTK_FILE, | ||
143 | .owner = THIS_MODULE, | ||
144 | } | ||
145 | }; | ||
146 | |||
147 | static struct platform_device *platform_device; | ||
148 | |||
149 | struct key_entry { | ||
150 | char type; | ||
151 | u8 code; | ||
152 | u16 keycode; | ||
153 | }; | ||
154 | |||
155 | enum { KE_KEY, KE_END }; | ||
156 | |||
157 | static struct key_entry eeepc_keymap[] = { | ||
158 | /* Sleep already handled via generic ACPI code */ | ||
159 | {KE_KEY, 0x10, KEY_WLAN }, | ||
160 | {KE_KEY, 0x12, KEY_PROG1 }, | ||
161 | {KE_KEY, 0x13, KEY_MUTE }, | ||
162 | {KE_KEY, 0x14, KEY_VOLUMEDOWN }, | ||
163 | {KE_KEY, 0x15, KEY_VOLUMEUP }, | ||
164 | {KE_KEY, 0x30, KEY_SWITCHVIDEOMODE }, | ||
165 | {KE_KEY, 0x31, KEY_SWITCHVIDEOMODE }, | ||
166 | {KE_KEY, 0x32, KEY_SWITCHVIDEOMODE }, | ||
167 | {KE_END, 0}, | ||
168 | }; | ||
169 | |||
170 | /* | ||
171 | * The hotkey driver declaration | ||
172 | */ | ||
173 | static int eeepc_hotk_add(struct acpi_device *device); | ||
174 | static int eeepc_hotk_remove(struct acpi_device *device, int type); | ||
175 | |||
176 | static const struct acpi_device_id eeepc_device_ids[] = { | ||
177 | {EEEPC_HOTK_HID, 0}, | ||
178 | {"", 0}, | ||
179 | }; | ||
180 | MODULE_DEVICE_TABLE(acpi, eeepc_device_ids); | ||
181 | |||
182 | static struct acpi_driver eeepc_hotk_driver = { | ||
183 | .name = EEEPC_HOTK_NAME, | ||
184 | .class = EEEPC_HOTK_CLASS, | ||
185 | .ids = eeepc_device_ids, | ||
186 | .ops = { | ||
187 | .add = eeepc_hotk_add, | ||
188 | .remove = eeepc_hotk_remove, | ||
189 | }, | ||
190 | }; | ||
191 | |||
192 | /* The backlight device /sys/class/backlight */ | ||
193 | static struct backlight_device *eeepc_backlight_device; | ||
194 | |||
195 | /* The hwmon device */ | ||
196 | static struct device *eeepc_hwmon_device; | ||
197 | |||
198 | /* | ||
199 | * The backlight class declaration | ||
200 | */ | ||
201 | static int read_brightness(struct backlight_device *bd); | ||
202 | static int update_bl_status(struct backlight_device *bd); | ||
203 | static struct backlight_ops eeepcbl_ops = { | ||
204 | .get_brightness = read_brightness, | ||
205 | .update_status = update_bl_status, | ||
206 | }; | ||
207 | |||
208 | MODULE_AUTHOR("Corentin Chary, Eric Cooper"); | ||
209 | MODULE_DESCRIPTION(EEEPC_HOTK_NAME); | ||
210 | MODULE_LICENSE("GPL"); | ||
211 | |||
212 | /* | ||
213 | * ACPI Helpers | ||
214 | */ | ||
215 | static int write_acpi_int(acpi_handle handle, const char *method, int val, | ||
216 | struct acpi_buffer *output) | ||
217 | { | ||
218 | struct acpi_object_list params; | ||
219 | union acpi_object in_obj; | ||
220 | acpi_status status; | ||
221 | |||
222 | params.count = 1; | ||
223 | params.pointer = &in_obj; | ||
224 | in_obj.type = ACPI_TYPE_INTEGER; | ||
225 | in_obj.integer.value = val; | ||
226 | |||
227 | status = acpi_evaluate_object(handle, (char *)method, ¶ms, output); | ||
228 | return (status == AE_OK ? 0 : -1); | ||
229 | } | ||
230 | |||
231 | static int read_acpi_int(acpi_handle handle, const char *method, int *val) | ||
232 | { | ||
233 | acpi_status status; | ||
234 | unsigned long long result; | ||
235 | |||
236 | status = acpi_evaluate_integer(handle, (char *)method, NULL, &result); | ||
237 | if (ACPI_FAILURE(status)) { | ||
238 | *val = -1; | ||
239 | return -1; | ||
240 | } else { | ||
241 | *val = result; | ||
242 | return 0; | ||
243 | } | ||
244 | } | ||
245 | |||
246 | static int set_acpi(int cm, int value) | ||
247 | { | ||
248 | if (ehotk->cm_supported & (0x1 << cm)) { | ||
249 | const char *method = cm_setv[cm]; | ||
250 | if (method == NULL) | ||
251 | return -ENODEV; | ||
252 | if (write_acpi_int(ehotk->handle, method, value, NULL)) | ||
253 | printk(EEEPC_WARNING "Error writing %s\n", method); | ||
254 | } | ||
255 | return 0; | ||
256 | } | ||
257 | |||
258 | static int get_acpi(int cm) | ||
259 | { | ||
260 | int value = -1; | ||
261 | if ((ehotk->cm_supported & (0x1 << cm))) { | ||
262 | const char *method = cm_getv[cm]; | ||
263 | if (method == NULL) | ||
264 | return -ENODEV; | ||
265 | if (read_acpi_int(ehotk->handle, method, &value)) | ||
266 | printk(EEEPC_WARNING "Error reading %s\n", method); | ||
267 | } | ||
268 | return value; | ||
269 | } | ||
270 | |||
271 | /* | ||
272 | * Backlight | ||
273 | */ | ||
274 | static int read_brightness(struct backlight_device *bd) | ||
275 | { | ||
276 | return get_acpi(CM_ASL_PANELBRIGHT); | ||
277 | } | ||
278 | |||
279 | static int set_brightness(struct backlight_device *bd, int value) | ||
280 | { | ||
281 | value = max(0, min(15, value)); | ||
282 | return set_acpi(CM_ASL_PANELBRIGHT, value); | ||
283 | } | ||
284 | |||
285 | static int update_bl_status(struct backlight_device *bd) | ||
286 | { | ||
287 | return set_brightness(bd, bd->props.brightness); | ||
288 | } | ||
289 | |||
290 | /* | ||
291 | * Rfkill helpers | ||
292 | */ | ||
293 | |||
294 | static int eeepc_wlan_rfkill_set(void *data, enum rfkill_state state) | ||
295 | { | ||
296 | if (state == RFKILL_STATE_SOFT_BLOCKED) | ||
297 | return set_acpi(CM_ASL_WLAN, 0); | ||
298 | else | ||
299 | return set_acpi(CM_ASL_WLAN, 1); | ||
300 | } | ||
301 | |||
302 | static int eeepc_wlan_rfkill_state(void *data, enum rfkill_state *state) | ||
303 | { | ||
304 | if (get_acpi(CM_ASL_WLAN) == 1) | ||
305 | *state = RFKILL_STATE_UNBLOCKED; | ||
306 | else | ||
307 | *state = RFKILL_STATE_SOFT_BLOCKED; | ||
308 | return 0; | ||
309 | } | ||
310 | |||
311 | static int eeepc_bluetooth_rfkill_set(void *data, enum rfkill_state state) | ||
312 | { | ||
313 | if (state == RFKILL_STATE_SOFT_BLOCKED) | ||
314 | return set_acpi(CM_ASL_BLUETOOTH, 0); | ||
315 | else | ||
316 | return set_acpi(CM_ASL_BLUETOOTH, 1); | ||
317 | } | ||
318 | |||
319 | static int eeepc_bluetooth_rfkill_state(void *data, enum rfkill_state *state) | ||
320 | { | ||
321 | if (get_acpi(CM_ASL_BLUETOOTH) == 1) | ||
322 | *state = RFKILL_STATE_UNBLOCKED; | ||
323 | else | ||
324 | *state = RFKILL_STATE_SOFT_BLOCKED; | ||
325 | return 0; | ||
326 | } | ||
327 | |||
328 | /* | ||
329 | * Sys helpers | ||
330 | */ | ||
331 | static int parse_arg(const char *buf, unsigned long count, int *val) | ||
332 | { | ||
333 | if (!count) | ||
334 | return 0; | ||
335 | if (sscanf(buf, "%i", val) != 1) | ||
336 | return -EINVAL; | ||
337 | return count; | ||
338 | } | ||
339 | |||
340 | static ssize_t store_sys_acpi(int cm, const char *buf, size_t count) | ||
341 | { | ||
342 | int rv, value; | ||
343 | |||
344 | rv = parse_arg(buf, count, &value); | ||
345 | if (rv > 0) | ||
346 | set_acpi(cm, value); | ||
347 | return rv; | ||
348 | } | ||
349 | |||
350 | static ssize_t show_sys_acpi(int cm, char *buf) | ||
351 | { | ||
352 | return sprintf(buf, "%d\n", get_acpi(cm)); | ||
353 | } | ||
354 | |||
355 | #define EEEPC_CREATE_DEVICE_ATTR(_name, _cm) \ | ||
356 | static ssize_t show_##_name(struct device *dev, \ | ||
357 | struct device_attribute *attr, \ | ||
358 | char *buf) \ | ||
359 | { \ | ||
360 | return show_sys_acpi(_cm, buf); \ | ||
361 | } \ | ||
362 | static ssize_t store_##_name(struct device *dev, \ | ||
363 | struct device_attribute *attr, \ | ||
364 | const char *buf, size_t count) \ | ||
365 | { \ | ||
366 | return store_sys_acpi(_cm, buf, count); \ | ||
367 | } \ | ||
368 | static struct device_attribute dev_attr_##_name = { \ | ||
369 | .attr = { \ | ||
370 | .name = __stringify(_name), \ | ||
371 | .mode = 0644 }, \ | ||
372 | .show = show_##_name, \ | ||
373 | .store = store_##_name, \ | ||
374 | } | ||
375 | |||
376 | EEEPC_CREATE_DEVICE_ATTR(camera, CM_ASL_CAMERA); | ||
377 | EEEPC_CREATE_DEVICE_ATTR(cardr, CM_ASL_CARDREADER); | ||
378 | EEEPC_CREATE_DEVICE_ATTR(disp, CM_ASL_DISPLAYSWITCH); | ||
379 | |||
380 | static struct attribute *platform_attributes[] = { | ||
381 | &dev_attr_camera.attr, | ||
382 | &dev_attr_cardr.attr, | ||
383 | &dev_attr_disp.attr, | ||
384 | NULL | ||
385 | }; | ||
386 | |||
387 | static struct attribute_group platform_attribute_group = { | ||
388 | .attrs = platform_attributes | ||
389 | }; | ||
390 | |||
391 | /* | ||
392 | * Hotkey functions | ||
393 | */ | ||
394 | static struct key_entry *eepc_get_entry_by_scancode(int code) | ||
395 | { | ||
396 | struct key_entry *key; | ||
397 | |||
398 | for (key = eeepc_keymap; key->type != KE_END; key++) | ||
399 | if (code == key->code) | ||
400 | return key; | ||
401 | |||
402 | return NULL; | ||
403 | } | ||
404 | |||
405 | static struct key_entry *eepc_get_entry_by_keycode(int code) | ||
406 | { | ||
407 | struct key_entry *key; | ||
408 | |||
409 | for (key = eeepc_keymap; key->type != KE_END; key++) | ||
410 | if (code == key->keycode && key->type == KE_KEY) | ||
411 | return key; | ||
412 | |||
413 | return NULL; | ||
414 | } | ||
415 | |||
416 | static int eeepc_getkeycode(struct input_dev *dev, int scancode, int *keycode) | ||
417 | { | ||
418 | struct key_entry *key = eepc_get_entry_by_scancode(scancode); | ||
419 | |||
420 | if (key && key->type == KE_KEY) { | ||
421 | *keycode = key->keycode; | ||
422 | return 0; | ||
423 | } | ||
424 | |||
425 | return -EINVAL; | ||
426 | } | ||
427 | |||
428 | static int eeepc_setkeycode(struct input_dev *dev, int scancode, int keycode) | ||
429 | { | ||
430 | struct key_entry *key; | ||
431 | int old_keycode; | ||
432 | |||
433 | if (keycode < 0 || keycode > KEY_MAX) | ||
434 | return -EINVAL; | ||
435 | |||
436 | key = eepc_get_entry_by_scancode(scancode); | ||
437 | if (key && key->type == KE_KEY) { | ||
438 | old_keycode = key->keycode; | ||
439 | key->keycode = keycode; | ||
440 | set_bit(keycode, dev->keybit); | ||
441 | if (!eepc_get_entry_by_keycode(old_keycode)) | ||
442 | clear_bit(old_keycode, dev->keybit); | ||
443 | return 0; | ||
444 | } | ||
445 | |||
446 | return -EINVAL; | ||
447 | } | ||
448 | |||
449 | static int eeepc_hotk_check(void) | ||
450 | { | ||
451 | const struct key_entry *key; | ||
452 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
453 | int result; | ||
454 | |||
455 | result = acpi_bus_get_status(ehotk->device); | ||
456 | if (result) | ||
457 | return result; | ||
458 | if (ehotk->device->status.present) { | ||
459 | if (write_acpi_int(ehotk->handle, "INIT", ehotk->init_flag, | ||
460 | &buffer)) { | ||
461 | printk(EEEPC_ERR "Hotkey initialization failed\n"); | ||
462 | return -ENODEV; | ||
463 | } else { | ||
464 | printk(EEEPC_NOTICE "Hotkey init flags 0x%x\n", | ||
465 | ehotk->init_flag); | ||
466 | } | ||
467 | /* get control methods supported */ | ||
468 | if (read_acpi_int(ehotk->handle, "CMSG" | ||
469 | , &ehotk->cm_supported)) { | ||
470 | printk(EEEPC_ERR | ||
471 | "Get control methods supported failed\n"); | ||
472 | return -ENODEV; | ||
473 | } else { | ||
474 | printk(EEEPC_INFO | ||
475 | "Get control methods supported: 0x%x\n", | ||
476 | ehotk->cm_supported); | ||
477 | } | ||
478 | ehotk->inputdev = input_allocate_device(); | ||
479 | if (!ehotk->inputdev) { | ||
480 | printk(EEEPC_INFO "Unable to allocate input device\n"); | ||
481 | return 0; | ||
482 | } | ||
483 | ehotk->inputdev->name = "Asus EeePC extra buttons"; | ||
484 | ehotk->inputdev->phys = EEEPC_HOTK_FILE "/input0"; | ||
485 | ehotk->inputdev->id.bustype = BUS_HOST; | ||
486 | ehotk->inputdev->getkeycode = eeepc_getkeycode; | ||
487 | ehotk->inputdev->setkeycode = eeepc_setkeycode; | ||
488 | |||
489 | for (key = eeepc_keymap; key->type != KE_END; key++) { | ||
490 | switch (key->type) { | ||
491 | case KE_KEY: | ||
492 | set_bit(EV_KEY, ehotk->inputdev->evbit); | ||
493 | set_bit(key->keycode, ehotk->inputdev->keybit); | ||
494 | break; | ||
495 | } | ||
496 | } | ||
497 | result = input_register_device(ehotk->inputdev); | ||
498 | if (result) { | ||
499 | printk(EEEPC_INFO "Unable to register input device\n"); | ||
500 | input_free_device(ehotk->inputdev); | ||
501 | return 0; | ||
502 | } | ||
503 | } else { | ||
504 | printk(EEEPC_ERR "Hotkey device not present, aborting\n"); | ||
505 | return -EINVAL; | ||
506 | } | ||
507 | return 0; | ||
508 | } | ||
509 | |||
510 | static void notify_brn(void) | ||
511 | { | ||
512 | struct backlight_device *bd = eeepc_backlight_device; | ||
513 | bd->props.brightness = read_brightness(bd); | ||
514 | } | ||
515 | |||
516 | static void eeepc_hotk_notify(acpi_handle handle, u32 event, void *data) | ||
517 | { | ||
518 | static struct key_entry *key; | ||
519 | if (!ehotk) | ||
520 | return; | ||
521 | if (event >= NOTIFY_BRN_MIN && event <= NOTIFY_BRN_MAX) | ||
522 | notify_brn(); | ||
523 | acpi_bus_generate_proc_event(ehotk->device, event, | ||
524 | ehotk->event_count[event % 128]++); | ||
525 | if (ehotk->inputdev) { | ||
526 | key = eepc_get_entry_by_scancode(event); | ||
527 | if (key) { | ||
528 | switch (key->type) { | ||
529 | case KE_KEY: | ||
530 | input_report_key(ehotk->inputdev, key->keycode, | ||
531 | 1); | ||
532 | input_sync(ehotk->inputdev); | ||
533 | input_report_key(ehotk->inputdev, key->keycode, | ||
534 | 0); | ||
535 | input_sync(ehotk->inputdev); | ||
536 | break; | ||
537 | } | ||
538 | } | ||
539 | } | ||
540 | } | ||
541 | |||
542 | static int eeepc_hotk_add(struct acpi_device *device) | ||
543 | { | ||
544 | acpi_status status = AE_OK; | ||
545 | int result; | ||
546 | |||
547 | if (!device) | ||
548 | return -EINVAL; | ||
549 | printk(EEEPC_NOTICE EEEPC_HOTK_NAME "\n"); | ||
550 | ehotk = kzalloc(sizeof(struct eeepc_hotk), GFP_KERNEL); | ||
551 | if (!ehotk) | ||
552 | return -ENOMEM; | ||
553 | ehotk->init_flag = DISABLE_ASL_WLAN | DISABLE_ASL_DISPLAYSWITCH; | ||
554 | ehotk->handle = device->handle; | ||
555 | strcpy(acpi_device_name(device), EEEPC_HOTK_DEVICE_NAME); | ||
556 | strcpy(acpi_device_class(device), EEEPC_HOTK_CLASS); | ||
557 | device->driver_data = ehotk; | ||
558 | ehotk->device = device; | ||
559 | result = eeepc_hotk_check(); | ||
560 | if (result) | ||
561 | goto end; | ||
562 | status = acpi_install_notify_handler(ehotk->handle, ACPI_SYSTEM_NOTIFY, | ||
563 | eeepc_hotk_notify, ehotk); | ||
564 | if (ACPI_FAILURE(status)) | ||
565 | printk(EEEPC_ERR "Error installing notify handler\n"); | ||
566 | |||
567 | if (get_acpi(CM_ASL_WLAN) != -1) { | ||
568 | ehotk->eeepc_wlan_rfkill = rfkill_allocate(&device->dev, | ||
569 | RFKILL_TYPE_WLAN); | ||
570 | |||
571 | if (!ehotk->eeepc_wlan_rfkill) | ||
572 | goto end; | ||
573 | |||
574 | ehotk->eeepc_wlan_rfkill->name = "eeepc-wlan"; | ||
575 | ehotk->eeepc_wlan_rfkill->toggle_radio = eeepc_wlan_rfkill_set; | ||
576 | ehotk->eeepc_wlan_rfkill->get_state = eeepc_wlan_rfkill_state; | ||
577 | if (get_acpi(CM_ASL_WLAN) == 1) | ||
578 | ehotk->eeepc_wlan_rfkill->state = | ||
579 | RFKILL_STATE_UNBLOCKED; | ||
580 | else | ||
581 | ehotk->eeepc_wlan_rfkill->state = | ||
582 | RFKILL_STATE_SOFT_BLOCKED; | ||
583 | rfkill_register(ehotk->eeepc_wlan_rfkill); | ||
584 | } | ||
585 | |||
586 | if (get_acpi(CM_ASL_BLUETOOTH) != -1) { | ||
587 | ehotk->eeepc_bluetooth_rfkill = | ||
588 | rfkill_allocate(&device->dev, RFKILL_TYPE_BLUETOOTH); | ||
589 | |||
590 | if (!ehotk->eeepc_bluetooth_rfkill) | ||
591 | goto end; | ||
592 | |||
593 | ehotk->eeepc_bluetooth_rfkill->name = "eeepc-bluetooth"; | ||
594 | ehotk->eeepc_bluetooth_rfkill->toggle_radio = | ||
595 | eeepc_bluetooth_rfkill_set; | ||
596 | ehotk->eeepc_bluetooth_rfkill->get_state = | ||
597 | eeepc_bluetooth_rfkill_state; | ||
598 | if (get_acpi(CM_ASL_BLUETOOTH) == 1) | ||
599 | ehotk->eeepc_bluetooth_rfkill->state = | ||
600 | RFKILL_STATE_UNBLOCKED; | ||
601 | else | ||
602 | ehotk->eeepc_bluetooth_rfkill->state = | ||
603 | RFKILL_STATE_SOFT_BLOCKED; | ||
604 | rfkill_register(ehotk->eeepc_bluetooth_rfkill); | ||
605 | } | ||
606 | |||
607 | end: | ||
608 | if (result) { | ||
609 | kfree(ehotk); | ||
610 | ehotk = NULL; | ||
611 | } | ||
612 | return result; | ||
613 | } | ||
614 | |||
615 | static int eeepc_hotk_remove(struct acpi_device *device, int type) | ||
616 | { | ||
617 | acpi_status status = 0; | ||
618 | |||
619 | if (!device || !acpi_driver_data(device)) | ||
620 | return -EINVAL; | ||
621 | status = acpi_remove_notify_handler(ehotk->handle, ACPI_SYSTEM_NOTIFY, | ||
622 | eeepc_hotk_notify); | ||
623 | if (ACPI_FAILURE(status)) | ||
624 | printk(EEEPC_ERR "Error removing notify handler\n"); | ||
625 | kfree(ehotk); | ||
626 | return 0; | ||
627 | } | ||
628 | |||
629 | /* | ||
630 | * Hwmon | ||
631 | */ | ||
632 | static int eeepc_get_fan_pwm(void) | ||
633 | { | ||
634 | int value = 0; | ||
635 | |||
636 | read_acpi_int(NULL, EEEPC_EC_FAN_PWM, &value); | ||
637 | value = value * 255 / 100; | ||
638 | return (value); | ||
639 | } | ||
640 | |||
641 | static void eeepc_set_fan_pwm(int value) | ||
642 | { | ||
643 | value = SENSORS_LIMIT(value, 0, 255); | ||
644 | value = value * 100 / 255; | ||
645 | ec_write(EEEPC_EC_SC02, value); | ||
646 | } | ||
647 | |||
648 | static int eeepc_get_fan_rpm(void) | ||
649 | { | ||
650 | int high = 0; | ||
651 | int low = 0; | ||
652 | |||
653 | read_acpi_int(NULL, EEEPC_EC_FAN_HRPM, &high); | ||
654 | read_acpi_int(NULL, EEEPC_EC_FAN_LRPM, &low); | ||
655 | return (high << 8 | low); | ||
656 | } | ||
657 | |||
658 | static int eeepc_get_fan_ctrl(void) | ||
659 | { | ||
660 | int value = 0; | ||
661 | |||
662 | read_acpi_int(NULL, EEEPC_EC_FAN_CTRL, &value); | ||
663 | return ((value & 0x02 ? 1 : 0)); | ||
664 | } | ||
665 | |||
666 | static void eeepc_set_fan_ctrl(int manual) | ||
667 | { | ||
668 | int value = 0; | ||
669 | |||
670 | read_acpi_int(NULL, EEEPC_EC_FAN_CTRL, &value); | ||
671 | if (manual) | ||
672 | value |= 0x02; | ||
673 | else | ||
674 | value &= ~0x02; | ||
675 | ec_write(EEEPC_EC_SFB3, value); | ||
676 | } | ||
677 | |||
678 | static ssize_t store_sys_hwmon(void (*set)(int), const char *buf, size_t count) | ||
679 | { | ||
680 | int rv, value; | ||
681 | |||
682 | rv = parse_arg(buf, count, &value); | ||
683 | if (rv > 0) | ||
684 | set(value); | ||
685 | return rv; | ||
686 | } | ||
687 | |||
688 | static ssize_t show_sys_hwmon(int (*get)(void), char *buf) | ||
689 | { | ||
690 | return sprintf(buf, "%d\n", get()); | ||
691 | } | ||
692 | |||
693 | #define EEEPC_CREATE_SENSOR_ATTR(_name, _mode, _set, _get) \ | ||
694 | static ssize_t show_##_name(struct device *dev, \ | ||
695 | struct device_attribute *attr, \ | ||
696 | char *buf) \ | ||
697 | { \ | ||
698 | return show_sys_hwmon(_set, buf); \ | ||
699 | } \ | ||
700 | static ssize_t store_##_name(struct device *dev, \ | ||
701 | struct device_attribute *attr, \ | ||
702 | const char *buf, size_t count) \ | ||
703 | { \ | ||
704 | return store_sys_hwmon(_get, buf, count); \ | ||
705 | } \ | ||
706 | static SENSOR_DEVICE_ATTR(_name, _mode, show_##_name, store_##_name, 0); | ||
707 | |||
708 | EEEPC_CREATE_SENSOR_ATTR(fan1_input, S_IRUGO, eeepc_get_fan_rpm, NULL); | ||
709 | EEEPC_CREATE_SENSOR_ATTR(pwm1, S_IRUGO | S_IWUSR, | ||
710 | eeepc_get_fan_pwm, eeepc_set_fan_pwm); | ||
711 | EEEPC_CREATE_SENSOR_ATTR(pwm1_enable, S_IRUGO | S_IWUSR, | ||
712 | eeepc_get_fan_ctrl, eeepc_set_fan_ctrl); | ||
713 | |||
714 | static ssize_t | ||
715 | show_name(struct device *dev, struct device_attribute *attr, char *buf) | ||
716 | { | ||
717 | return sprintf(buf, "eeepc\n"); | ||
718 | } | ||
719 | static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0); | ||
720 | |||
721 | static struct attribute *hwmon_attributes[] = { | ||
722 | &sensor_dev_attr_pwm1.dev_attr.attr, | ||
723 | &sensor_dev_attr_fan1_input.dev_attr.attr, | ||
724 | &sensor_dev_attr_pwm1_enable.dev_attr.attr, | ||
725 | &sensor_dev_attr_name.dev_attr.attr, | ||
726 | NULL | ||
727 | }; | ||
728 | |||
729 | static struct attribute_group hwmon_attribute_group = { | ||
730 | .attrs = hwmon_attributes | ||
731 | }; | ||
732 | |||
733 | /* | ||
734 | * exit/init | ||
735 | */ | ||
736 | static void eeepc_backlight_exit(void) | ||
737 | { | ||
738 | if (eeepc_backlight_device) | ||
739 | backlight_device_unregister(eeepc_backlight_device); | ||
740 | if (ehotk->inputdev) | ||
741 | input_unregister_device(ehotk->inputdev); | ||
742 | if (ehotk->eeepc_wlan_rfkill) | ||
743 | rfkill_unregister(ehotk->eeepc_wlan_rfkill); | ||
744 | if (ehotk->eeepc_bluetooth_rfkill) | ||
745 | rfkill_unregister(ehotk->eeepc_bluetooth_rfkill); | ||
746 | eeepc_backlight_device = NULL; | ||
747 | } | ||
748 | |||
749 | static void eeepc_hwmon_exit(void) | ||
750 | { | ||
751 | struct device *hwmon; | ||
752 | |||
753 | hwmon = eeepc_hwmon_device; | ||
754 | if (!hwmon) | ||
755 | return ; | ||
756 | sysfs_remove_group(&hwmon->kobj, | ||
757 | &hwmon_attribute_group); | ||
758 | hwmon_device_unregister(hwmon); | ||
759 | eeepc_hwmon_device = NULL; | ||
760 | } | ||
761 | |||
762 | static void __exit eeepc_laptop_exit(void) | ||
763 | { | ||
764 | eeepc_backlight_exit(); | ||
765 | eeepc_hwmon_exit(); | ||
766 | acpi_bus_unregister_driver(&eeepc_hotk_driver); | ||
767 | sysfs_remove_group(&platform_device->dev.kobj, | ||
768 | &platform_attribute_group); | ||
769 | platform_device_unregister(platform_device); | ||
770 | platform_driver_unregister(&platform_driver); | ||
771 | } | ||
772 | |||
773 | static int eeepc_backlight_init(struct device *dev) | ||
774 | { | ||
775 | struct backlight_device *bd; | ||
776 | |||
777 | bd = backlight_device_register(EEEPC_HOTK_FILE, dev, | ||
778 | NULL, &eeepcbl_ops); | ||
779 | if (IS_ERR(bd)) { | ||
780 | printk(EEEPC_ERR | ||
781 | "Could not register eeepc backlight device\n"); | ||
782 | eeepc_backlight_device = NULL; | ||
783 | return PTR_ERR(bd); | ||
784 | } | ||
785 | eeepc_backlight_device = bd; | ||
786 | bd->props.max_brightness = 15; | ||
787 | bd->props.brightness = read_brightness(NULL); | ||
788 | bd->props.power = FB_BLANK_UNBLANK; | ||
789 | backlight_update_status(bd); | ||
790 | return 0; | ||
791 | } | ||
792 | |||
793 | static int eeepc_hwmon_init(struct device *dev) | ||
794 | { | ||
795 | struct device *hwmon; | ||
796 | int result; | ||
797 | |||
798 | hwmon = hwmon_device_register(dev); | ||
799 | if (IS_ERR(hwmon)) { | ||
800 | printk(EEEPC_ERR | ||
801 | "Could not register eeepc hwmon device\n"); | ||
802 | eeepc_hwmon_device = NULL; | ||
803 | return PTR_ERR(hwmon); | ||
804 | } | ||
805 | eeepc_hwmon_device = hwmon; | ||
806 | result = sysfs_create_group(&hwmon->kobj, | ||
807 | &hwmon_attribute_group); | ||
808 | if (result) | ||
809 | eeepc_hwmon_exit(); | ||
810 | return result; | ||
811 | } | ||
812 | |||
813 | static int __init eeepc_laptop_init(void) | ||
814 | { | ||
815 | struct device *dev; | ||
816 | int result; | ||
817 | |||
818 | if (acpi_disabled) | ||
819 | return -ENODEV; | ||
820 | result = acpi_bus_register_driver(&eeepc_hotk_driver); | ||
821 | if (result < 0) | ||
822 | return result; | ||
823 | if (!ehotk) { | ||
824 | acpi_bus_unregister_driver(&eeepc_hotk_driver); | ||
825 | return -ENODEV; | ||
826 | } | ||
827 | dev = acpi_get_physical_device(ehotk->device->handle); | ||
828 | |||
829 | if (!acpi_video_backlight_support()) { | ||
830 | result = eeepc_backlight_init(dev); | ||
831 | if (result) | ||
832 | goto fail_backlight; | ||
833 | } else | ||
834 | printk(EEEPC_INFO "Backlight controlled by ACPI video " | ||
835 | "driver\n"); | ||
836 | |||
837 | result = eeepc_hwmon_init(dev); | ||
838 | if (result) | ||
839 | goto fail_hwmon; | ||
840 | /* Register platform stuff */ | ||
841 | result = platform_driver_register(&platform_driver); | ||
842 | if (result) | ||
843 | goto fail_platform_driver; | ||
844 | platform_device = platform_device_alloc(EEEPC_HOTK_FILE, -1); | ||
845 | if (!platform_device) { | ||
846 | result = -ENOMEM; | ||
847 | goto fail_platform_device1; | ||
848 | } | ||
849 | result = platform_device_add(platform_device); | ||
850 | if (result) | ||
851 | goto fail_platform_device2; | ||
852 | result = sysfs_create_group(&platform_device->dev.kobj, | ||
853 | &platform_attribute_group); | ||
854 | if (result) | ||
855 | goto fail_sysfs; | ||
856 | return 0; | ||
857 | fail_sysfs: | ||
858 | platform_device_del(platform_device); | ||
859 | fail_platform_device2: | ||
860 | platform_device_put(platform_device); | ||
861 | fail_platform_device1: | ||
862 | platform_driver_unregister(&platform_driver); | ||
863 | fail_platform_driver: | ||
864 | eeepc_hwmon_exit(); | ||
865 | fail_hwmon: | ||
866 | eeepc_backlight_exit(); | ||
867 | fail_backlight: | ||
868 | return result; | ||
869 | } | ||
870 | |||
871 | module_init(eeepc_laptop_init); | ||
872 | module_exit(eeepc_laptop_exit); | ||
diff --git a/drivers/platform/x86/fujitsu-laptop.c b/drivers/platform/x86/fujitsu-laptop.c new file mode 100644 index 000000000000..65dc41540c62 --- /dev/null +++ b/drivers/platform/x86/fujitsu-laptop.c | |||
@@ -0,0 +1,1293 @@ | |||
1 | /*-*-linux-c-*-*/ | ||
2 | |||
3 | /* | ||
4 | Copyright (C) 2007,2008 Jonathan Woithe <jwoithe@physics.adelaide.edu.au> | ||
5 | Copyright (C) 2008 Peter Gruber <nokos@gmx.net> | ||
6 | Copyright (C) 2008 Tony Vroon <tony@linx.net> | ||
7 | Based on earlier work: | ||
8 | Copyright (C) 2003 Shane Spencer <shane@bogomip.com> | ||
9 | Adrian Yee <brewt-fujitsu@brewt.org> | ||
10 | |||
11 | Templated from msi-laptop.c and thinkpad_acpi.c which is copyright | ||
12 | by its respective authors. | ||
13 | |||
14 | This program is free software; you can redistribute it and/or modify | ||
15 | it under the terms of the GNU General Public License as published by | ||
16 | the Free Software Foundation; either version 2 of the License, or | ||
17 | (at your option) any later version. | ||
18 | |||
19 | This program is distributed in the hope that it will be useful, but | ||
20 | WITHOUT ANY WARRANTY; without even the implied warranty of | ||
21 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
22 | General Public License for more details. | ||
23 | |||
24 | You should have received a copy of the GNU General Public License | ||
25 | along with this program; if not, write to the Free Software | ||
26 | Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
27 | 02110-1301, USA. | ||
28 | */ | ||
29 | |||
30 | /* | ||
31 | * fujitsu-laptop.c - Fujitsu laptop support, providing access to additional | ||
32 | * features made available on a range of Fujitsu laptops including the | ||
33 | * P2xxx/P5xxx/S6xxx/S7xxx series. | ||
34 | * | ||
35 | * This driver exports a few files in /sys/devices/platform/fujitsu-laptop/; | ||
36 | * others may be added at a later date. | ||
37 | * | ||
38 | * lcd_level - Screen brightness: contains a single integer in the | ||
39 | * range 0..7. (rw) | ||
40 | * | ||
41 | * In addition to these platform device attributes the driver | ||
42 | * registers itself in the Linux backlight control subsystem and is | ||
43 | * available to userspace under /sys/class/backlight/fujitsu-laptop/. | ||
44 | * | ||
45 | * Hotkeys present on certain Fujitsu laptops (eg: the S6xxx series) are | ||
46 | * also supported by this driver. | ||
47 | * | ||
48 | * This driver has been tested on a Fujitsu Lifebook S6410, S7020 and | ||
49 | * P8010. It should work on most P-series and S-series Lifebooks, but | ||
50 | * YMMV. | ||
51 | * | ||
52 | * The module parameter use_alt_lcd_levels switches between different ACPI | ||
53 | * brightness controls which are used by different Fujitsu laptops. In most | ||
54 | * cases the correct method is automatically detected. "use_alt_lcd_levels=1" | ||
55 | * is applicable for a Fujitsu Lifebook S6410 if autodetection fails. | ||
56 | * | ||
57 | */ | ||
58 | |||
59 | #include <linux/module.h> | ||
60 | #include <linux/kernel.h> | ||
61 | #include <linux/init.h> | ||
62 | #include <linux/acpi.h> | ||
63 | #include <linux/dmi.h> | ||
64 | #include <linux/backlight.h> | ||
65 | #include <linux/input.h> | ||
66 | #include <linux/kfifo.h> | ||
67 | #include <linux/video_output.h> | ||
68 | #include <linux/platform_device.h> | ||
69 | #ifdef CONFIG_LEDS_CLASS | ||
70 | #include <linux/leds.h> | ||
71 | #endif | ||
72 | |||
73 | #define FUJITSU_DRIVER_VERSION "0.5.0" | ||
74 | |||
75 | #define FUJITSU_LCD_N_LEVELS 8 | ||
76 | |||
77 | #define ACPI_FUJITSU_CLASS "fujitsu" | ||
78 | #define ACPI_FUJITSU_HID "FUJ02B1" | ||
79 | #define ACPI_FUJITSU_DRIVER_NAME "Fujitsu laptop FUJ02B1 ACPI brightness driver" | ||
80 | #define ACPI_FUJITSU_DEVICE_NAME "Fujitsu FUJ02B1" | ||
81 | #define ACPI_FUJITSU_HOTKEY_HID "FUJ02E3" | ||
82 | #define ACPI_FUJITSU_HOTKEY_DRIVER_NAME "Fujitsu laptop FUJ02E3 ACPI hotkeys driver" | ||
83 | #define ACPI_FUJITSU_HOTKEY_DEVICE_NAME "Fujitsu FUJ02E3" | ||
84 | |||
85 | #define ACPI_FUJITSU_NOTIFY_CODE1 0x80 | ||
86 | |||
87 | #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS 0x86 | ||
88 | #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS 0x87 | ||
89 | |||
90 | /* FUNC interface - command values */ | ||
91 | #define FUNC_RFKILL 0x1000 | ||
92 | #define FUNC_LEDS 0x1001 | ||
93 | #define FUNC_BUTTONS 0x1002 | ||
94 | #define FUNC_BACKLIGHT 0x1004 | ||
95 | |||
96 | /* FUNC interface - responses */ | ||
97 | #define UNSUPPORTED_CMD 0x80000000 | ||
98 | |||
99 | #ifdef CONFIG_LEDS_CLASS | ||
100 | /* FUNC interface - LED control */ | ||
101 | #define FUNC_LED_OFF 0x1 | ||
102 | #define FUNC_LED_ON 0x30001 | ||
103 | #define KEYBOARD_LAMPS 0x100 | ||
104 | #define LOGOLAMP_POWERON 0x2000 | ||
105 | #define LOGOLAMP_ALWAYS 0x4000 | ||
106 | #endif | ||
107 | |||
108 | /* Hotkey details */ | ||
109 | #define KEY1_CODE 0x410 /* codes for the keys in the GIRB register */ | ||
110 | #define KEY2_CODE 0x411 | ||
111 | #define KEY3_CODE 0x412 | ||
112 | #define KEY4_CODE 0x413 | ||
113 | |||
114 | #define MAX_HOTKEY_RINGBUFFER_SIZE 100 | ||
115 | #define RINGBUFFERSIZE 40 | ||
116 | |||
117 | /* Debugging */ | ||
118 | #define FUJLAPTOP_LOG ACPI_FUJITSU_HID ": " | ||
119 | #define FUJLAPTOP_ERR KERN_ERR FUJLAPTOP_LOG | ||
120 | #define FUJLAPTOP_NOTICE KERN_NOTICE FUJLAPTOP_LOG | ||
121 | #define FUJLAPTOP_INFO KERN_INFO FUJLAPTOP_LOG | ||
122 | #define FUJLAPTOP_DEBUG KERN_DEBUG FUJLAPTOP_LOG | ||
123 | |||
124 | #define FUJLAPTOP_DBG_ALL 0xffff | ||
125 | #define FUJLAPTOP_DBG_ERROR 0x0001 | ||
126 | #define FUJLAPTOP_DBG_WARN 0x0002 | ||
127 | #define FUJLAPTOP_DBG_INFO 0x0004 | ||
128 | #define FUJLAPTOP_DBG_TRACE 0x0008 | ||
129 | |||
130 | #define dbg_printk(a_dbg_level, format, arg...) \ | ||
131 | do { if (dbg_level & a_dbg_level) \ | ||
132 | printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \ | ||
133 | } while (0) | ||
134 | #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG | ||
135 | #define vdbg_printk(a_dbg_level, format, arg...) \ | ||
136 | dbg_printk(a_dbg_level, format, ## arg) | ||
137 | #else | ||
138 | #define vdbg_printk(a_dbg_level, format, arg...) | ||
139 | #endif | ||
140 | |||
141 | /* Device controlling the backlight and associated keys */ | ||
142 | struct fujitsu_t { | ||
143 | acpi_handle acpi_handle; | ||
144 | struct acpi_device *dev; | ||
145 | struct input_dev *input; | ||
146 | char phys[32]; | ||
147 | struct backlight_device *bl_device; | ||
148 | struct platform_device *pf_device; | ||
149 | int keycode1, keycode2, keycode3, keycode4; | ||
150 | |||
151 | unsigned int max_brightness; | ||
152 | unsigned int brightness_changed; | ||
153 | unsigned int brightness_level; | ||
154 | }; | ||
155 | |||
156 | static struct fujitsu_t *fujitsu; | ||
157 | static int use_alt_lcd_levels = -1; | ||
158 | static int disable_brightness_adjust = -1; | ||
159 | |||
160 | /* Device used to access other hotkeys on the laptop */ | ||
161 | struct fujitsu_hotkey_t { | ||
162 | acpi_handle acpi_handle; | ||
163 | struct acpi_device *dev; | ||
164 | struct input_dev *input; | ||
165 | char phys[32]; | ||
166 | struct platform_device *pf_device; | ||
167 | struct kfifo *fifo; | ||
168 | spinlock_t fifo_lock; | ||
169 | int rfkill_state; | ||
170 | int logolamp_registered; | ||
171 | int kblamps_registered; | ||
172 | }; | ||
173 | |||
174 | static struct fujitsu_hotkey_t *fujitsu_hotkey; | ||
175 | |||
176 | static void acpi_fujitsu_hotkey_notify(acpi_handle handle, u32 event, | ||
177 | void *data); | ||
178 | |||
179 | #ifdef CONFIG_LEDS_CLASS | ||
180 | static enum led_brightness logolamp_get(struct led_classdev *cdev); | ||
181 | static void logolamp_set(struct led_classdev *cdev, | ||
182 | enum led_brightness brightness); | ||
183 | |||
184 | struct led_classdev logolamp_led = { | ||
185 | .name = "fujitsu::logolamp", | ||
186 | .brightness_get = logolamp_get, | ||
187 | .brightness_set = logolamp_set | ||
188 | }; | ||
189 | |||
190 | static enum led_brightness kblamps_get(struct led_classdev *cdev); | ||
191 | static void kblamps_set(struct led_classdev *cdev, | ||
192 | enum led_brightness brightness); | ||
193 | |||
194 | struct led_classdev kblamps_led = { | ||
195 | .name = "fujitsu::kblamps", | ||
196 | .brightness_get = kblamps_get, | ||
197 | .brightness_set = kblamps_set | ||
198 | }; | ||
199 | #endif | ||
200 | |||
201 | #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG | ||
202 | static u32 dbg_level = 0x03; | ||
203 | #endif | ||
204 | |||
205 | static void acpi_fujitsu_notify(acpi_handle handle, u32 event, void *data); | ||
206 | |||
207 | /* Fujitsu ACPI interface function */ | ||
208 | |||
209 | static int call_fext_func(int cmd, int arg0, int arg1, int arg2) | ||
210 | { | ||
211 | acpi_status status = AE_OK; | ||
212 | union acpi_object params[4] = { | ||
213 | { .type = ACPI_TYPE_INTEGER }, | ||
214 | { .type = ACPI_TYPE_INTEGER }, | ||
215 | { .type = ACPI_TYPE_INTEGER }, | ||
216 | { .type = ACPI_TYPE_INTEGER } | ||
217 | }; | ||
218 | struct acpi_object_list arg_list = { 4, ¶ms[0] }; | ||
219 | struct acpi_buffer output; | ||
220 | union acpi_object out_obj; | ||
221 | acpi_handle handle = NULL; | ||
222 | |||
223 | status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle); | ||
224 | if (ACPI_FAILURE(status)) { | ||
225 | vdbg_printk(FUJLAPTOP_DBG_ERROR, | ||
226 | "FUNC interface is not present\n"); | ||
227 | return -ENODEV; | ||
228 | } | ||
229 | |||
230 | params[0].integer.value = cmd; | ||
231 | params[1].integer.value = arg0; | ||
232 | params[2].integer.value = arg1; | ||
233 | params[3].integer.value = arg2; | ||
234 | |||
235 | output.length = sizeof(out_obj); | ||
236 | output.pointer = &out_obj; | ||
237 | |||
238 | status = acpi_evaluate_object(handle, NULL, &arg_list, &output); | ||
239 | if (ACPI_FAILURE(status)) { | ||
240 | vdbg_printk(FUJLAPTOP_DBG_WARN, | ||
241 | "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n", | ||
242 | cmd, arg0, arg1, arg2); | ||
243 | return -ENODEV; | ||
244 | } | ||
245 | |||
246 | if (out_obj.type != ACPI_TYPE_INTEGER) { | ||
247 | vdbg_printk(FUJLAPTOP_DBG_WARN, | ||
248 | "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) did not " | ||
249 | "return an integer\n", | ||
250 | cmd, arg0, arg1, arg2); | ||
251 | return -ENODEV; | ||
252 | } | ||
253 | |||
254 | vdbg_printk(FUJLAPTOP_DBG_TRACE, | ||
255 | "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n", | ||
256 | cmd, arg0, arg1, arg2, (int)out_obj.integer.value); | ||
257 | return out_obj.integer.value; | ||
258 | } | ||
259 | |||
260 | #ifdef CONFIG_LEDS_CLASS | ||
261 | /* LED class callbacks */ | ||
262 | |||
263 | static void logolamp_set(struct led_classdev *cdev, | ||
264 | enum led_brightness brightness) | ||
265 | { | ||
266 | if (brightness >= LED_FULL) { | ||
267 | call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON); | ||
268 | call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON); | ||
269 | } else if (brightness >= LED_HALF) { | ||
270 | call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON); | ||
271 | call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF); | ||
272 | } else { | ||
273 | call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF); | ||
274 | } | ||
275 | } | ||
276 | |||
277 | static void kblamps_set(struct led_classdev *cdev, | ||
278 | enum led_brightness brightness) | ||
279 | { | ||
280 | if (brightness >= LED_FULL) | ||
281 | call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON); | ||
282 | else | ||
283 | call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF); | ||
284 | } | ||
285 | |||
286 | static enum led_brightness logolamp_get(struct led_classdev *cdev) | ||
287 | { | ||
288 | enum led_brightness brightness = LED_OFF; | ||
289 | int poweron, always; | ||
290 | |||
291 | poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0); | ||
292 | if (poweron == FUNC_LED_ON) { | ||
293 | brightness = LED_HALF; | ||
294 | always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0); | ||
295 | if (always == FUNC_LED_ON) | ||
296 | brightness = LED_FULL; | ||
297 | } | ||
298 | return brightness; | ||
299 | } | ||
300 | |||
301 | static enum led_brightness kblamps_get(struct led_classdev *cdev) | ||
302 | { | ||
303 | enum led_brightness brightness = LED_OFF; | ||
304 | |||
305 | if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON) | ||
306 | brightness = LED_FULL; | ||
307 | |||
308 | return brightness; | ||
309 | } | ||
310 | #endif | ||
311 | |||
312 | /* Hardware access for LCD brightness control */ | ||
313 | |||
314 | static int set_lcd_level(int level) | ||
315 | { | ||
316 | acpi_status status = AE_OK; | ||
317 | union acpi_object arg0 = { ACPI_TYPE_INTEGER }; | ||
318 | struct acpi_object_list arg_list = { 1, &arg0 }; | ||
319 | acpi_handle handle = NULL; | ||
320 | |||
321 | vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n", | ||
322 | level); | ||
323 | |||
324 | if (level < 0 || level >= fujitsu->max_brightness) | ||
325 | return -EINVAL; | ||
326 | |||
327 | if (!fujitsu) | ||
328 | return -EINVAL; | ||
329 | |||
330 | status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle); | ||
331 | if (ACPI_FAILURE(status)) { | ||
332 | vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n"); | ||
333 | return -ENODEV; | ||
334 | } | ||
335 | |||
336 | arg0.integer.value = level; | ||
337 | |||
338 | status = acpi_evaluate_object(handle, NULL, &arg_list, NULL); | ||
339 | if (ACPI_FAILURE(status)) | ||
340 | return -ENODEV; | ||
341 | |||
342 | return 0; | ||
343 | } | ||
344 | |||
345 | static int set_lcd_level_alt(int level) | ||
346 | { | ||
347 | acpi_status status = AE_OK; | ||
348 | union acpi_object arg0 = { ACPI_TYPE_INTEGER }; | ||
349 | struct acpi_object_list arg_list = { 1, &arg0 }; | ||
350 | acpi_handle handle = NULL; | ||
351 | |||
352 | vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n", | ||
353 | level); | ||
354 | |||
355 | if (level < 0 || level >= fujitsu->max_brightness) | ||
356 | return -EINVAL; | ||
357 | |||
358 | if (!fujitsu) | ||
359 | return -EINVAL; | ||
360 | |||
361 | status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle); | ||
362 | if (ACPI_FAILURE(status)) { | ||
363 | vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n"); | ||
364 | return -ENODEV; | ||
365 | } | ||
366 | |||
367 | arg0.integer.value = level; | ||
368 | |||
369 | status = acpi_evaluate_object(handle, NULL, &arg_list, NULL); | ||
370 | if (ACPI_FAILURE(status)) | ||
371 | return -ENODEV; | ||
372 | |||
373 | return 0; | ||
374 | } | ||
375 | |||
376 | static int get_lcd_level(void) | ||
377 | { | ||
378 | unsigned long long state = 0; | ||
379 | acpi_status status = AE_OK; | ||
380 | |||
381 | vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n"); | ||
382 | |||
383 | status = | ||
384 | acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state); | ||
385 | if (status < 0) | ||
386 | return status; | ||
387 | |||
388 | fujitsu->brightness_level = state & 0x0fffffff; | ||
389 | |||
390 | if (state & 0x80000000) | ||
391 | fujitsu->brightness_changed = 1; | ||
392 | else | ||
393 | fujitsu->brightness_changed = 0; | ||
394 | |||
395 | return fujitsu->brightness_level; | ||
396 | } | ||
397 | |||
398 | static int get_max_brightness(void) | ||
399 | { | ||
400 | unsigned long long state = 0; | ||
401 | acpi_status status = AE_OK; | ||
402 | |||
403 | vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n"); | ||
404 | |||
405 | status = | ||
406 | acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state); | ||
407 | if (status < 0) | ||
408 | return status; | ||
409 | |||
410 | fujitsu->max_brightness = state; | ||
411 | |||
412 | return fujitsu->max_brightness; | ||
413 | } | ||
414 | |||
415 | /* Backlight device stuff */ | ||
416 | |||
417 | static int bl_get_brightness(struct backlight_device *b) | ||
418 | { | ||
419 | return get_lcd_level(); | ||
420 | } | ||
421 | |||
422 | static int bl_update_status(struct backlight_device *b) | ||
423 | { | ||
424 | int ret; | ||
425 | if (b->props.power == 4) | ||
426 | ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3); | ||
427 | else | ||
428 | ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0); | ||
429 | if (ret != 0) | ||
430 | vdbg_printk(FUJLAPTOP_DBG_ERROR, | ||
431 | "Unable to adjust backlight power, error code %i\n", | ||
432 | ret); | ||
433 | |||
434 | if (use_alt_lcd_levels) | ||
435 | ret = set_lcd_level_alt(b->props.brightness); | ||
436 | else | ||
437 | ret = set_lcd_level(b->props.brightness); | ||
438 | if (ret != 0) | ||
439 | vdbg_printk(FUJLAPTOP_DBG_ERROR, | ||
440 | "Unable to adjust LCD brightness, error code %i\n", | ||
441 | ret); | ||
442 | return ret; | ||
443 | } | ||
444 | |||
445 | static struct backlight_ops fujitsubl_ops = { | ||
446 | .get_brightness = bl_get_brightness, | ||
447 | .update_status = bl_update_status, | ||
448 | }; | ||
449 | |||
450 | /* Platform LCD brightness device */ | ||
451 | |||
452 | static ssize_t | ||
453 | show_max_brightness(struct device *dev, | ||
454 | struct device_attribute *attr, char *buf) | ||
455 | { | ||
456 | |||
457 | int ret; | ||
458 | |||
459 | ret = get_max_brightness(); | ||
460 | if (ret < 0) | ||
461 | return ret; | ||
462 | |||
463 | return sprintf(buf, "%i\n", ret); | ||
464 | } | ||
465 | |||
466 | static ssize_t | ||
467 | show_brightness_changed(struct device *dev, | ||
468 | struct device_attribute *attr, char *buf) | ||
469 | { | ||
470 | |||
471 | int ret; | ||
472 | |||
473 | ret = fujitsu->brightness_changed; | ||
474 | if (ret < 0) | ||
475 | return ret; | ||
476 | |||
477 | return sprintf(buf, "%i\n", ret); | ||
478 | } | ||
479 | |||
480 | static ssize_t show_lcd_level(struct device *dev, | ||
481 | struct device_attribute *attr, char *buf) | ||
482 | { | ||
483 | |||
484 | int ret; | ||
485 | |||
486 | ret = get_lcd_level(); | ||
487 | if (ret < 0) | ||
488 | return ret; | ||
489 | |||
490 | return sprintf(buf, "%i\n", ret); | ||
491 | } | ||
492 | |||
493 | static ssize_t store_lcd_level(struct device *dev, | ||
494 | struct device_attribute *attr, const char *buf, | ||
495 | size_t count) | ||
496 | { | ||
497 | |||
498 | int level, ret; | ||
499 | |||
500 | if (sscanf(buf, "%i", &level) != 1 | ||
501 | || (level < 0 || level >= fujitsu->max_brightness)) | ||
502 | return -EINVAL; | ||
503 | |||
504 | if (use_alt_lcd_levels) | ||
505 | ret = set_lcd_level_alt(level); | ||
506 | else | ||
507 | ret = set_lcd_level(level); | ||
508 | if (ret < 0) | ||
509 | return ret; | ||
510 | |||
511 | ret = get_lcd_level(); | ||
512 | if (ret < 0) | ||
513 | return ret; | ||
514 | |||
515 | return count; | ||
516 | } | ||
517 | |||
518 | static ssize_t | ||
519 | ignore_store(struct device *dev, | ||
520 | struct device_attribute *attr, const char *buf, size_t count) | ||
521 | { | ||
522 | return count; | ||
523 | } | ||
524 | |||
525 | static ssize_t | ||
526 | show_lid_state(struct device *dev, | ||
527 | struct device_attribute *attr, char *buf) | ||
528 | { | ||
529 | if (fujitsu_hotkey->rfkill_state == UNSUPPORTED_CMD) | ||
530 | return sprintf(buf, "unknown\n"); | ||
531 | if (fujitsu_hotkey->rfkill_state & 0x100) | ||
532 | return sprintf(buf, "open\n"); | ||
533 | else | ||
534 | return sprintf(buf, "closed\n"); | ||
535 | } | ||
536 | |||
537 | static ssize_t | ||
538 | show_dock_state(struct device *dev, | ||
539 | struct device_attribute *attr, char *buf) | ||
540 | { | ||
541 | if (fujitsu_hotkey->rfkill_state == UNSUPPORTED_CMD) | ||
542 | return sprintf(buf, "unknown\n"); | ||
543 | if (fujitsu_hotkey->rfkill_state & 0x200) | ||
544 | return sprintf(buf, "docked\n"); | ||
545 | else | ||
546 | return sprintf(buf, "undocked\n"); | ||
547 | } | ||
548 | |||
549 | static ssize_t | ||
550 | show_radios_state(struct device *dev, | ||
551 | struct device_attribute *attr, char *buf) | ||
552 | { | ||
553 | if (fujitsu_hotkey->rfkill_state == UNSUPPORTED_CMD) | ||
554 | return sprintf(buf, "unknown\n"); | ||
555 | if (fujitsu_hotkey->rfkill_state & 0x20) | ||
556 | return sprintf(buf, "on\n"); | ||
557 | else | ||
558 | return sprintf(buf, "killed\n"); | ||
559 | } | ||
560 | |||
561 | static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store); | ||
562 | static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed, | ||
563 | ignore_store); | ||
564 | static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level); | ||
565 | static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store); | ||
566 | static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store); | ||
567 | static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store); | ||
568 | |||
569 | static struct attribute *fujitsupf_attributes[] = { | ||
570 | &dev_attr_brightness_changed.attr, | ||
571 | &dev_attr_max_brightness.attr, | ||
572 | &dev_attr_lcd_level.attr, | ||
573 | &dev_attr_lid.attr, | ||
574 | &dev_attr_dock.attr, | ||
575 | &dev_attr_radios.attr, | ||
576 | NULL | ||
577 | }; | ||
578 | |||
579 | static struct attribute_group fujitsupf_attribute_group = { | ||
580 | .attrs = fujitsupf_attributes | ||
581 | }; | ||
582 | |||
583 | static struct platform_driver fujitsupf_driver = { | ||
584 | .driver = { | ||
585 | .name = "fujitsu-laptop", | ||
586 | .owner = THIS_MODULE, | ||
587 | } | ||
588 | }; | ||
589 | |||
590 | static void dmi_check_cb_common(const struct dmi_system_id *id) | ||
591 | { | ||
592 | acpi_handle handle; | ||
593 | printk(KERN_INFO "fujitsu-laptop: Identified laptop model '%s'.\n", | ||
594 | id->ident); | ||
595 | if (use_alt_lcd_levels == -1) { | ||
596 | if (ACPI_SUCCESS(acpi_get_handle(NULL, | ||
597 | "\\_SB.PCI0.LPCB.FJEX.SBL2", &handle))) | ||
598 | use_alt_lcd_levels = 1; | ||
599 | else | ||
600 | use_alt_lcd_levels = 0; | ||
601 | vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as " | ||
602 | "%i\n", use_alt_lcd_levels); | ||
603 | } | ||
604 | } | ||
605 | |||
606 | static int dmi_check_cb_s6410(const struct dmi_system_id *id) | ||
607 | { | ||
608 | dmi_check_cb_common(id); | ||
609 | fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */ | ||
610 | fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */ | ||
611 | return 0; | ||
612 | } | ||
613 | |||
614 | static int dmi_check_cb_s6420(const struct dmi_system_id *id) | ||
615 | { | ||
616 | dmi_check_cb_common(id); | ||
617 | fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */ | ||
618 | fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */ | ||
619 | return 0; | ||
620 | } | ||
621 | |||
622 | static int dmi_check_cb_p8010(const struct dmi_system_id *id) | ||
623 | { | ||
624 | dmi_check_cb_common(id); | ||
625 | fujitsu->keycode1 = KEY_HELP; /* "Support" */ | ||
626 | fujitsu->keycode3 = KEY_SWITCHVIDEOMODE; /* "Presentation" */ | ||
627 | fujitsu->keycode4 = KEY_WWW; /* "Internet" */ | ||
628 | return 0; | ||
629 | } | ||
630 | |||
631 | static struct dmi_system_id fujitsu_dmi_table[] = { | ||
632 | { | ||
633 | .ident = "Fujitsu Siemens S6410", | ||
634 | .matches = { | ||
635 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), | ||
636 | DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"), | ||
637 | }, | ||
638 | .callback = dmi_check_cb_s6410}, | ||
639 | { | ||
640 | .ident = "Fujitsu Siemens S6420", | ||
641 | .matches = { | ||
642 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), | ||
643 | DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"), | ||
644 | }, | ||
645 | .callback = dmi_check_cb_s6420}, | ||
646 | { | ||
647 | .ident = "Fujitsu LifeBook P8010", | ||
648 | .matches = { | ||
649 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"), | ||
650 | DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"), | ||
651 | }, | ||
652 | .callback = dmi_check_cb_p8010}, | ||
653 | {} | ||
654 | }; | ||
655 | |||
656 | /* ACPI device for LCD brightness control */ | ||
657 | |||
658 | static int acpi_fujitsu_add(struct acpi_device *device) | ||
659 | { | ||
660 | acpi_status status; | ||
661 | acpi_handle handle; | ||
662 | int result = 0; | ||
663 | int state = 0; | ||
664 | struct input_dev *input; | ||
665 | int error; | ||
666 | |||
667 | if (!device) | ||
668 | return -EINVAL; | ||
669 | |||
670 | fujitsu->acpi_handle = device->handle; | ||
671 | sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME); | ||
672 | sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS); | ||
673 | device->driver_data = fujitsu; | ||
674 | |||
675 | status = acpi_install_notify_handler(device->handle, | ||
676 | ACPI_DEVICE_NOTIFY, | ||
677 | acpi_fujitsu_notify, fujitsu); | ||
678 | |||
679 | if (ACPI_FAILURE(status)) { | ||
680 | printk(KERN_ERR "Error installing notify handler\n"); | ||
681 | error = -ENODEV; | ||
682 | goto err_stop; | ||
683 | } | ||
684 | |||
685 | fujitsu->input = input = input_allocate_device(); | ||
686 | if (!input) { | ||
687 | error = -ENOMEM; | ||
688 | goto err_uninstall_notify; | ||
689 | } | ||
690 | |||
691 | snprintf(fujitsu->phys, sizeof(fujitsu->phys), | ||
692 | "%s/video/input0", acpi_device_hid(device)); | ||
693 | |||
694 | input->name = acpi_device_name(device); | ||
695 | input->phys = fujitsu->phys; | ||
696 | input->id.bustype = BUS_HOST; | ||
697 | input->id.product = 0x06; | ||
698 | input->dev.parent = &device->dev; | ||
699 | input->evbit[0] = BIT(EV_KEY); | ||
700 | set_bit(KEY_BRIGHTNESSUP, input->keybit); | ||
701 | set_bit(KEY_BRIGHTNESSDOWN, input->keybit); | ||
702 | set_bit(KEY_UNKNOWN, input->keybit); | ||
703 | |||
704 | error = input_register_device(input); | ||
705 | if (error) | ||
706 | goto err_free_input_dev; | ||
707 | |||
708 | result = acpi_bus_get_power(fujitsu->acpi_handle, &state); | ||
709 | if (result) { | ||
710 | printk(KERN_ERR "Error reading power state\n"); | ||
711 | goto end; | ||
712 | } | ||
713 | |||
714 | printk(KERN_INFO PREFIX "%s [%s] (%s)\n", | ||
715 | acpi_device_name(device), acpi_device_bid(device), | ||
716 | !device->power.state ? "on" : "off"); | ||
717 | |||
718 | fujitsu->dev = device; | ||
719 | |||
720 | if (ACPI_SUCCESS | ||
721 | (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) { | ||
722 | vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n"); | ||
723 | if (ACPI_FAILURE | ||
724 | (acpi_evaluate_object | ||
725 | (device->handle, METHOD_NAME__INI, NULL, NULL))) | ||
726 | printk(KERN_ERR "_INI Method failed\n"); | ||
727 | } | ||
728 | |||
729 | /* do config (detect defaults) */ | ||
730 | use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0; | ||
731 | disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0; | ||
732 | vdbg_printk(FUJLAPTOP_DBG_INFO, | ||
733 | "config: [alt interface: %d], [adjust disable: %d]\n", | ||
734 | use_alt_lcd_levels, disable_brightness_adjust); | ||
735 | |||
736 | if (get_max_brightness() <= 0) | ||
737 | fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS; | ||
738 | get_lcd_level(); | ||
739 | |||
740 | return result; | ||
741 | |||
742 | end: | ||
743 | err_free_input_dev: | ||
744 | input_free_device(input); | ||
745 | err_uninstall_notify: | ||
746 | acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY, | ||
747 | acpi_fujitsu_notify); | ||
748 | err_stop: | ||
749 | |||
750 | return result; | ||
751 | } | ||
752 | |||
753 | static int acpi_fujitsu_remove(struct acpi_device *device, int type) | ||
754 | { | ||
755 | acpi_status status; | ||
756 | struct fujitsu_t *fujitsu = NULL; | ||
757 | |||
758 | if (!device || !acpi_driver_data(device)) | ||
759 | return -EINVAL; | ||
760 | |||
761 | fujitsu = acpi_driver_data(device); | ||
762 | |||
763 | status = acpi_remove_notify_handler(fujitsu->acpi_handle, | ||
764 | ACPI_DEVICE_NOTIFY, | ||
765 | acpi_fujitsu_notify); | ||
766 | |||
767 | if (!device || !acpi_driver_data(device)) | ||
768 | return -EINVAL; | ||
769 | |||
770 | fujitsu->acpi_handle = NULL; | ||
771 | |||
772 | return 0; | ||
773 | } | ||
774 | |||
775 | /* Brightness notify */ | ||
776 | |||
777 | static void acpi_fujitsu_notify(acpi_handle handle, u32 event, void *data) | ||
778 | { | ||
779 | struct input_dev *input; | ||
780 | int keycode; | ||
781 | int oldb, newb; | ||
782 | |||
783 | input = fujitsu->input; | ||
784 | |||
785 | switch (event) { | ||
786 | case ACPI_FUJITSU_NOTIFY_CODE1: | ||
787 | keycode = 0; | ||
788 | oldb = fujitsu->brightness_level; | ||
789 | get_lcd_level(); | ||
790 | newb = fujitsu->brightness_level; | ||
791 | |||
792 | vdbg_printk(FUJLAPTOP_DBG_TRACE, | ||
793 | "brightness button event [%i -> %i (%i)]\n", | ||
794 | oldb, newb, fujitsu->brightness_changed); | ||
795 | |||
796 | if (oldb < newb) { | ||
797 | if (disable_brightness_adjust != 1) { | ||
798 | if (use_alt_lcd_levels) | ||
799 | set_lcd_level_alt(newb); | ||
800 | else | ||
801 | set_lcd_level(newb); | ||
802 | } | ||
803 | acpi_bus_generate_proc_event(fujitsu->dev, | ||
804 | ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS, 0); | ||
805 | keycode = KEY_BRIGHTNESSUP; | ||
806 | } else if (oldb > newb) { | ||
807 | if (disable_brightness_adjust != 1) { | ||
808 | if (use_alt_lcd_levels) | ||
809 | set_lcd_level_alt(newb); | ||
810 | else | ||
811 | set_lcd_level(newb); | ||
812 | } | ||
813 | acpi_bus_generate_proc_event(fujitsu->dev, | ||
814 | ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS, 0); | ||
815 | keycode = KEY_BRIGHTNESSDOWN; | ||
816 | } | ||
817 | break; | ||
818 | default: | ||
819 | keycode = KEY_UNKNOWN; | ||
820 | vdbg_printk(FUJLAPTOP_DBG_WARN, | ||
821 | "unsupported event [0x%x]\n", event); | ||
822 | break; | ||
823 | } | ||
824 | |||
825 | if (keycode != 0) { | ||
826 | input_report_key(input, keycode, 1); | ||
827 | input_sync(input); | ||
828 | input_report_key(input, keycode, 0); | ||
829 | input_sync(input); | ||
830 | } | ||
831 | |||
832 | return; | ||
833 | } | ||
834 | |||
835 | /* ACPI device for hotkey handling */ | ||
836 | |||
837 | static int acpi_fujitsu_hotkey_add(struct acpi_device *device) | ||
838 | { | ||
839 | acpi_status status; | ||
840 | acpi_handle handle; | ||
841 | int result = 0; | ||
842 | int state = 0; | ||
843 | struct input_dev *input; | ||
844 | int error; | ||
845 | int i; | ||
846 | |||
847 | if (!device) | ||
848 | return -EINVAL; | ||
849 | |||
850 | fujitsu_hotkey->acpi_handle = device->handle; | ||
851 | sprintf(acpi_device_name(device), "%s", | ||
852 | ACPI_FUJITSU_HOTKEY_DEVICE_NAME); | ||
853 | sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS); | ||
854 | device->driver_data = fujitsu_hotkey; | ||
855 | |||
856 | status = acpi_install_notify_handler(device->handle, | ||
857 | ACPI_DEVICE_NOTIFY, | ||
858 | acpi_fujitsu_hotkey_notify, | ||
859 | fujitsu_hotkey); | ||
860 | |||
861 | if (ACPI_FAILURE(status)) { | ||
862 | printk(KERN_ERR "Error installing notify handler\n"); | ||
863 | error = -ENODEV; | ||
864 | goto err_stop; | ||
865 | } | ||
866 | |||
867 | /* kfifo */ | ||
868 | spin_lock_init(&fujitsu_hotkey->fifo_lock); | ||
869 | fujitsu_hotkey->fifo = | ||
870 | kfifo_alloc(RINGBUFFERSIZE * sizeof(int), GFP_KERNEL, | ||
871 | &fujitsu_hotkey->fifo_lock); | ||
872 | if (IS_ERR(fujitsu_hotkey->fifo)) { | ||
873 | printk(KERN_ERR "kfifo_alloc failed\n"); | ||
874 | error = PTR_ERR(fujitsu_hotkey->fifo); | ||
875 | goto err_stop; | ||
876 | } | ||
877 | |||
878 | fujitsu_hotkey->input = input = input_allocate_device(); | ||
879 | if (!input) { | ||
880 | error = -ENOMEM; | ||
881 | goto err_uninstall_notify; | ||
882 | } | ||
883 | |||
884 | snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys), | ||
885 | "%s/video/input0", acpi_device_hid(device)); | ||
886 | |||
887 | input->name = acpi_device_name(device); | ||
888 | input->phys = fujitsu_hotkey->phys; | ||
889 | input->id.bustype = BUS_HOST; | ||
890 | input->id.product = 0x06; | ||
891 | input->dev.parent = &device->dev; | ||
892 | |||
893 | set_bit(EV_KEY, input->evbit); | ||
894 | set_bit(fujitsu->keycode1, input->keybit); | ||
895 | set_bit(fujitsu->keycode2, input->keybit); | ||
896 | set_bit(fujitsu->keycode3, input->keybit); | ||
897 | set_bit(fujitsu->keycode4, input->keybit); | ||
898 | set_bit(KEY_UNKNOWN, input->keybit); | ||
899 | |||
900 | error = input_register_device(input); | ||
901 | if (error) | ||
902 | goto err_free_input_dev; | ||
903 | |||
904 | result = acpi_bus_get_power(fujitsu_hotkey->acpi_handle, &state); | ||
905 | if (result) { | ||
906 | printk(KERN_ERR "Error reading power state\n"); | ||
907 | goto end; | ||
908 | } | ||
909 | |||
910 | printk(KERN_INFO PREFIX "%s [%s] (%s)\n", | ||
911 | acpi_device_name(device), acpi_device_bid(device), | ||
912 | !device->power.state ? "on" : "off"); | ||
913 | |||
914 | fujitsu_hotkey->dev = device; | ||
915 | |||
916 | if (ACPI_SUCCESS | ||
917 | (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) { | ||
918 | vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n"); | ||
919 | if (ACPI_FAILURE | ||
920 | (acpi_evaluate_object | ||
921 | (device->handle, METHOD_NAME__INI, NULL, NULL))) | ||
922 | printk(KERN_ERR "_INI Method failed\n"); | ||
923 | } | ||
924 | |||
925 | i = 0; | ||
926 | while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0 | ||
927 | && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) | ||
928 | ; /* No action, result is discarded */ | ||
929 | vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i); | ||
930 | |||
931 | fujitsu_hotkey->rfkill_state = | ||
932 | call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0); | ||
933 | |||
934 | /* Suspect this is a keymap of the application panel, print it */ | ||
935 | printk(KERN_INFO "fujitsu-laptop: BTNI: [0x%x]\n", | ||
936 | call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0)); | ||
937 | |||
938 | #ifdef CONFIG_LEDS_CLASS | ||
939 | if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) { | ||
940 | result = led_classdev_register(&fujitsu->pf_device->dev, | ||
941 | &logolamp_led); | ||
942 | if (result == 0) { | ||
943 | fujitsu_hotkey->logolamp_registered = 1; | ||
944 | } else { | ||
945 | printk(KERN_ERR "fujitsu-laptop: Could not register " | ||
946 | "LED handler for logo lamp, error %i\n", result); | ||
947 | } | ||
948 | } | ||
949 | |||
950 | if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) && | ||
951 | (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) { | ||
952 | result = led_classdev_register(&fujitsu->pf_device->dev, | ||
953 | &kblamps_led); | ||
954 | if (result == 0) { | ||
955 | fujitsu_hotkey->kblamps_registered = 1; | ||
956 | } else { | ||
957 | printk(KERN_ERR "fujitsu-laptop: Could not register " | ||
958 | "LED handler for keyboard lamps, error %i\n", result); | ||
959 | } | ||
960 | } | ||
961 | #endif | ||
962 | |||
963 | return result; | ||
964 | |||
965 | end: | ||
966 | err_free_input_dev: | ||
967 | input_free_device(input); | ||
968 | err_uninstall_notify: | ||
969 | acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY, | ||
970 | acpi_fujitsu_hotkey_notify); | ||
971 | kfifo_free(fujitsu_hotkey->fifo); | ||
972 | err_stop: | ||
973 | |||
974 | return result; | ||
975 | } | ||
976 | |||
977 | static int acpi_fujitsu_hotkey_remove(struct acpi_device *device, int type) | ||
978 | { | ||
979 | acpi_status status; | ||
980 | struct fujitsu_hotkey_t *fujitsu_hotkey = NULL; | ||
981 | |||
982 | if (!device || !acpi_driver_data(device)) | ||
983 | return -EINVAL; | ||
984 | |||
985 | fujitsu_hotkey = acpi_driver_data(device); | ||
986 | |||
987 | status = acpi_remove_notify_handler(fujitsu_hotkey->acpi_handle, | ||
988 | ACPI_DEVICE_NOTIFY, | ||
989 | acpi_fujitsu_hotkey_notify); | ||
990 | |||
991 | fujitsu_hotkey->acpi_handle = NULL; | ||
992 | |||
993 | kfifo_free(fujitsu_hotkey->fifo); | ||
994 | |||
995 | return 0; | ||
996 | } | ||
997 | |||
998 | static void acpi_fujitsu_hotkey_notify(acpi_handle handle, u32 event, | ||
999 | void *data) | ||
1000 | { | ||
1001 | struct input_dev *input; | ||
1002 | int keycode, keycode_r; | ||
1003 | unsigned int irb = 1; | ||
1004 | int i, status; | ||
1005 | |||
1006 | input = fujitsu_hotkey->input; | ||
1007 | |||
1008 | fujitsu_hotkey->rfkill_state = | ||
1009 | call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0); | ||
1010 | |||
1011 | switch (event) { | ||
1012 | case ACPI_FUJITSU_NOTIFY_CODE1: | ||
1013 | i = 0; | ||
1014 | while ((irb = | ||
1015 | call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0 | ||
1016 | && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) { | ||
1017 | switch (irb & 0x4ff) { | ||
1018 | case KEY1_CODE: | ||
1019 | keycode = fujitsu->keycode1; | ||
1020 | break; | ||
1021 | case KEY2_CODE: | ||
1022 | keycode = fujitsu->keycode2; | ||
1023 | break; | ||
1024 | case KEY3_CODE: | ||
1025 | keycode = fujitsu->keycode3; | ||
1026 | break; | ||
1027 | case KEY4_CODE: | ||
1028 | keycode = fujitsu->keycode4; | ||
1029 | break; | ||
1030 | case 0: | ||
1031 | keycode = 0; | ||
1032 | break; | ||
1033 | default: | ||
1034 | vdbg_printk(FUJLAPTOP_DBG_WARN, | ||
1035 | "Unknown GIRB result [%x]\n", irb); | ||
1036 | keycode = -1; | ||
1037 | break; | ||
1038 | } | ||
1039 | if (keycode > 0) { | ||
1040 | vdbg_printk(FUJLAPTOP_DBG_TRACE, | ||
1041 | "Push keycode into ringbuffer [%d]\n", | ||
1042 | keycode); | ||
1043 | status = kfifo_put(fujitsu_hotkey->fifo, | ||
1044 | (unsigned char *)&keycode, | ||
1045 | sizeof(keycode)); | ||
1046 | if (status != sizeof(keycode)) { | ||
1047 | vdbg_printk(FUJLAPTOP_DBG_WARN, | ||
1048 | "Could not push keycode [0x%x]\n", | ||
1049 | keycode); | ||
1050 | } else { | ||
1051 | input_report_key(input, keycode, 1); | ||
1052 | input_sync(input); | ||
1053 | } | ||
1054 | } else if (keycode == 0) { | ||
1055 | while ((status = | ||
1056 | kfifo_get | ||
1057 | (fujitsu_hotkey->fifo, (unsigned char *) | ||
1058 | &keycode_r, | ||
1059 | sizeof | ||
1060 | (keycode_r))) == sizeof(keycode_r)) { | ||
1061 | input_report_key(input, keycode_r, 0); | ||
1062 | input_sync(input); | ||
1063 | vdbg_printk(FUJLAPTOP_DBG_TRACE, | ||
1064 | "Pop keycode from ringbuffer [%d]\n", | ||
1065 | keycode_r); | ||
1066 | } | ||
1067 | } | ||
1068 | } | ||
1069 | |||
1070 | break; | ||
1071 | default: | ||
1072 | keycode = KEY_UNKNOWN; | ||
1073 | vdbg_printk(FUJLAPTOP_DBG_WARN, | ||
1074 | "Unsupported event [0x%x]\n", event); | ||
1075 | input_report_key(input, keycode, 1); | ||
1076 | input_sync(input); | ||
1077 | input_report_key(input, keycode, 0); | ||
1078 | input_sync(input); | ||
1079 | break; | ||
1080 | } | ||
1081 | |||
1082 | return; | ||
1083 | } | ||
1084 | |||
1085 | /* Initialization */ | ||
1086 | |||
1087 | static const struct acpi_device_id fujitsu_device_ids[] = { | ||
1088 | {ACPI_FUJITSU_HID, 0}, | ||
1089 | {"", 0}, | ||
1090 | }; | ||
1091 | |||
1092 | static struct acpi_driver acpi_fujitsu_driver = { | ||
1093 | .name = ACPI_FUJITSU_DRIVER_NAME, | ||
1094 | .class = ACPI_FUJITSU_CLASS, | ||
1095 | .ids = fujitsu_device_ids, | ||
1096 | .ops = { | ||
1097 | .add = acpi_fujitsu_add, | ||
1098 | .remove = acpi_fujitsu_remove, | ||
1099 | }, | ||
1100 | }; | ||
1101 | |||
1102 | static const struct acpi_device_id fujitsu_hotkey_device_ids[] = { | ||
1103 | {ACPI_FUJITSU_HOTKEY_HID, 0}, | ||
1104 | {"", 0}, | ||
1105 | }; | ||
1106 | |||
1107 | static struct acpi_driver acpi_fujitsu_hotkey_driver = { | ||
1108 | .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME, | ||
1109 | .class = ACPI_FUJITSU_CLASS, | ||
1110 | .ids = fujitsu_hotkey_device_ids, | ||
1111 | .ops = { | ||
1112 | .add = acpi_fujitsu_hotkey_add, | ||
1113 | .remove = acpi_fujitsu_hotkey_remove, | ||
1114 | }, | ||
1115 | }; | ||
1116 | |||
1117 | static int __init fujitsu_init(void) | ||
1118 | { | ||
1119 | int ret, result, max_brightness; | ||
1120 | |||
1121 | if (acpi_disabled) | ||
1122 | return -ENODEV; | ||
1123 | |||
1124 | fujitsu = kmalloc(sizeof(struct fujitsu_t), GFP_KERNEL); | ||
1125 | if (!fujitsu) | ||
1126 | return -ENOMEM; | ||
1127 | memset(fujitsu, 0, sizeof(struct fujitsu_t)); | ||
1128 | fujitsu->keycode1 = KEY_PROG1; | ||
1129 | fujitsu->keycode2 = KEY_PROG2; | ||
1130 | fujitsu->keycode3 = KEY_PROG3; | ||
1131 | fujitsu->keycode4 = KEY_PROG4; | ||
1132 | dmi_check_system(fujitsu_dmi_table); | ||
1133 | |||
1134 | result = acpi_bus_register_driver(&acpi_fujitsu_driver); | ||
1135 | if (result < 0) { | ||
1136 | ret = -ENODEV; | ||
1137 | goto fail_acpi; | ||
1138 | } | ||
1139 | |||
1140 | /* Register platform stuff */ | ||
1141 | |||
1142 | fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1); | ||
1143 | if (!fujitsu->pf_device) { | ||
1144 | ret = -ENOMEM; | ||
1145 | goto fail_platform_driver; | ||
1146 | } | ||
1147 | |||
1148 | ret = platform_device_add(fujitsu->pf_device); | ||
1149 | if (ret) | ||
1150 | goto fail_platform_device1; | ||
1151 | |||
1152 | ret = | ||
1153 | sysfs_create_group(&fujitsu->pf_device->dev.kobj, | ||
1154 | &fujitsupf_attribute_group); | ||
1155 | if (ret) | ||
1156 | goto fail_platform_device2; | ||
1157 | |||
1158 | /* Register backlight stuff */ | ||
1159 | |||
1160 | if (!acpi_video_backlight_support()) { | ||
1161 | fujitsu->bl_device = | ||
1162 | backlight_device_register("fujitsu-laptop", NULL, NULL, | ||
1163 | &fujitsubl_ops); | ||
1164 | if (IS_ERR(fujitsu->bl_device)) | ||
1165 | return PTR_ERR(fujitsu->bl_device); | ||
1166 | max_brightness = fujitsu->max_brightness; | ||
1167 | fujitsu->bl_device->props.max_brightness = max_brightness - 1; | ||
1168 | fujitsu->bl_device->props.brightness = fujitsu->brightness_level; | ||
1169 | } | ||
1170 | |||
1171 | ret = platform_driver_register(&fujitsupf_driver); | ||
1172 | if (ret) | ||
1173 | goto fail_backlight; | ||
1174 | |||
1175 | /* Register hotkey driver */ | ||
1176 | |||
1177 | fujitsu_hotkey = kmalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL); | ||
1178 | if (!fujitsu_hotkey) { | ||
1179 | ret = -ENOMEM; | ||
1180 | goto fail_hotkey; | ||
1181 | } | ||
1182 | memset(fujitsu_hotkey, 0, sizeof(struct fujitsu_hotkey_t)); | ||
1183 | |||
1184 | result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver); | ||
1185 | if (result < 0) { | ||
1186 | ret = -ENODEV; | ||
1187 | goto fail_hotkey1; | ||
1188 | } | ||
1189 | |||
1190 | /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */ | ||
1191 | |||
1192 | if (!acpi_video_backlight_support()) { | ||
1193 | if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3) | ||
1194 | fujitsu->bl_device->props.power = 4; | ||
1195 | else | ||
1196 | fujitsu->bl_device->props.power = 0; | ||
1197 | } | ||
1198 | |||
1199 | printk(KERN_INFO "fujitsu-laptop: driver " FUJITSU_DRIVER_VERSION | ||
1200 | " successfully loaded.\n"); | ||
1201 | |||
1202 | return 0; | ||
1203 | |||
1204 | fail_hotkey1: | ||
1205 | |||
1206 | kfree(fujitsu_hotkey); | ||
1207 | |||
1208 | fail_hotkey: | ||
1209 | |||
1210 | platform_driver_unregister(&fujitsupf_driver); | ||
1211 | |||
1212 | fail_backlight: | ||
1213 | |||
1214 | if (fujitsu->bl_device) | ||
1215 | backlight_device_unregister(fujitsu->bl_device); | ||
1216 | |||
1217 | fail_platform_device2: | ||
1218 | |||
1219 | platform_device_del(fujitsu->pf_device); | ||
1220 | |||
1221 | fail_platform_device1: | ||
1222 | |||
1223 | platform_device_put(fujitsu->pf_device); | ||
1224 | |||
1225 | fail_platform_driver: | ||
1226 | |||
1227 | acpi_bus_unregister_driver(&acpi_fujitsu_driver); | ||
1228 | |||
1229 | fail_acpi: | ||
1230 | |||
1231 | kfree(fujitsu); | ||
1232 | |||
1233 | return ret; | ||
1234 | } | ||
1235 | |||
1236 | static void __exit fujitsu_cleanup(void) | ||
1237 | { | ||
1238 | #ifdef CONFIG_LEDS_CLASS | ||
1239 | if (fujitsu_hotkey->logolamp_registered != 0) | ||
1240 | led_classdev_unregister(&logolamp_led); | ||
1241 | |||
1242 | if (fujitsu_hotkey->kblamps_registered != 0) | ||
1243 | led_classdev_unregister(&kblamps_led); | ||
1244 | #endif | ||
1245 | |||
1246 | sysfs_remove_group(&fujitsu->pf_device->dev.kobj, | ||
1247 | &fujitsupf_attribute_group); | ||
1248 | platform_device_unregister(fujitsu->pf_device); | ||
1249 | platform_driver_unregister(&fujitsupf_driver); | ||
1250 | if (fujitsu->bl_device) | ||
1251 | backlight_device_unregister(fujitsu->bl_device); | ||
1252 | |||
1253 | acpi_bus_unregister_driver(&acpi_fujitsu_driver); | ||
1254 | |||
1255 | kfree(fujitsu); | ||
1256 | |||
1257 | acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver); | ||
1258 | |||
1259 | kfree(fujitsu_hotkey); | ||
1260 | |||
1261 | printk(KERN_INFO "fujitsu-laptop: driver unloaded.\n"); | ||
1262 | } | ||
1263 | |||
1264 | module_init(fujitsu_init); | ||
1265 | module_exit(fujitsu_cleanup); | ||
1266 | |||
1267 | module_param(use_alt_lcd_levels, uint, 0644); | ||
1268 | MODULE_PARM_DESC(use_alt_lcd_levels, | ||
1269 | "Use alternative interface for lcd_levels (needed for Lifebook s6410)."); | ||
1270 | module_param(disable_brightness_adjust, uint, 0644); | ||
1271 | MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment ."); | ||
1272 | #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG | ||
1273 | module_param_named(debug, dbg_level, uint, 0644); | ||
1274 | MODULE_PARM_DESC(debug, "Sets debug level bit-mask"); | ||
1275 | #endif | ||
1276 | |||
1277 | MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon"); | ||
1278 | MODULE_DESCRIPTION("Fujitsu laptop extras support"); | ||
1279 | MODULE_VERSION(FUJITSU_DRIVER_VERSION); | ||
1280 | MODULE_LICENSE("GPL"); | ||
1281 | |||
1282 | MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*"); | ||
1283 | MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*"); | ||
1284 | MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*"); | ||
1285 | |||
1286 | static struct pnp_device_id pnp_ids[] = { | ||
1287 | {.id = "FUJ02bf"}, | ||
1288 | {.id = "FUJ02B1"}, | ||
1289 | {.id = "FUJ02E3"}, | ||
1290 | {.id = ""} | ||
1291 | }; | ||
1292 | |||
1293 | MODULE_DEVICE_TABLE(pnp, pnp_ids); | ||
diff --git a/drivers/platform/x86/hp-wmi.c b/drivers/platform/x86/hp-wmi.c new file mode 100644 index 000000000000..4b7c24c519c3 --- /dev/null +++ b/drivers/platform/x86/hp-wmi.c | |||
@@ -0,0 +1,512 @@ | |||
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/types.h> | ||
30 | #include <linux/input.h> | ||
31 | #include <acpi/acpi_drivers.h> | ||
32 | #include <linux/platform_device.h> | ||
33 | #include <linux/acpi.h> | ||
34 | #include <linux/rfkill.h> | ||
35 | #include <linux/string.h> | ||
36 | |||
37 | MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>"); | ||
38 | MODULE_DESCRIPTION("HP laptop WMI hotkeys driver"); | ||
39 | MODULE_LICENSE("GPL"); | ||
40 | |||
41 | MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C"); | ||
42 | MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4"); | ||
43 | |||
44 | #define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C" | ||
45 | #define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4" | ||
46 | |||
47 | #define HPWMI_DISPLAY_QUERY 0x1 | ||
48 | #define HPWMI_HDDTEMP_QUERY 0x2 | ||
49 | #define HPWMI_ALS_QUERY 0x3 | ||
50 | #define HPWMI_DOCK_QUERY 0x4 | ||
51 | #define HPWMI_WIRELESS_QUERY 0x5 | ||
52 | #define HPWMI_HOTKEY_QUERY 0xc | ||
53 | |||
54 | static int __init hp_wmi_bios_setup(struct platform_device *device); | ||
55 | static int __exit hp_wmi_bios_remove(struct platform_device *device); | ||
56 | |||
57 | struct bios_args { | ||
58 | u32 signature; | ||
59 | u32 command; | ||
60 | u32 commandtype; | ||
61 | u32 datasize; | ||
62 | u32 data; | ||
63 | }; | ||
64 | |||
65 | struct bios_return { | ||
66 | u32 sigpass; | ||
67 | u32 return_code; | ||
68 | u32 value; | ||
69 | }; | ||
70 | |||
71 | struct key_entry { | ||
72 | char type; /* See KE_* below */ | ||
73 | u16 code; | ||
74 | u16 keycode; | ||
75 | }; | ||
76 | |||
77 | enum { KE_KEY, KE_SW, KE_END }; | ||
78 | |||
79 | static struct key_entry hp_wmi_keymap[] = { | ||
80 | {KE_SW, 0x01, SW_DOCK}, | ||
81 | {KE_KEY, 0x02, KEY_BRIGHTNESSUP}, | ||
82 | {KE_KEY, 0x03, KEY_BRIGHTNESSDOWN}, | ||
83 | {KE_KEY, 0x20e6, KEY_PROG1}, | ||
84 | {KE_KEY, 0x2142, KEY_MEDIA}, | ||
85 | {KE_KEY, 0x213b, KEY_INFO}, | ||
86 | {KE_KEY, 0x231b, KEY_HELP}, | ||
87 | {KE_END, 0} | ||
88 | }; | ||
89 | |||
90 | static struct input_dev *hp_wmi_input_dev; | ||
91 | static struct platform_device *hp_wmi_platform_dev; | ||
92 | |||
93 | static struct rfkill *wifi_rfkill; | ||
94 | static struct rfkill *bluetooth_rfkill; | ||
95 | static struct rfkill *wwan_rfkill; | ||
96 | |||
97 | static struct platform_driver hp_wmi_driver = { | ||
98 | .driver = { | ||
99 | .name = "hp-wmi", | ||
100 | .owner = THIS_MODULE, | ||
101 | }, | ||
102 | .probe = hp_wmi_bios_setup, | ||
103 | .remove = hp_wmi_bios_remove, | ||
104 | }; | ||
105 | |||
106 | static int hp_wmi_perform_query(int query, int write, int value) | ||
107 | { | ||
108 | struct bios_return bios_return; | ||
109 | acpi_status status; | ||
110 | union acpi_object *obj; | ||
111 | struct bios_args args = { | ||
112 | .signature = 0x55434553, | ||
113 | .command = write ? 0x2 : 0x1, | ||
114 | .commandtype = query, | ||
115 | .datasize = write ? 0x4 : 0, | ||
116 | .data = value, | ||
117 | }; | ||
118 | struct acpi_buffer input = { sizeof(struct bios_args), &args }; | ||
119 | struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
120 | |||
121 | status = wmi_evaluate_method(HPWMI_BIOS_GUID, 0, 0x3, &input, &output); | ||
122 | |||
123 | obj = output.pointer; | ||
124 | |||
125 | if (!obj || obj->type != ACPI_TYPE_BUFFER) | ||
126 | return -EINVAL; | ||
127 | |||
128 | bios_return = *((struct bios_return *)obj->buffer.pointer); | ||
129 | if (bios_return.return_code > 0) | ||
130 | return bios_return.return_code * -1; | ||
131 | else | ||
132 | return bios_return.value; | ||
133 | } | ||
134 | |||
135 | static int hp_wmi_display_state(void) | ||
136 | { | ||
137 | return hp_wmi_perform_query(HPWMI_DISPLAY_QUERY, 0, 0); | ||
138 | } | ||
139 | |||
140 | static int hp_wmi_hddtemp_state(void) | ||
141 | { | ||
142 | return hp_wmi_perform_query(HPWMI_HDDTEMP_QUERY, 0, 0); | ||
143 | } | ||
144 | |||
145 | static int hp_wmi_als_state(void) | ||
146 | { | ||
147 | return hp_wmi_perform_query(HPWMI_ALS_QUERY, 0, 0); | ||
148 | } | ||
149 | |||
150 | static int hp_wmi_dock_state(void) | ||
151 | { | ||
152 | return hp_wmi_perform_query(HPWMI_DOCK_QUERY, 0, 0); | ||
153 | } | ||
154 | |||
155 | static int hp_wmi_wifi_set(void *data, enum rfkill_state state) | ||
156 | { | ||
157 | if (state) | ||
158 | return hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, 0x101); | ||
159 | else | ||
160 | return hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, 0x100); | ||
161 | } | ||
162 | |||
163 | static int hp_wmi_bluetooth_set(void *data, enum rfkill_state state) | ||
164 | { | ||
165 | if (state) | ||
166 | return hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, 0x202); | ||
167 | else | ||
168 | return hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, 0x200); | ||
169 | } | ||
170 | |||
171 | static int hp_wmi_wwan_set(void *data, enum rfkill_state state) | ||
172 | { | ||
173 | if (state) | ||
174 | return hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, 0x404); | ||
175 | else | ||
176 | return hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1, 0x400); | ||
177 | } | ||
178 | |||
179 | static int hp_wmi_wifi_state(void) | ||
180 | { | ||
181 | int wireless = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, 0); | ||
182 | |||
183 | if (wireless & 0x100) | ||
184 | return RFKILL_STATE_UNBLOCKED; | ||
185 | else | ||
186 | return RFKILL_STATE_SOFT_BLOCKED; | ||
187 | } | ||
188 | |||
189 | static int hp_wmi_bluetooth_state(void) | ||
190 | { | ||
191 | int wireless = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, 0); | ||
192 | |||
193 | if (wireless & 0x10000) | ||
194 | return RFKILL_STATE_UNBLOCKED; | ||
195 | else | ||
196 | return RFKILL_STATE_SOFT_BLOCKED; | ||
197 | } | ||
198 | |||
199 | static int hp_wmi_wwan_state(void) | ||
200 | { | ||
201 | int wireless = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, 0); | ||
202 | |||
203 | if (wireless & 0x1000000) | ||
204 | return RFKILL_STATE_UNBLOCKED; | ||
205 | else | ||
206 | return RFKILL_STATE_SOFT_BLOCKED; | ||
207 | } | ||
208 | |||
209 | static ssize_t show_display(struct device *dev, struct device_attribute *attr, | ||
210 | char *buf) | ||
211 | { | ||
212 | int value = hp_wmi_display_state(); | ||
213 | if (value < 0) | ||
214 | return -EINVAL; | ||
215 | return sprintf(buf, "%d\n", value); | ||
216 | } | ||
217 | |||
218 | static ssize_t show_hddtemp(struct device *dev, struct device_attribute *attr, | ||
219 | char *buf) | ||
220 | { | ||
221 | int value = hp_wmi_hddtemp_state(); | ||
222 | if (value < 0) | ||
223 | return -EINVAL; | ||
224 | return sprintf(buf, "%d\n", value); | ||
225 | } | ||
226 | |||
227 | static ssize_t show_als(struct device *dev, struct device_attribute *attr, | ||
228 | char *buf) | ||
229 | { | ||
230 | int value = hp_wmi_als_state(); | ||
231 | if (value < 0) | ||
232 | return -EINVAL; | ||
233 | return sprintf(buf, "%d\n", value); | ||
234 | } | ||
235 | |||
236 | static ssize_t show_dock(struct device *dev, struct device_attribute *attr, | ||
237 | char *buf) | ||
238 | { | ||
239 | int value = hp_wmi_dock_state(); | ||
240 | if (value < 0) | ||
241 | return -EINVAL; | ||
242 | return sprintf(buf, "%d\n", value); | ||
243 | } | ||
244 | |||
245 | static ssize_t set_als(struct device *dev, struct device_attribute *attr, | ||
246 | const char *buf, size_t count) | ||
247 | { | ||
248 | u32 tmp = simple_strtoul(buf, NULL, 10); | ||
249 | hp_wmi_perform_query(HPWMI_ALS_QUERY, 1, tmp); | ||
250 | return count; | ||
251 | } | ||
252 | |||
253 | static DEVICE_ATTR(display, S_IRUGO, show_display, NULL); | ||
254 | static DEVICE_ATTR(hddtemp, S_IRUGO, show_hddtemp, NULL); | ||
255 | static DEVICE_ATTR(als, S_IRUGO | S_IWUSR, show_als, set_als); | ||
256 | static DEVICE_ATTR(dock, S_IRUGO, show_dock, NULL); | ||
257 | |||
258 | static struct key_entry *hp_wmi_get_entry_by_scancode(int code) | ||
259 | { | ||
260 | struct key_entry *key; | ||
261 | |||
262 | for (key = hp_wmi_keymap; key->type != KE_END; key++) | ||
263 | if (code == key->code) | ||
264 | return key; | ||
265 | |||
266 | return NULL; | ||
267 | } | ||
268 | |||
269 | static struct key_entry *hp_wmi_get_entry_by_keycode(int keycode) | ||
270 | { | ||
271 | struct key_entry *key; | ||
272 | |||
273 | for (key = hp_wmi_keymap; key->type != KE_END; key++) | ||
274 | if (key->type == KE_KEY && keycode == key->keycode) | ||
275 | return key; | ||
276 | |||
277 | return NULL; | ||
278 | } | ||
279 | |||
280 | static int hp_wmi_getkeycode(struct input_dev *dev, int scancode, int *keycode) | ||
281 | { | ||
282 | struct key_entry *key = hp_wmi_get_entry_by_scancode(scancode); | ||
283 | |||
284 | if (key && key->type == KE_KEY) { | ||
285 | *keycode = key->keycode; | ||
286 | return 0; | ||
287 | } | ||
288 | |||
289 | return -EINVAL; | ||
290 | } | ||
291 | |||
292 | static int hp_wmi_setkeycode(struct input_dev *dev, int scancode, int keycode) | ||
293 | { | ||
294 | struct key_entry *key; | ||
295 | int old_keycode; | ||
296 | |||
297 | if (keycode < 0 || keycode > KEY_MAX) | ||
298 | return -EINVAL; | ||
299 | |||
300 | key = hp_wmi_get_entry_by_scancode(scancode); | ||
301 | if (key && key->type == KE_KEY) { | ||
302 | old_keycode = key->keycode; | ||
303 | key->keycode = keycode; | ||
304 | set_bit(keycode, dev->keybit); | ||
305 | if (!hp_wmi_get_entry_by_keycode(old_keycode)) | ||
306 | clear_bit(old_keycode, dev->keybit); | ||
307 | return 0; | ||
308 | } | ||
309 | |||
310 | return -EINVAL; | ||
311 | } | ||
312 | |||
313 | static void hp_wmi_notify(u32 value, void *context) | ||
314 | { | ||
315 | struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
316 | static struct key_entry *key; | ||
317 | union acpi_object *obj; | ||
318 | |||
319 | wmi_get_event_data(value, &response); | ||
320 | |||
321 | obj = (union acpi_object *)response.pointer; | ||
322 | |||
323 | if (obj && obj->type == ACPI_TYPE_BUFFER && obj->buffer.length == 8) { | ||
324 | int eventcode = *((u8 *) obj->buffer.pointer); | ||
325 | if (eventcode == 0x4) | ||
326 | eventcode = hp_wmi_perform_query(HPWMI_HOTKEY_QUERY, 0, | ||
327 | 0); | ||
328 | key = hp_wmi_get_entry_by_scancode(eventcode); | ||
329 | if (key) { | ||
330 | switch (key->type) { | ||
331 | case KE_KEY: | ||
332 | input_report_key(hp_wmi_input_dev, | ||
333 | key->keycode, 1); | ||
334 | input_sync(hp_wmi_input_dev); | ||
335 | input_report_key(hp_wmi_input_dev, | ||
336 | key->keycode, 0); | ||
337 | input_sync(hp_wmi_input_dev); | ||
338 | break; | ||
339 | case KE_SW: | ||
340 | input_report_switch(hp_wmi_input_dev, | ||
341 | key->keycode, | ||
342 | hp_wmi_dock_state()); | ||
343 | input_sync(hp_wmi_input_dev); | ||
344 | break; | ||
345 | } | ||
346 | } else if (eventcode == 0x5) { | ||
347 | if (wifi_rfkill) | ||
348 | rfkill_force_state(wifi_rfkill, | ||
349 | hp_wmi_wifi_state()); | ||
350 | if (bluetooth_rfkill) | ||
351 | rfkill_force_state(bluetooth_rfkill, | ||
352 | hp_wmi_bluetooth_state()); | ||
353 | if (wwan_rfkill) | ||
354 | rfkill_force_state(wwan_rfkill, | ||
355 | hp_wmi_wwan_state()); | ||
356 | } else | ||
357 | printk(KERN_INFO "HP WMI: Unknown key pressed - %x\n", | ||
358 | eventcode); | ||
359 | } else | ||
360 | printk(KERN_INFO "HP WMI: Unknown response received\n"); | ||
361 | } | ||
362 | |||
363 | static int __init hp_wmi_input_setup(void) | ||
364 | { | ||
365 | struct key_entry *key; | ||
366 | int err; | ||
367 | |||
368 | hp_wmi_input_dev = input_allocate_device(); | ||
369 | |||
370 | hp_wmi_input_dev->name = "HP WMI hotkeys"; | ||
371 | hp_wmi_input_dev->phys = "wmi/input0"; | ||
372 | hp_wmi_input_dev->id.bustype = BUS_HOST; | ||
373 | hp_wmi_input_dev->getkeycode = hp_wmi_getkeycode; | ||
374 | hp_wmi_input_dev->setkeycode = hp_wmi_setkeycode; | ||
375 | |||
376 | for (key = hp_wmi_keymap; key->type != KE_END; key++) { | ||
377 | switch (key->type) { | ||
378 | case KE_KEY: | ||
379 | set_bit(EV_KEY, hp_wmi_input_dev->evbit); | ||
380 | set_bit(key->keycode, hp_wmi_input_dev->keybit); | ||
381 | break; | ||
382 | case KE_SW: | ||
383 | set_bit(EV_SW, hp_wmi_input_dev->evbit); | ||
384 | set_bit(key->keycode, hp_wmi_input_dev->swbit); | ||
385 | break; | ||
386 | } | ||
387 | } | ||
388 | |||
389 | err = input_register_device(hp_wmi_input_dev); | ||
390 | |||
391 | if (err) { | ||
392 | input_free_device(hp_wmi_input_dev); | ||
393 | return err; | ||
394 | } | ||
395 | |||
396 | return 0; | ||
397 | } | ||
398 | |||
399 | static void cleanup_sysfs(struct platform_device *device) | ||
400 | { | ||
401 | device_remove_file(&device->dev, &dev_attr_display); | ||
402 | device_remove_file(&device->dev, &dev_attr_hddtemp); | ||
403 | device_remove_file(&device->dev, &dev_attr_als); | ||
404 | device_remove_file(&device->dev, &dev_attr_dock); | ||
405 | } | ||
406 | |||
407 | static int __init hp_wmi_bios_setup(struct platform_device *device) | ||
408 | { | ||
409 | int err; | ||
410 | int wireless = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, 0); | ||
411 | |||
412 | err = device_create_file(&device->dev, &dev_attr_display); | ||
413 | if (err) | ||
414 | goto add_sysfs_error; | ||
415 | err = device_create_file(&device->dev, &dev_attr_hddtemp); | ||
416 | if (err) | ||
417 | goto add_sysfs_error; | ||
418 | err = device_create_file(&device->dev, &dev_attr_als); | ||
419 | if (err) | ||
420 | goto add_sysfs_error; | ||
421 | err = device_create_file(&device->dev, &dev_attr_dock); | ||
422 | if (err) | ||
423 | goto add_sysfs_error; | ||
424 | |||
425 | if (wireless & 0x1) { | ||
426 | wifi_rfkill = rfkill_allocate(&device->dev, RFKILL_TYPE_WLAN); | ||
427 | wifi_rfkill->name = "hp-wifi"; | ||
428 | wifi_rfkill->state = hp_wmi_wifi_state(); | ||
429 | wifi_rfkill->toggle_radio = hp_wmi_wifi_set; | ||
430 | wifi_rfkill->user_claim_unsupported = 1; | ||
431 | rfkill_register(wifi_rfkill); | ||
432 | } | ||
433 | |||
434 | if (wireless & 0x2) { | ||
435 | bluetooth_rfkill = rfkill_allocate(&device->dev, | ||
436 | RFKILL_TYPE_BLUETOOTH); | ||
437 | bluetooth_rfkill->name = "hp-bluetooth"; | ||
438 | bluetooth_rfkill->state = hp_wmi_bluetooth_state(); | ||
439 | bluetooth_rfkill->toggle_radio = hp_wmi_bluetooth_set; | ||
440 | bluetooth_rfkill->user_claim_unsupported = 1; | ||
441 | rfkill_register(bluetooth_rfkill); | ||
442 | } | ||
443 | |||
444 | if (wireless & 0x4) { | ||
445 | wwan_rfkill = rfkill_allocate(&device->dev, RFKILL_TYPE_WWAN); | ||
446 | wwan_rfkill->name = "hp-wwan"; | ||
447 | wwan_rfkill->state = hp_wmi_wwan_state(); | ||
448 | wwan_rfkill->toggle_radio = hp_wmi_wwan_set; | ||
449 | wwan_rfkill->user_claim_unsupported = 1; | ||
450 | rfkill_register(wwan_rfkill); | ||
451 | } | ||
452 | |||
453 | return 0; | ||
454 | add_sysfs_error: | ||
455 | cleanup_sysfs(device); | ||
456 | return err; | ||
457 | } | ||
458 | |||
459 | static int __exit hp_wmi_bios_remove(struct platform_device *device) | ||
460 | { | ||
461 | cleanup_sysfs(device); | ||
462 | |||
463 | if (wifi_rfkill) | ||
464 | rfkill_unregister(wifi_rfkill); | ||
465 | if (bluetooth_rfkill) | ||
466 | rfkill_unregister(bluetooth_rfkill); | ||
467 | if (wwan_rfkill) | ||
468 | rfkill_unregister(wwan_rfkill); | ||
469 | |||
470 | return 0; | ||
471 | } | ||
472 | |||
473 | static int __init hp_wmi_init(void) | ||
474 | { | ||
475 | int err; | ||
476 | |||
477 | if (wmi_has_guid(HPWMI_EVENT_GUID)) { | ||
478 | err = wmi_install_notify_handler(HPWMI_EVENT_GUID, | ||
479 | hp_wmi_notify, NULL); | ||
480 | if (!err) | ||
481 | hp_wmi_input_setup(); | ||
482 | } | ||
483 | |||
484 | if (wmi_has_guid(HPWMI_BIOS_GUID)) { | ||
485 | err = platform_driver_register(&hp_wmi_driver); | ||
486 | if (err) | ||
487 | return 0; | ||
488 | hp_wmi_platform_dev = platform_device_alloc("hp-wmi", -1); | ||
489 | if (!hp_wmi_platform_dev) { | ||
490 | platform_driver_unregister(&hp_wmi_driver); | ||
491 | return 0; | ||
492 | } | ||
493 | platform_device_add(hp_wmi_platform_dev); | ||
494 | } | ||
495 | |||
496 | return 0; | ||
497 | } | ||
498 | |||
499 | static void __exit hp_wmi_exit(void) | ||
500 | { | ||
501 | if (wmi_has_guid(HPWMI_EVENT_GUID)) { | ||
502 | wmi_remove_notify_handler(HPWMI_EVENT_GUID); | ||
503 | input_unregister_device(hp_wmi_input_dev); | ||
504 | } | ||
505 | if (hp_wmi_platform_dev) { | ||
506 | platform_device_del(hp_wmi_platform_dev); | ||
507 | platform_driver_unregister(&hp_wmi_driver); | ||
508 | } | ||
509 | } | ||
510 | |||
511 | module_init(hp_wmi_init); | ||
512 | module_exit(hp_wmi_exit); | ||
diff --git a/drivers/platform/x86/intel_menlow.c b/drivers/platform/x86/intel_menlow.c new file mode 100644 index 000000000000..27b7662955bb --- /dev/null +++ b/drivers/platform/x86/intel_menlow.c | |||
@@ -0,0 +1,536 @@ | |||
1 | /* | ||
2 | * intel_menlow.c - Intel menlow Driver for thermal management extension | ||
3 | * | ||
4 | * Copyright (C) 2008 Intel Corp | ||
5 | * Copyright (C) 2008 Sujith Thomas <sujith.thomas@intel.com> | ||
6 | * Copyright (C) 2008 Zhang Rui <rui.zhang@intel.com> | ||
7 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or modify | ||
10 | * it under the terms of the GNU General Public License as published by | ||
11 | * the Free Software Foundation; version 2 of the License. | ||
12 | * | ||
13 | * This program is distributed in the hope that it will be useful, but | ||
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
16 | * General Public License for more details. | ||
17 | * | ||
18 | * You should have received a copy of the GNU General Public License along | ||
19 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
20 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. | ||
21 | * | ||
22 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
23 | * | ||
24 | * This driver creates the sys I/F for programming the sensors. | ||
25 | * It also implements the driver for intel menlow memory controller (hardware | ||
26 | * id is INT0002) which makes use of the platform specific ACPI methods | ||
27 | * to get/set bandwidth. | ||
28 | */ | ||
29 | |||
30 | #include <linux/kernel.h> | ||
31 | #include <linux/module.h> | ||
32 | #include <linux/init.h> | ||
33 | #include <linux/types.h> | ||
34 | #include <linux/pci.h> | ||
35 | #include <linux/pm.h> | ||
36 | |||
37 | #include <linux/thermal.h> | ||
38 | #include <acpi/acpi_bus.h> | ||
39 | #include <acpi/acpi_drivers.h> | ||
40 | |||
41 | MODULE_AUTHOR("Thomas Sujith"); | ||
42 | MODULE_AUTHOR("Zhang Rui"); | ||
43 | MODULE_DESCRIPTION("Intel Menlow platform specific driver"); | ||
44 | MODULE_LICENSE("GPL"); | ||
45 | |||
46 | /* | ||
47 | * Memory controller device control | ||
48 | */ | ||
49 | |||
50 | #define MEMORY_GET_BANDWIDTH "GTHS" | ||
51 | #define MEMORY_SET_BANDWIDTH "STHS" | ||
52 | #define MEMORY_ARG_CUR_BANDWIDTH 1 | ||
53 | #define MEMORY_ARG_MAX_BANDWIDTH 0 | ||
54 | |||
55 | /* | ||
56 | * GTHS returning 'n' would mean that [0,n-1] states are supported | ||
57 | * In that case max_cstate would be n-1 | ||
58 | * GTHS returning '0' would mean that no bandwidth control states are supported | ||
59 | */ | ||
60 | static int memory_get_int_max_bandwidth(struct thermal_cooling_device *cdev, | ||
61 | unsigned long *max_state) | ||
62 | { | ||
63 | struct acpi_device *device = cdev->devdata; | ||
64 | acpi_handle handle = device->handle; | ||
65 | unsigned long long value; | ||
66 | struct acpi_object_list arg_list; | ||
67 | union acpi_object arg; | ||
68 | acpi_status status = AE_OK; | ||
69 | |||
70 | arg_list.count = 1; | ||
71 | arg_list.pointer = &arg; | ||
72 | arg.type = ACPI_TYPE_INTEGER; | ||
73 | arg.integer.value = MEMORY_ARG_MAX_BANDWIDTH; | ||
74 | status = acpi_evaluate_integer(handle, MEMORY_GET_BANDWIDTH, | ||
75 | &arg_list, &value); | ||
76 | if (ACPI_FAILURE(status)) | ||
77 | return -EFAULT; | ||
78 | |||
79 | if (!value) | ||
80 | return -EINVAL; | ||
81 | |||
82 | *max_state = value - 1; | ||
83 | return 0; | ||
84 | } | ||
85 | |||
86 | static int memory_get_max_bandwidth(struct thermal_cooling_device *cdev, | ||
87 | char *buf) | ||
88 | { | ||
89 | unsigned long value; | ||
90 | if (memory_get_int_max_bandwidth(cdev, &value)) | ||
91 | return -EINVAL; | ||
92 | |||
93 | return sprintf(buf, "%ld\n", value); | ||
94 | } | ||
95 | |||
96 | static int memory_get_cur_bandwidth(struct thermal_cooling_device *cdev, | ||
97 | char *buf) | ||
98 | { | ||
99 | struct acpi_device *device = cdev->devdata; | ||
100 | acpi_handle handle = device->handle; | ||
101 | unsigned long long value; | ||
102 | struct acpi_object_list arg_list; | ||
103 | union acpi_object arg; | ||
104 | acpi_status status = AE_OK; | ||
105 | |||
106 | arg_list.count = 1; | ||
107 | arg_list.pointer = &arg; | ||
108 | arg.type = ACPI_TYPE_INTEGER; | ||
109 | arg.integer.value = MEMORY_ARG_CUR_BANDWIDTH; | ||
110 | status = acpi_evaluate_integer(handle, MEMORY_GET_BANDWIDTH, | ||
111 | &arg_list, &value); | ||
112 | if (ACPI_FAILURE(status)) | ||
113 | return -EFAULT; | ||
114 | |||
115 | return sprintf(buf, "%llu\n", value); | ||
116 | } | ||
117 | |||
118 | static int memory_set_cur_bandwidth(struct thermal_cooling_device *cdev, | ||
119 | unsigned int state) | ||
120 | { | ||
121 | struct acpi_device *device = cdev->devdata; | ||
122 | acpi_handle handle = device->handle; | ||
123 | struct acpi_object_list arg_list; | ||
124 | union acpi_object arg; | ||
125 | acpi_status status; | ||
126 | unsigned long long temp; | ||
127 | unsigned long max_state; | ||
128 | |||
129 | if (memory_get_int_max_bandwidth(cdev, &max_state)) | ||
130 | return -EFAULT; | ||
131 | |||
132 | if (state > max_state) | ||
133 | return -EINVAL; | ||
134 | |||
135 | arg_list.count = 1; | ||
136 | arg_list.pointer = &arg; | ||
137 | arg.type = ACPI_TYPE_INTEGER; | ||
138 | arg.integer.value = state; | ||
139 | |||
140 | status = | ||
141 | acpi_evaluate_integer(handle, MEMORY_SET_BANDWIDTH, &arg_list, | ||
142 | &temp); | ||
143 | |||
144 | printk(KERN_INFO | ||
145 | "Bandwidth value was %d: status is %d\n", state, status); | ||
146 | if (ACPI_FAILURE(status)) | ||
147 | return -EFAULT; | ||
148 | |||
149 | return 0; | ||
150 | } | ||
151 | |||
152 | static struct thermal_cooling_device_ops memory_cooling_ops = { | ||
153 | .get_max_state = memory_get_max_bandwidth, | ||
154 | .get_cur_state = memory_get_cur_bandwidth, | ||
155 | .set_cur_state = memory_set_cur_bandwidth, | ||
156 | }; | ||
157 | |||
158 | /* | ||
159 | * Memory Device Management | ||
160 | */ | ||
161 | static int intel_menlow_memory_add(struct acpi_device *device) | ||
162 | { | ||
163 | int result = -ENODEV; | ||
164 | acpi_status status = AE_OK; | ||
165 | acpi_handle dummy; | ||
166 | struct thermal_cooling_device *cdev; | ||
167 | |||
168 | if (!device) | ||
169 | return -EINVAL; | ||
170 | |||
171 | status = acpi_get_handle(device->handle, MEMORY_GET_BANDWIDTH, &dummy); | ||
172 | if (ACPI_FAILURE(status)) | ||
173 | goto end; | ||
174 | |||
175 | status = acpi_get_handle(device->handle, MEMORY_SET_BANDWIDTH, &dummy); | ||
176 | if (ACPI_FAILURE(status)) | ||
177 | goto end; | ||
178 | |||
179 | cdev = thermal_cooling_device_register("Memory controller", device, | ||
180 | &memory_cooling_ops); | ||
181 | if (IS_ERR(cdev)) { | ||
182 | result = PTR_ERR(cdev); | ||
183 | goto end; | ||
184 | } | ||
185 | |||
186 | device->driver_data = cdev; | ||
187 | result = sysfs_create_link(&device->dev.kobj, | ||
188 | &cdev->device.kobj, "thermal_cooling"); | ||
189 | if (result) | ||
190 | goto unregister; | ||
191 | |||
192 | result = sysfs_create_link(&cdev->device.kobj, | ||
193 | &device->dev.kobj, "device"); | ||
194 | if (result) { | ||
195 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); | ||
196 | goto unregister; | ||
197 | } | ||
198 | |||
199 | end: | ||
200 | return result; | ||
201 | |||
202 | unregister: | ||
203 | thermal_cooling_device_unregister(cdev); | ||
204 | return result; | ||
205 | |||
206 | } | ||
207 | |||
208 | static int intel_menlow_memory_remove(struct acpi_device *device, int type) | ||
209 | { | ||
210 | struct thermal_cooling_device *cdev = acpi_driver_data(device); | ||
211 | |||
212 | if (!device || !cdev) | ||
213 | return -EINVAL; | ||
214 | |||
215 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); | ||
216 | sysfs_remove_link(&cdev->device.kobj, "device"); | ||
217 | thermal_cooling_device_unregister(cdev); | ||
218 | |||
219 | return 0; | ||
220 | } | ||
221 | |||
222 | static const struct acpi_device_id intel_menlow_memory_ids[] = { | ||
223 | {"INT0002", 0}, | ||
224 | {"", 0}, | ||
225 | }; | ||
226 | |||
227 | static struct acpi_driver intel_menlow_memory_driver = { | ||
228 | .name = "intel_menlow_thermal_control", | ||
229 | .ids = intel_menlow_memory_ids, | ||
230 | .ops = { | ||
231 | .add = intel_menlow_memory_add, | ||
232 | .remove = intel_menlow_memory_remove, | ||
233 | }, | ||
234 | }; | ||
235 | |||
236 | /* | ||
237 | * Sensor control on menlow platform | ||
238 | */ | ||
239 | |||
240 | #define THERMAL_AUX0 0 | ||
241 | #define THERMAL_AUX1 1 | ||
242 | #define GET_AUX0 "GAX0" | ||
243 | #define GET_AUX1 "GAX1" | ||
244 | #define SET_AUX0 "SAX0" | ||
245 | #define SET_AUX1 "SAX1" | ||
246 | |||
247 | struct intel_menlow_attribute { | ||
248 | struct device_attribute attr; | ||
249 | struct device *device; | ||
250 | acpi_handle handle; | ||
251 | struct list_head node; | ||
252 | }; | ||
253 | |||
254 | static LIST_HEAD(intel_menlow_attr_list); | ||
255 | static DEFINE_MUTEX(intel_menlow_attr_lock); | ||
256 | |||
257 | /* | ||
258 | * sensor_get_auxtrip - get the current auxtrip value from sensor | ||
259 | * @name: Thermalzone name | ||
260 | * @auxtype : AUX0/AUX1 | ||
261 | * @buf: syfs buffer | ||
262 | */ | ||
263 | static int sensor_get_auxtrip(acpi_handle handle, int index, | ||
264 | unsigned long long *value) | ||
265 | { | ||
266 | acpi_status status; | ||
267 | |||
268 | if ((index != 0 && index != 1) || !value) | ||
269 | return -EINVAL; | ||
270 | |||
271 | status = acpi_evaluate_integer(handle, index ? GET_AUX1 : GET_AUX0, | ||
272 | NULL, value); | ||
273 | if (ACPI_FAILURE(status)) | ||
274 | return -EIO; | ||
275 | |||
276 | return 0; | ||
277 | } | ||
278 | |||
279 | /* | ||
280 | * sensor_set_auxtrip - set the new auxtrip value to sensor | ||
281 | * @name: Thermalzone name | ||
282 | * @auxtype : AUX0/AUX1 | ||
283 | * @buf: syfs buffer | ||
284 | */ | ||
285 | static int sensor_set_auxtrip(acpi_handle handle, int index, int value) | ||
286 | { | ||
287 | acpi_status status; | ||
288 | union acpi_object arg = { | ||
289 | ACPI_TYPE_INTEGER | ||
290 | }; | ||
291 | struct acpi_object_list args = { | ||
292 | 1, &arg | ||
293 | }; | ||
294 | unsigned long long temp; | ||
295 | |||
296 | if (index != 0 && index != 1) | ||
297 | return -EINVAL; | ||
298 | |||
299 | status = acpi_evaluate_integer(handle, index ? GET_AUX0 : GET_AUX1, | ||
300 | NULL, &temp); | ||
301 | if (ACPI_FAILURE(status)) | ||
302 | return -EIO; | ||
303 | if ((index && value < temp) || (!index && value > temp)) | ||
304 | return -EINVAL; | ||
305 | |||
306 | arg.integer.value = value; | ||
307 | status = acpi_evaluate_integer(handle, index ? SET_AUX1 : SET_AUX0, | ||
308 | &args, &temp); | ||
309 | if (ACPI_FAILURE(status)) | ||
310 | return -EIO; | ||
311 | |||
312 | /* do we need to check the return value of SAX0/SAX1 ? */ | ||
313 | |||
314 | return 0; | ||
315 | } | ||
316 | |||
317 | #define to_intel_menlow_attr(_attr) \ | ||
318 | container_of(_attr, struct intel_menlow_attribute, attr) | ||
319 | |||
320 | static ssize_t aux0_show(struct device *dev, | ||
321 | struct device_attribute *dev_attr, char *buf) | ||
322 | { | ||
323 | struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr); | ||
324 | unsigned long long value; | ||
325 | int result; | ||
326 | |||
327 | result = sensor_get_auxtrip(attr->handle, 0, &value); | ||
328 | |||
329 | return result ? result : sprintf(buf, "%lu", KELVIN_TO_CELSIUS(value)); | ||
330 | } | ||
331 | |||
332 | static ssize_t aux1_show(struct device *dev, | ||
333 | struct device_attribute *dev_attr, char *buf) | ||
334 | { | ||
335 | struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr); | ||
336 | unsigned long long value; | ||
337 | int result; | ||
338 | |||
339 | result = sensor_get_auxtrip(attr->handle, 1, &value); | ||
340 | |||
341 | return result ? result : sprintf(buf, "%lu", KELVIN_TO_CELSIUS(value)); | ||
342 | } | ||
343 | |||
344 | static ssize_t aux0_store(struct device *dev, | ||
345 | struct device_attribute *dev_attr, | ||
346 | const char *buf, size_t count) | ||
347 | { | ||
348 | struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr); | ||
349 | int value; | ||
350 | int result; | ||
351 | |||
352 | /*Sanity check; should be a positive integer */ | ||
353 | if (!sscanf(buf, "%d", &value)) | ||
354 | return -EINVAL; | ||
355 | |||
356 | if (value < 0) | ||
357 | return -EINVAL; | ||
358 | |||
359 | result = sensor_set_auxtrip(attr->handle, 0, CELSIUS_TO_KELVIN(value)); | ||
360 | return result ? result : count; | ||
361 | } | ||
362 | |||
363 | static ssize_t aux1_store(struct device *dev, | ||
364 | struct device_attribute *dev_attr, | ||
365 | const char *buf, size_t count) | ||
366 | { | ||
367 | struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr); | ||
368 | int value; | ||
369 | int result; | ||
370 | |||
371 | /*Sanity check; should be a positive integer */ | ||
372 | if (!sscanf(buf, "%d", &value)) | ||
373 | return -EINVAL; | ||
374 | |||
375 | if (value < 0) | ||
376 | return -EINVAL; | ||
377 | |||
378 | result = sensor_set_auxtrip(attr->handle, 1, CELSIUS_TO_KELVIN(value)); | ||
379 | return result ? result : count; | ||
380 | } | ||
381 | |||
382 | /* BIOS can enable/disable the thermal user application in dabney platform */ | ||
383 | #define BIOS_ENABLED "\\_TZ.GSTS" | ||
384 | static ssize_t bios_enabled_show(struct device *dev, | ||
385 | struct device_attribute *attr, char *buf) | ||
386 | { | ||
387 | acpi_status status; | ||
388 | unsigned long long bios_enabled; | ||
389 | |||
390 | status = acpi_evaluate_integer(NULL, BIOS_ENABLED, NULL, &bios_enabled); | ||
391 | if (ACPI_FAILURE(status)) | ||
392 | return -ENODEV; | ||
393 | |||
394 | return sprintf(buf, "%s\n", bios_enabled ? "enabled" : "disabled"); | ||
395 | } | ||
396 | |||
397 | static int intel_menlow_add_one_attribute(char *name, int mode, void *show, | ||
398 | void *store, struct device *dev, | ||
399 | acpi_handle handle) | ||
400 | { | ||
401 | struct intel_menlow_attribute *attr; | ||
402 | int result; | ||
403 | |||
404 | attr = kzalloc(sizeof(struct intel_menlow_attribute), GFP_KERNEL); | ||
405 | if (!attr) | ||
406 | return -ENOMEM; | ||
407 | |||
408 | attr->attr.attr.name = name; | ||
409 | attr->attr.attr.mode = mode; | ||
410 | attr->attr.show = show; | ||
411 | attr->attr.store = store; | ||
412 | attr->device = dev; | ||
413 | attr->handle = handle; | ||
414 | |||
415 | result = device_create_file(dev, &attr->attr); | ||
416 | if (result) | ||
417 | return result; | ||
418 | |||
419 | mutex_lock(&intel_menlow_attr_lock); | ||
420 | list_add_tail(&attr->node, &intel_menlow_attr_list); | ||
421 | mutex_unlock(&intel_menlow_attr_lock); | ||
422 | |||
423 | return 0; | ||
424 | } | ||
425 | |||
426 | static acpi_status intel_menlow_register_sensor(acpi_handle handle, u32 lvl, | ||
427 | void *context, void **rv) | ||
428 | { | ||
429 | acpi_status status; | ||
430 | acpi_handle dummy; | ||
431 | struct thermal_zone_device *thermal; | ||
432 | int result; | ||
433 | |||
434 | result = acpi_bus_get_private_data(handle, (void **)&thermal); | ||
435 | if (result) | ||
436 | return 0; | ||
437 | |||
438 | /* _TZ must have the AUX0/1 methods */ | ||
439 | status = acpi_get_handle(handle, GET_AUX0, &dummy); | ||
440 | if (ACPI_FAILURE(status)) | ||
441 | goto not_found; | ||
442 | |||
443 | status = acpi_get_handle(handle, SET_AUX0, &dummy); | ||
444 | if (ACPI_FAILURE(status)) | ||
445 | goto not_found; | ||
446 | |||
447 | result = intel_menlow_add_one_attribute("aux0", 0644, | ||
448 | aux0_show, aux0_store, | ||
449 | &thermal->device, handle); | ||
450 | if (result) | ||
451 | return AE_ERROR; | ||
452 | |||
453 | status = acpi_get_handle(handle, GET_AUX1, &dummy); | ||
454 | if (ACPI_FAILURE(status)) | ||
455 | goto not_found; | ||
456 | |||
457 | status = acpi_get_handle(handle, SET_AUX1, &dummy); | ||
458 | if (ACPI_FAILURE(status)) | ||
459 | goto not_found; | ||
460 | |||
461 | result = intel_menlow_add_one_attribute("aux1", 0644, | ||
462 | aux1_show, aux1_store, | ||
463 | &thermal->device, handle); | ||
464 | if (result) | ||
465 | return AE_ERROR; | ||
466 | |||
467 | /* | ||
468 | * create the "dabney_enabled" attribute which means the user app | ||
469 | * should be loaded or not | ||
470 | */ | ||
471 | |||
472 | result = intel_menlow_add_one_attribute("bios_enabled", 0444, | ||
473 | bios_enabled_show, NULL, | ||
474 | &thermal->device, handle); | ||
475 | if (result) | ||
476 | return AE_ERROR; | ||
477 | |||
478 | not_found: | ||
479 | if (status == AE_NOT_FOUND) | ||
480 | return AE_OK; | ||
481 | else | ||
482 | return status; | ||
483 | } | ||
484 | |||
485 | static void intel_menlow_unregister_sensor(void) | ||
486 | { | ||
487 | struct intel_menlow_attribute *pos, *next; | ||
488 | |||
489 | mutex_lock(&intel_menlow_attr_lock); | ||
490 | list_for_each_entry_safe(pos, next, &intel_menlow_attr_list, node) { | ||
491 | list_del(&pos->node); | ||
492 | device_remove_file(pos->device, &pos->attr); | ||
493 | kfree(pos); | ||
494 | } | ||
495 | mutex_unlock(&intel_menlow_attr_lock); | ||
496 | |||
497 | return; | ||
498 | } | ||
499 | |||
500 | static int __init intel_menlow_module_init(void) | ||
501 | { | ||
502 | int result = -ENODEV; | ||
503 | acpi_status status; | ||
504 | unsigned long long enable; | ||
505 | |||
506 | if (acpi_disabled) | ||
507 | return result; | ||
508 | |||
509 | /* Looking for the \_TZ.GSTS method */ | ||
510 | status = acpi_evaluate_integer(NULL, BIOS_ENABLED, NULL, &enable); | ||
511 | if (ACPI_FAILURE(status) || !enable) | ||
512 | return -ENODEV; | ||
513 | |||
514 | /* Looking for ACPI device MEM0 with hardware id INT0002 */ | ||
515 | result = acpi_bus_register_driver(&intel_menlow_memory_driver); | ||
516 | if (result) | ||
517 | return result; | ||
518 | |||
519 | /* Looking for sensors in each ACPI thermal zone */ | ||
520 | status = acpi_walk_namespace(ACPI_TYPE_THERMAL, ACPI_ROOT_OBJECT, | ||
521 | ACPI_UINT32_MAX, | ||
522 | intel_menlow_register_sensor, NULL, NULL); | ||
523 | if (ACPI_FAILURE(status)) | ||
524 | return -ENODEV; | ||
525 | |||
526 | return 0; | ||
527 | } | ||
528 | |||
529 | static void __exit intel_menlow_module_exit(void) | ||
530 | { | ||
531 | acpi_bus_unregister_driver(&intel_menlow_memory_driver); | ||
532 | intel_menlow_unregister_sensor(); | ||
533 | } | ||
534 | |||
535 | module_init(intel_menlow_module_init); | ||
536 | module_exit(intel_menlow_module_exit); | ||
diff --git a/drivers/platform/x86/msi-laptop.c b/drivers/platform/x86/msi-laptop.c new file mode 100644 index 000000000000..759763d18e4c --- /dev/null +++ b/drivers/platform/x86/msi-laptop.c | |||
@@ -0,0 +1,437 @@ | |||
1 | /*-*-linux-c-*-*/ | ||
2 | |||
3 | /* | ||
4 | Copyright (C) 2006 Lennart Poettering <mzxreary (at) 0pointer (dot) de> | ||
5 | |||
6 | This program is free software; you can redistribute it and/or modify | ||
7 | it under the terms of the GNU General Public License as published by | ||
8 | the Free Software Foundation; either version 2 of the License, or | ||
9 | (at your option) any later version. | ||
10 | |||
11 | This program is distributed in the hope that it will be useful, but | ||
12 | WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
14 | General Public License for more details. | ||
15 | |||
16 | You should have received a copy of the GNU General Public License | ||
17 | along with this program; if not, write to the Free Software | ||
18 | Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
19 | 02110-1301, USA. | ||
20 | */ | ||
21 | |||
22 | /* | ||
23 | * msi-laptop.c - MSI S270 laptop support. This laptop is sold under | ||
24 | * various brands, including "Cytron/TCM/Medion/Tchibo MD96100". | ||
25 | * | ||
26 | * Driver also supports S271, S420 models. | ||
27 | * | ||
28 | * This driver exports a few files in /sys/devices/platform/msi-laptop-pf/: | ||
29 | * | ||
30 | * lcd_level - Screen brightness: contains a single integer in the | ||
31 | * range 0..8. (rw) | ||
32 | * | ||
33 | * auto_brightness - Enable automatic brightness control: contains | ||
34 | * either 0 or 1. If set to 1 the hardware adjusts the screen | ||
35 | * brightness automatically when the power cord is | ||
36 | * plugged/unplugged. (rw) | ||
37 | * | ||
38 | * wlan - WLAN subsystem enabled: contains either 0 or 1. (ro) | ||
39 | * | ||
40 | * bluetooth - Bluetooth subsystem enabled: contains either 0 or 1 | ||
41 | * Please note that this file is constantly 0 if no Bluetooth | ||
42 | * hardware is available. (ro) | ||
43 | * | ||
44 | * In addition to these platform device attributes the driver | ||
45 | * registers itself in the Linux backlight control subsystem and is | ||
46 | * available to userspace under /sys/class/backlight/msi-laptop-bl/. | ||
47 | * | ||
48 | * This driver might work on other laptops produced by MSI. If you | ||
49 | * want to try it you can pass force=1 as argument to the module which | ||
50 | * will force it to load even when the DMI data doesn't identify the | ||
51 | * laptop as MSI S270. YMMV. | ||
52 | */ | ||
53 | |||
54 | #include <linux/module.h> | ||
55 | #include <linux/kernel.h> | ||
56 | #include <linux/init.h> | ||
57 | #include <linux/acpi.h> | ||
58 | #include <linux/dmi.h> | ||
59 | #include <linux/backlight.h> | ||
60 | #include <linux/platform_device.h> | ||
61 | |||
62 | #define MSI_DRIVER_VERSION "0.5" | ||
63 | |||
64 | #define MSI_LCD_LEVEL_MAX 9 | ||
65 | |||
66 | #define MSI_EC_COMMAND_WIRELESS 0x10 | ||
67 | #define MSI_EC_COMMAND_LCD_LEVEL 0x11 | ||
68 | |||
69 | static int force; | ||
70 | module_param(force, bool, 0); | ||
71 | MODULE_PARM_DESC(force, "Force driver load, ignore DMI data"); | ||
72 | |||
73 | static int auto_brightness; | ||
74 | module_param(auto_brightness, int, 0); | ||
75 | MODULE_PARM_DESC(auto_brightness, "Enable automatic brightness control (0: disabled; 1: enabled; 2: don't touch)"); | ||
76 | |||
77 | /* Hardware access */ | ||
78 | |||
79 | static int set_lcd_level(int level) | ||
80 | { | ||
81 | u8 buf[2]; | ||
82 | |||
83 | if (level < 0 || level >= MSI_LCD_LEVEL_MAX) | ||
84 | return -EINVAL; | ||
85 | |||
86 | buf[0] = 0x80; | ||
87 | buf[1] = (u8) (level*31); | ||
88 | |||
89 | return ec_transaction(MSI_EC_COMMAND_LCD_LEVEL, buf, sizeof(buf), NULL, 0, 1); | ||
90 | } | ||
91 | |||
92 | static int get_lcd_level(void) | ||
93 | { | ||
94 | u8 wdata = 0, rdata; | ||
95 | int result; | ||
96 | |||
97 | result = ec_transaction(MSI_EC_COMMAND_LCD_LEVEL, &wdata, 1, &rdata, 1, 1); | ||
98 | if (result < 0) | ||
99 | return result; | ||
100 | |||
101 | return (int) rdata / 31; | ||
102 | } | ||
103 | |||
104 | static int get_auto_brightness(void) | ||
105 | { | ||
106 | u8 wdata = 4, rdata; | ||
107 | int result; | ||
108 | |||
109 | result = ec_transaction(MSI_EC_COMMAND_LCD_LEVEL, &wdata, 1, &rdata, 1, 1); | ||
110 | if (result < 0) | ||
111 | return result; | ||
112 | |||
113 | return !!(rdata & 8); | ||
114 | } | ||
115 | |||
116 | static int set_auto_brightness(int enable) | ||
117 | { | ||
118 | u8 wdata[2], rdata; | ||
119 | int result; | ||
120 | |||
121 | wdata[0] = 4; | ||
122 | |||
123 | result = ec_transaction(MSI_EC_COMMAND_LCD_LEVEL, wdata, 1, &rdata, 1, 1); | ||
124 | if (result < 0) | ||
125 | return result; | ||
126 | |||
127 | wdata[0] = 0x84; | ||
128 | wdata[1] = (rdata & 0xF7) | (enable ? 8 : 0); | ||
129 | |||
130 | return ec_transaction(MSI_EC_COMMAND_LCD_LEVEL, wdata, 2, NULL, 0, 1); | ||
131 | } | ||
132 | |||
133 | static int get_wireless_state(int *wlan, int *bluetooth) | ||
134 | { | ||
135 | u8 wdata = 0, rdata; | ||
136 | int result; | ||
137 | |||
138 | result = ec_transaction(MSI_EC_COMMAND_WIRELESS, &wdata, 1, &rdata, 1, 1); | ||
139 | if (result < 0) | ||
140 | return -1; | ||
141 | |||
142 | if (wlan) | ||
143 | *wlan = !!(rdata & 8); | ||
144 | |||
145 | if (bluetooth) | ||
146 | *bluetooth = !!(rdata & 128); | ||
147 | |||
148 | return 0; | ||
149 | } | ||
150 | |||
151 | /* Backlight device stuff */ | ||
152 | |||
153 | static int bl_get_brightness(struct backlight_device *b) | ||
154 | { | ||
155 | return get_lcd_level(); | ||
156 | } | ||
157 | |||
158 | |||
159 | static int bl_update_status(struct backlight_device *b) | ||
160 | { | ||
161 | return set_lcd_level(b->props.brightness); | ||
162 | } | ||
163 | |||
164 | static struct backlight_ops msibl_ops = { | ||
165 | .get_brightness = bl_get_brightness, | ||
166 | .update_status = bl_update_status, | ||
167 | }; | ||
168 | |||
169 | static struct backlight_device *msibl_device; | ||
170 | |||
171 | /* Platform device */ | ||
172 | |||
173 | static ssize_t show_wlan(struct device *dev, | ||
174 | struct device_attribute *attr, char *buf) | ||
175 | { | ||
176 | |||
177 | int ret, enabled; | ||
178 | |||
179 | ret = get_wireless_state(&enabled, NULL); | ||
180 | if (ret < 0) | ||
181 | return ret; | ||
182 | |||
183 | return sprintf(buf, "%i\n", enabled); | ||
184 | } | ||
185 | |||
186 | static ssize_t show_bluetooth(struct device *dev, | ||
187 | struct device_attribute *attr, char *buf) | ||
188 | { | ||
189 | |||
190 | int ret, enabled; | ||
191 | |||
192 | ret = get_wireless_state(NULL, &enabled); | ||
193 | if (ret < 0) | ||
194 | return ret; | ||
195 | |||
196 | return sprintf(buf, "%i\n", enabled); | ||
197 | } | ||
198 | |||
199 | static ssize_t show_lcd_level(struct device *dev, | ||
200 | struct device_attribute *attr, char *buf) | ||
201 | { | ||
202 | |||
203 | int ret; | ||
204 | |||
205 | ret = get_lcd_level(); | ||
206 | if (ret < 0) | ||
207 | return ret; | ||
208 | |||
209 | return sprintf(buf, "%i\n", ret); | ||
210 | } | ||
211 | |||
212 | static ssize_t store_lcd_level(struct device *dev, | ||
213 | struct device_attribute *attr, const char *buf, size_t count) | ||
214 | { | ||
215 | |||
216 | int level, ret; | ||
217 | |||
218 | if (sscanf(buf, "%i", &level) != 1 || (level < 0 || level >= MSI_LCD_LEVEL_MAX)) | ||
219 | return -EINVAL; | ||
220 | |||
221 | ret = set_lcd_level(level); | ||
222 | if (ret < 0) | ||
223 | return ret; | ||
224 | |||
225 | return count; | ||
226 | } | ||
227 | |||
228 | static ssize_t show_auto_brightness(struct device *dev, | ||
229 | struct device_attribute *attr, char *buf) | ||
230 | { | ||
231 | |||
232 | int ret; | ||
233 | |||
234 | ret = get_auto_brightness(); | ||
235 | if (ret < 0) | ||
236 | return ret; | ||
237 | |||
238 | return sprintf(buf, "%i\n", ret); | ||
239 | } | ||
240 | |||
241 | static ssize_t store_auto_brightness(struct device *dev, | ||
242 | struct device_attribute *attr, const char *buf, size_t count) | ||
243 | { | ||
244 | |||
245 | int enable, ret; | ||
246 | |||
247 | if (sscanf(buf, "%i", &enable) != 1 || (enable != (enable & 1))) | ||
248 | return -EINVAL; | ||
249 | |||
250 | ret = set_auto_brightness(enable); | ||
251 | if (ret < 0) | ||
252 | return ret; | ||
253 | |||
254 | return count; | ||
255 | } | ||
256 | |||
257 | static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level); | ||
258 | static DEVICE_ATTR(auto_brightness, 0644, show_auto_brightness, store_auto_brightness); | ||
259 | static DEVICE_ATTR(bluetooth, 0444, show_bluetooth, NULL); | ||
260 | static DEVICE_ATTR(wlan, 0444, show_wlan, NULL); | ||
261 | |||
262 | static struct attribute *msipf_attributes[] = { | ||
263 | &dev_attr_lcd_level.attr, | ||
264 | &dev_attr_auto_brightness.attr, | ||
265 | &dev_attr_bluetooth.attr, | ||
266 | &dev_attr_wlan.attr, | ||
267 | NULL | ||
268 | }; | ||
269 | |||
270 | static struct attribute_group msipf_attribute_group = { | ||
271 | .attrs = msipf_attributes | ||
272 | }; | ||
273 | |||
274 | static struct platform_driver msipf_driver = { | ||
275 | .driver = { | ||
276 | .name = "msi-laptop-pf", | ||
277 | .owner = THIS_MODULE, | ||
278 | } | ||
279 | }; | ||
280 | |||
281 | static struct platform_device *msipf_device; | ||
282 | |||
283 | /* Initialization */ | ||
284 | |||
285 | static int dmi_check_cb(const struct dmi_system_id *id) | ||
286 | { | ||
287 | printk("msi-laptop: Identified laptop model '%s'.\n", id->ident); | ||
288 | return 0; | ||
289 | } | ||
290 | |||
291 | static struct dmi_system_id __initdata msi_dmi_table[] = { | ||
292 | { | ||
293 | .ident = "MSI S270", | ||
294 | .matches = { | ||
295 | DMI_MATCH(DMI_SYS_VENDOR, "MICRO-STAR INT'L CO.,LTD"), | ||
296 | DMI_MATCH(DMI_PRODUCT_NAME, "MS-1013"), | ||
297 | DMI_MATCH(DMI_PRODUCT_VERSION, "0131"), | ||
298 | DMI_MATCH(DMI_CHASSIS_VENDOR, "MICRO-STAR INT'L CO.,LTD") | ||
299 | }, | ||
300 | .callback = dmi_check_cb | ||
301 | }, | ||
302 | { | ||
303 | .ident = "MSI S271", | ||
304 | .matches = { | ||
305 | DMI_MATCH(DMI_SYS_VENDOR, "Micro-Star International"), | ||
306 | DMI_MATCH(DMI_PRODUCT_NAME, "MS-1058"), | ||
307 | DMI_MATCH(DMI_PRODUCT_VERSION, "0581"), | ||
308 | DMI_MATCH(DMI_BOARD_NAME, "MS-1058") | ||
309 | }, | ||
310 | .callback = dmi_check_cb | ||
311 | }, | ||
312 | { | ||
313 | .ident = "MSI S420", | ||
314 | .matches = { | ||
315 | DMI_MATCH(DMI_SYS_VENDOR, "Micro-Star International"), | ||
316 | DMI_MATCH(DMI_PRODUCT_NAME, "MS-1412"), | ||
317 | DMI_MATCH(DMI_BOARD_VENDOR, "MSI"), | ||
318 | DMI_MATCH(DMI_BOARD_NAME, "MS-1412") | ||
319 | }, | ||
320 | .callback = dmi_check_cb | ||
321 | }, | ||
322 | { | ||
323 | .ident = "Medion MD96100", | ||
324 | .matches = { | ||
325 | DMI_MATCH(DMI_SYS_VENDOR, "NOTEBOOK"), | ||
326 | DMI_MATCH(DMI_PRODUCT_NAME, "SAM2000"), | ||
327 | DMI_MATCH(DMI_PRODUCT_VERSION, "0131"), | ||
328 | DMI_MATCH(DMI_CHASSIS_VENDOR, "MICRO-STAR INT'L CO.,LTD") | ||
329 | }, | ||
330 | .callback = dmi_check_cb | ||
331 | }, | ||
332 | { } | ||
333 | }; | ||
334 | |||
335 | static int __init msi_init(void) | ||
336 | { | ||
337 | int ret; | ||
338 | |||
339 | if (acpi_disabled) | ||
340 | return -ENODEV; | ||
341 | |||
342 | if (!force && !dmi_check_system(msi_dmi_table)) | ||
343 | return -ENODEV; | ||
344 | |||
345 | if (auto_brightness < 0 || auto_brightness > 2) | ||
346 | return -EINVAL; | ||
347 | |||
348 | /* Register backlight stuff */ | ||
349 | |||
350 | if (acpi_video_backlight_support()) { | ||
351 | printk(KERN_INFO "MSI: Brightness ignored, must be controlled " | ||
352 | "by ACPI video driver\n"); | ||
353 | } else { | ||
354 | msibl_device = backlight_device_register("msi-laptop-bl", NULL, | ||
355 | NULL, &msibl_ops); | ||
356 | if (IS_ERR(msibl_device)) | ||
357 | return PTR_ERR(msibl_device); | ||
358 | msibl_device->props.max_brightness = MSI_LCD_LEVEL_MAX-1; | ||
359 | } | ||
360 | |||
361 | ret = platform_driver_register(&msipf_driver); | ||
362 | if (ret) | ||
363 | goto fail_backlight; | ||
364 | |||
365 | /* Register platform stuff */ | ||
366 | |||
367 | msipf_device = platform_device_alloc("msi-laptop-pf", -1); | ||
368 | if (!msipf_device) { | ||
369 | ret = -ENOMEM; | ||
370 | goto fail_platform_driver; | ||
371 | } | ||
372 | |||
373 | ret = platform_device_add(msipf_device); | ||
374 | if (ret) | ||
375 | goto fail_platform_device1; | ||
376 | |||
377 | ret = sysfs_create_group(&msipf_device->dev.kobj, &msipf_attribute_group); | ||
378 | if (ret) | ||
379 | goto fail_platform_device2; | ||
380 | |||
381 | /* Disable automatic brightness control by default because | ||
382 | * this module was probably loaded to do brightness control in | ||
383 | * software. */ | ||
384 | |||
385 | if (auto_brightness != 2) | ||
386 | set_auto_brightness(auto_brightness); | ||
387 | |||
388 | printk(KERN_INFO "msi-laptop: driver "MSI_DRIVER_VERSION" successfully loaded.\n"); | ||
389 | |||
390 | return 0; | ||
391 | |||
392 | fail_platform_device2: | ||
393 | |||
394 | platform_device_del(msipf_device); | ||
395 | |||
396 | fail_platform_device1: | ||
397 | |||
398 | platform_device_put(msipf_device); | ||
399 | |||
400 | fail_platform_driver: | ||
401 | |||
402 | platform_driver_unregister(&msipf_driver); | ||
403 | |||
404 | fail_backlight: | ||
405 | |||
406 | backlight_device_unregister(msibl_device); | ||
407 | |||
408 | return ret; | ||
409 | } | ||
410 | |||
411 | static void __exit msi_cleanup(void) | ||
412 | { | ||
413 | |||
414 | sysfs_remove_group(&msipf_device->dev.kobj, &msipf_attribute_group); | ||
415 | platform_device_unregister(msipf_device); | ||
416 | platform_driver_unregister(&msipf_driver); | ||
417 | backlight_device_unregister(msibl_device); | ||
418 | |||
419 | /* Enable automatic brightness control again */ | ||
420 | if (auto_brightness != 2) | ||
421 | set_auto_brightness(1); | ||
422 | |||
423 | printk(KERN_INFO "msi-laptop: driver unloaded.\n"); | ||
424 | } | ||
425 | |||
426 | module_init(msi_init); | ||
427 | module_exit(msi_cleanup); | ||
428 | |||
429 | MODULE_AUTHOR("Lennart Poettering"); | ||
430 | MODULE_DESCRIPTION("MSI Laptop Support"); | ||
431 | MODULE_VERSION(MSI_DRIVER_VERSION); | ||
432 | MODULE_LICENSE("GPL"); | ||
433 | |||
434 | MODULE_ALIAS("dmi:*:svnMICRO-STARINT'LCO.,LTD:pnMS-1013:pvr0131*:cvnMICRO-STARINT'LCO.,LTD:ct10:*"); | ||
435 | MODULE_ALIAS("dmi:*:svnMicro-StarInternational:pnMS-1058:pvr0581:rvnMSI:rnMS-1058:*:ct10:*"); | ||
436 | MODULE_ALIAS("dmi:*:svnMicro-StarInternational:pnMS-1412:*:rvnMSI:rnMS-1412:*:cvnMICRO-STARINT'LCO.,LTD:ct10:*"); | ||
437 | MODULE_ALIAS("dmi:*:svnNOTEBOOK:pnSAM2000:pvr0131*:cvnMICRO-STARINT'LCO.,LTD:ct10:*"); | ||
diff --git a/drivers/platform/x86/panasonic-laptop.c b/drivers/platform/x86/panasonic-laptop.c new file mode 100644 index 000000000000..f30db367c82e --- /dev/null +++ b/drivers/platform/x86/panasonic-laptop.c | |||
@@ -0,0 +1,744 @@ | |||
1 | /* | ||
2 | * Panasonic HotKey and LCD brightness control driver | ||
3 | * (C) 2004 Hiroshi Miura <miura@da-cha.org> | ||
4 | * (C) 2004 NTT DATA Intellilink Co. http://www.intellilink.co.jp/ | ||
5 | * (C) YOKOTA Hiroshi <yokota (at) netlab. is. tsukuba. ac. jp> | ||
6 | * (C) 2004 David Bronaugh <dbronaugh> | ||
7 | * (C) 2006-2008 Harald Welte <laforge@gnumonks.org> | ||
8 | * | ||
9 | * derived from toshiba_acpi.c, Copyright (C) 2002-2004 John Belmonte | ||
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 version 2 as | ||
13 | * publicshed by the Free Software Foundation. | ||
14 | * | ||
15 | * This program is distributed in the hope that it will be useful, | ||
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
18 | * GNU General Public License for more details. | ||
19 | * | ||
20 | * You should have received a copy of the GNU General Public License | ||
21 | * along with this program; if not, write to the Free Software | ||
22 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
23 | * | ||
24 | *--------------------------------------------------------------------------- | ||
25 | * | ||
26 | * ChangeLog: | ||
27 | * Sep.23, 2008 Harald Welte <laforge@gnumonks.org> | ||
28 | * -v0.95 rename driver from drivers/acpi/pcc_acpi.c to | ||
29 | * drivers/misc/panasonic-laptop.c | ||
30 | * | ||
31 | * Jul.04, 2008 Harald Welte <laforge@gnumonks.org> | ||
32 | * -v0.94 replace /proc interface with device attributes | ||
33 | * support {set,get}keycode on th input device | ||
34 | * | ||
35 | * Jun.27, 2008 Harald Welte <laforge@gnumonks.org> | ||
36 | * -v0.92 merge with 2.6.26-rc6 input API changes | ||
37 | * remove broken <= 2.6.15 kernel support | ||
38 | * resolve all compiler warnings | ||
39 | * various coding style fixes (checkpatch.pl) | ||
40 | * add support for backlight api | ||
41 | * major code restructuring | ||
42 | * | ||
43 | * Dac.28, 2007 Harald Welte <laforge@gnumonks.org> | ||
44 | * -v0.91 merge with 2.6.24-rc6 ACPI changes | ||
45 | * | ||
46 | * Nov.04, 2006 Hiroshi Miura <miura@da-cha.org> | ||
47 | * -v0.9 remove warning about section reference. | ||
48 | * remove acpi_os_free | ||
49 | * add /proc/acpi/pcc/brightness interface for HAL access | ||
50 | * merge dbronaugh's enhancement | ||
51 | * Aug.17, 2004 David Bronaugh (dbronaugh) | ||
52 | * - Added screen brightness setting interface | ||
53 | * Thanks to FreeBSD crew (acpi_panasonic.c) | ||
54 | * for the ideas I needed to accomplish it | ||
55 | * | ||
56 | * May.29, 2006 Hiroshi Miura <miura@da-cha.org> | ||
57 | * -v0.8.4 follow to change keyinput structure | ||
58 | * thanks Fabian Yamaguchi <fabs@cs.tu-berlin.de>, | ||
59 | * Jacob Bower <jacob.bower@ic.ac.uk> and | ||
60 | * Hiroshi Yokota for providing solutions. | ||
61 | * | ||
62 | * Oct.02, 2004 Hiroshi Miura <miura@da-cha.org> | ||
63 | * -v0.8.2 merge code of YOKOTA Hiroshi | ||
64 | * <yokota@netlab.is.tsukuba.ac.jp>. | ||
65 | * Add sticky key mode interface. | ||
66 | * Refactoring acpi_pcc_generate_keyinput(). | ||
67 | * | ||
68 | * Sep.15, 2004 Hiroshi Miura <miura@da-cha.org> | ||
69 | * -v0.8 Generate key input event on input subsystem. | ||
70 | * This is based on yet another driver written by | ||
71 | * Ryuta Nakanishi. | ||
72 | * | ||
73 | * Sep.10, 2004 Hiroshi Miura <miura@da-cha.org> | ||
74 | * -v0.7 Change proc interface functions using seq_file | ||
75 | * facility as same as other ACPI drivers. | ||
76 | * | ||
77 | * Aug.28, 2004 Hiroshi Miura <miura@da-cha.org> | ||
78 | * -v0.6.4 Fix a silly error with status checking | ||
79 | * | ||
80 | * Aug.25, 2004 Hiroshi Miura <miura@da-cha.org> | ||
81 | * -v0.6.3 replace read_acpi_int by standard function | ||
82 | * acpi_evaluate_integer | ||
83 | * some clean up and make smart copyright notice. | ||
84 | * fix return value of pcc_acpi_get_key() | ||
85 | * fix checking return value of acpi_bus_register_driver() | ||
86 | * | ||
87 | * Aug.22, 2004 David Bronaugh <dbronaugh@linuxboxen.org> | ||
88 | * -v0.6.2 Add check on ACPI data (num_sifr) | ||
89 | * Coding style cleanups, better error messages/handling | ||
90 | * Fixed an off-by-one error in memory allocation | ||
91 | * | ||
92 | * Aug.21, 2004 David Bronaugh <dbronaugh@linuxboxen.org> | ||
93 | * -v0.6.1 Fix a silly error with status checking | ||
94 | * | ||
95 | * Aug.20, 2004 David Bronaugh <dbronaugh@linuxboxen.org> | ||
96 | * - v0.6 Correct brightness controls to reflect reality | ||
97 | * based on information gleaned by Hiroshi Miura | ||
98 | * and discussions with Hiroshi Miura | ||
99 | * | ||
100 | * Aug.10, 2004 Hiroshi Miura <miura@da-cha.org> | ||
101 | * - v0.5 support LCD brightness control | ||
102 | * based on the disclosed information by MEI. | ||
103 | * | ||
104 | * Jul.25, 2004 Hiroshi Miura <miura@da-cha.org> | ||
105 | * - v0.4 first post version | ||
106 | * add function to retrive SIFR | ||
107 | * | ||
108 | * Jul.24, 2004 Hiroshi Miura <miura@da-cha.org> | ||
109 | * - v0.3 get proper status of hotkey | ||
110 | * | ||
111 | * Jul.22, 2004 Hiroshi Miura <miura@da-cha.org> | ||
112 | * - v0.2 add HotKey handler | ||
113 | * | ||
114 | * Jul.17, 2004 Hiroshi Miura <miura@da-cha.org> | ||
115 | * - v0.1 start from toshiba_acpi driver written by John Belmonte | ||
116 | * | ||
117 | */ | ||
118 | |||
119 | #include <linux/kernel.h> | ||
120 | #include <linux/module.h> | ||
121 | #include <linux/init.h> | ||
122 | #include <linux/types.h> | ||
123 | #include <linux/backlight.h> | ||
124 | #include <linux/ctype.h> | ||
125 | #include <linux/seq_file.h> | ||
126 | #include <linux/uaccess.h> | ||
127 | #include <acpi/acpi_bus.h> | ||
128 | #include <acpi/acpi_drivers.h> | ||
129 | #include <linux/input.h> | ||
130 | |||
131 | |||
132 | #ifndef ACPI_HOTKEY_COMPONENT | ||
133 | #define ACPI_HOTKEY_COMPONENT 0x10000000 | ||
134 | #endif | ||
135 | |||
136 | #define _COMPONENT ACPI_HOTKEY_COMPONENT | ||
137 | |||
138 | MODULE_AUTHOR("Hiroshi Miura, David Bronaugh and Harald Welte"); | ||
139 | MODULE_DESCRIPTION("ACPI HotKey driver for Panasonic Let's Note laptops"); | ||
140 | MODULE_LICENSE("GPL"); | ||
141 | |||
142 | #define LOGPREFIX "pcc_acpi: " | ||
143 | |||
144 | /* Define ACPI PATHs */ | ||
145 | /* Lets note hotkeys */ | ||
146 | #define METHOD_HKEY_QUERY "HINF" | ||
147 | #define METHOD_HKEY_SQTY "SQTY" | ||
148 | #define METHOD_HKEY_SINF "SINF" | ||
149 | #define METHOD_HKEY_SSET "SSET" | ||
150 | #define HKEY_NOTIFY 0x80 | ||
151 | |||
152 | #define ACPI_PCC_DRIVER_NAME "Panasonic Laptop Support" | ||
153 | #define ACPI_PCC_DEVICE_NAME "Hotkey" | ||
154 | #define ACPI_PCC_CLASS "pcc" | ||
155 | |||
156 | #define ACPI_PCC_INPUT_PHYS "panasonic/hkey0" | ||
157 | |||
158 | /* LCD_TYPEs: 0 = Normal, 1 = Semi-transparent | ||
159 | ENV_STATEs: Normal temp=0x01, High temp=0x81, N/A=0x00 | ||
160 | */ | ||
161 | enum SINF_BITS { SINF_NUM_BATTERIES = 0, | ||
162 | SINF_LCD_TYPE, | ||
163 | SINF_AC_MAX_BRIGHT, | ||
164 | SINF_AC_MIN_BRIGHT, | ||
165 | SINF_AC_CUR_BRIGHT, | ||
166 | SINF_DC_MAX_BRIGHT, | ||
167 | SINF_DC_MIN_BRIGHT, | ||
168 | SINF_DC_CUR_BRIGHT, | ||
169 | SINF_MUTE, | ||
170 | SINF_RESERVED, | ||
171 | SINF_ENV_STATE, | ||
172 | SINF_STICKY_KEY = 0x80, | ||
173 | }; | ||
174 | /* R1 handles SINF_AC_CUR_BRIGHT as SINF_CUR_BRIGHT, doesn't know AC state */ | ||
175 | |||
176 | static int acpi_pcc_hotkey_add(struct acpi_device *device); | ||
177 | static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type); | ||
178 | static int acpi_pcc_hotkey_resume(struct acpi_device *device); | ||
179 | |||
180 | static const struct acpi_device_id pcc_device_ids[] = { | ||
181 | { "MAT0012", 0}, | ||
182 | { "MAT0013", 0}, | ||
183 | { "MAT0018", 0}, | ||
184 | { "MAT0019", 0}, | ||
185 | { "", 0}, | ||
186 | }; | ||
187 | |||
188 | static struct acpi_driver acpi_pcc_driver = { | ||
189 | .name = ACPI_PCC_DRIVER_NAME, | ||
190 | .class = ACPI_PCC_CLASS, | ||
191 | .ids = pcc_device_ids, | ||
192 | .ops = { | ||
193 | .add = acpi_pcc_hotkey_add, | ||
194 | .remove = acpi_pcc_hotkey_remove, | ||
195 | .resume = acpi_pcc_hotkey_resume, | ||
196 | }, | ||
197 | }; | ||
198 | |||
199 | #define KEYMAP_SIZE 11 | ||
200 | static const int initial_keymap[KEYMAP_SIZE] = { | ||
201 | /* 0 */ KEY_RESERVED, | ||
202 | /* 1 */ KEY_BRIGHTNESSDOWN, | ||
203 | /* 2 */ KEY_BRIGHTNESSUP, | ||
204 | /* 3 */ KEY_DISPLAYTOGGLE, | ||
205 | /* 4 */ KEY_MUTE, | ||
206 | /* 5 */ KEY_VOLUMEDOWN, | ||
207 | /* 6 */ KEY_VOLUMEUP, | ||
208 | /* 7 */ KEY_SLEEP, | ||
209 | /* 8 */ KEY_PROG1, /* Change CPU boost */ | ||
210 | /* 9 */ KEY_BATTERY, | ||
211 | /* 10 */ KEY_SUSPEND, | ||
212 | }; | ||
213 | |||
214 | struct pcc_acpi { | ||
215 | acpi_handle handle; | ||
216 | unsigned long num_sifr; | ||
217 | int sticky_mode; | ||
218 | u32 *sinf; | ||
219 | struct acpi_device *device; | ||
220 | struct input_dev *input_dev; | ||
221 | struct backlight_device *backlight; | ||
222 | int keymap[KEYMAP_SIZE]; | ||
223 | }; | ||
224 | |||
225 | struct pcc_keyinput { | ||
226 | struct acpi_hotkey *hotkey; | ||
227 | }; | ||
228 | |||
229 | /* method access functions */ | ||
230 | static int acpi_pcc_write_sset(struct pcc_acpi *pcc, int func, int val) | ||
231 | { | ||
232 | union acpi_object in_objs[] = { | ||
233 | { .integer.type = ACPI_TYPE_INTEGER, | ||
234 | .integer.value = func, }, | ||
235 | { .integer.type = ACPI_TYPE_INTEGER, | ||
236 | .integer.value = val, }, | ||
237 | }; | ||
238 | struct acpi_object_list params = { | ||
239 | .count = ARRAY_SIZE(in_objs), | ||
240 | .pointer = in_objs, | ||
241 | }; | ||
242 | acpi_status status = AE_OK; | ||
243 | |||
244 | status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SSET, | ||
245 | ¶ms, NULL); | ||
246 | |||
247 | return status == AE_OK; | ||
248 | } | ||
249 | |||
250 | static inline int acpi_pcc_get_sqty(struct acpi_device *device) | ||
251 | { | ||
252 | unsigned long long s; | ||
253 | acpi_status status; | ||
254 | |||
255 | status = acpi_evaluate_integer(device->handle, METHOD_HKEY_SQTY, | ||
256 | NULL, &s); | ||
257 | if (ACPI_SUCCESS(status)) | ||
258 | return s; | ||
259 | else { | ||
260 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
261 | "evaluation error HKEY.SQTY\n")); | ||
262 | return -EINVAL; | ||
263 | } | ||
264 | } | ||
265 | |||
266 | static int acpi_pcc_retrieve_biosdata(struct pcc_acpi *pcc, u32 *sinf) | ||
267 | { | ||
268 | acpi_status status; | ||
269 | struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; | ||
270 | union acpi_object *hkey = NULL; | ||
271 | int i; | ||
272 | |||
273 | status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SINF, 0, | ||
274 | &buffer); | ||
275 | if (ACPI_FAILURE(status)) { | ||
276 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
277 | "evaluation error HKEY.SINF\n")); | ||
278 | return 0; | ||
279 | } | ||
280 | |||
281 | hkey = buffer.pointer; | ||
282 | if (!hkey || (hkey->type != ACPI_TYPE_PACKAGE)) { | ||
283 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid HKEY.SINF\n")); | ||
284 | goto end; | ||
285 | } | ||
286 | |||
287 | if (pcc->num_sifr < hkey->package.count) { | ||
288 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
289 | "SQTY reports bad SINF length\n")); | ||
290 | status = AE_ERROR; | ||
291 | goto end; | ||
292 | } | ||
293 | |||
294 | for (i = 0; i < hkey->package.count; i++) { | ||
295 | union acpi_object *element = &(hkey->package.elements[i]); | ||
296 | if (likely(element->type == ACPI_TYPE_INTEGER)) { | ||
297 | sinf[i] = element->integer.value; | ||
298 | } else | ||
299 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
300 | "Invalid HKEY.SINF data\n")); | ||
301 | } | ||
302 | sinf[hkey->package.count] = -1; | ||
303 | |||
304 | end: | ||
305 | kfree(buffer.pointer); | ||
306 | return status == AE_OK; | ||
307 | } | ||
308 | |||
309 | /* backlight API interface functions */ | ||
310 | |||
311 | /* This driver currently treats AC and DC brightness identical, | ||
312 | * since we don't need to invent an interface to the core ACPI | ||
313 | * logic to receive events in case a power supply is plugged in | ||
314 | * or removed */ | ||
315 | |||
316 | static int bl_get(struct backlight_device *bd) | ||
317 | { | ||
318 | struct pcc_acpi *pcc = bl_get_data(bd); | ||
319 | |||
320 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) | ||
321 | return -EIO; | ||
322 | |||
323 | return pcc->sinf[SINF_AC_CUR_BRIGHT]; | ||
324 | } | ||
325 | |||
326 | static int bl_set_status(struct backlight_device *bd) | ||
327 | { | ||
328 | struct pcc_acpi *pcc = bl_get_data(bd); | ||
329 | int bright = bd->props.brightness; | ||
330 | int rc; | ||
331 | |||
332 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) | ||
333 | return -EIO; | ||
334 | |||
335 | if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT]) | ||
336 | bright = pcc->sinf[SINF_AC_MIN_BRIGHT]; | ||
337 | |||
338 | if (bright < pcc->sinf[SINF_DC_MIN_BRIGHT]) | ||
339 | bright = pcc->sinf[SINF_DC_MIN_BRIGHT]; | ||
340 | |||
341 | if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT] || | ||
342 | bright > pcc->sinf[SINF_AC_MAX_BRIGHT]) | ||
343 | return -EINVAL; | ||
344 | |||
345 | rc = acpi_pcc_write_sset(pcc, SINF_AC_CUR_BRIGHT, bright); | ||
346 | if (rc < 0) | ||
347 | return rc; | ||
348 | |||
349 | return acpi_pcc_write_sset(pcc, SINF_DC_CUR_BRIGHT, bright); | ||
350 | } | ||
351 | |||
352 | static struct backlight_ops pcc_backlight_ops = { | ||
353 | .get_brightness = bl_get, | ||
354 | .update_status = bl_set_status, | ||
355 | }; | ||
356 | |||
357 | |||
358 | /* sysfs user interface functions */ | ||
359 | |||
360 | static ssize_t show_numbatt(struct device *dev, struct device_attribute *attr, | ||
361 | char *buf) | ||
362 | { | ||
363 | struct acpi_device *acpi = to_acpi_device(dev); | ||
364 | struct pcc_acpi *pcc = acpi_driver_data(acpi); | ||
365 | |||
366 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) | ||
367 | return -EIO; | ||
368 | |||
369 | return sprintf(buf, "%u\n", pcc->sinf[SINF_NUM_BATTERIES]); | ||
370 | } | ||
371 | |||
372 | static ssize_t show_lcdtype(struct device *dev, struct device_attribute *attr, | ||
373 | char *buf) | ||
374 | { | ||
375 | struct acpi_device *acpi = to_acpi_device(dev); | ||
376 | struct pcc_acpi *pcc = acpi_driver_data(acpi); | ||
377 | |||
378 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) | ||
379 | return -EIO; | ||
380 | |||
381 | return sprintf(buf, "%u\n", pcc->sinf[SINF_LCD_TYPE]); | ||
382 | } | ||
383 | |||
384 | static ssize_t show_mute(struct device *dev, struct device_attribute *attr, | ||
385 | char *buf) | ||
386 | { | ||
387 | struct acpi_device *acpi = to_acpi_device(dev); | ||
388 | struct pcc_acpi *pcc = acpi_driver_data(acpi); | ||
389 | |||
390 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) | ||
391 | return -EIO; | ||
392 | |||
393 | return sprintf(buf, "%u\n", pcc->sinf[SINF_MUTE]); | ||
394 | } | ||
395 | |||
396 | static ssize_t show_sticky(struct device *dev, struct device_attribute *attr, | ||
397 | char *buf) | ||
398 | { | ||
399 | struct acpi_device *acpi = to_acpi_device(dev); | ||
400 | struct pcc_acpi *pcc = acpi_driver_data(acpi); | ||
401 | |||
402 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) | ||
403 | return -EIO; | ||
404 | |||
405 | return sprintf(buf, "%u\n", pcc->sinf[SINF_STICKY_KEY]); | ||
406 | } | ||
407 | |||
408 | static ssize_t set_sticky(struct device *dev, struct device_attribute *attr, | ||
409 | const char *buf, size_t count) | ||
410 | { | ||
411 | struct acpi_device *acpi = to_acpi_device(dev); | ||
412 | struct pcc_acpi *pcc = acpi_driver_data(acpi); | ||
413 | int val; | ||
414 | |||
415 | if (count && sscanf(buf, "%i", &val) == 1 && | ||
416 | (val == 0 || val == 1)) { | ||
417 | acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, val); | ||
418 | pcc->sticky_mode = val; | ||
419 | } | ||
420 | |||
421 | return count; | ||
422 | } | ||
423 | |||
424 | static DEVICE_ATTR(numbatt, S_IRUGO, show_numbatt, NULL); | ||
425 | static DEVICE_ATTR(lcdtype, S_IRUGO, show_lcdtype, NULL); | ||
426 | static DEVICE_ATTR(mute, S_IRUGO, show_mute, NULL); | ||
427 | static DEVICE_ATTR(sticky_key, S_IRUGO | S_IWUSR, show_sticky, set_sticky); | ||
428 | |||
429 | static struct attribute *pcc_sysfs_entries[] = { | ||
430 | &dev_attr_numbatt.attr, | ||
431 | &dev_attr_lcdtype.attr, | ||
432 | &dev_attr_mute.attr, | ||
433 | &dev_attr_sticky_key.attr, | ||
434 | NULL, | ||
435 | }; | ||
436 | |||
437 | static struct attribute_group pcc_attr_group = { | ||
438 | .name = NULL, /* put in device directory */ | ||
439 | .attrs = pcc_sysfs_entries, | ||
440 | }; | ||
441 | |||
442 | |||
443 | /* hotkey input device driver */ | ||
444 | |||
445 | static int pcc_getkeycode(struct input_dev *dev, int scancode, int *keycode) | ||
446 | { | ||
447 | struct pcc_acpi *pcc = input_get_drvdata(dev); | ||
448 | |||
449 | if (scancode >= ARRAY_SIZE(pcc->keymap)) | ||
450 | return -EINVAL; | ||
451 | |||
452 | *keycode = pcc->keymap[scancode]; | ||
453 | |||
454 | return 0; | ||
455 | } | ||
456 | |||
457 | static int keymap_get_by_keycode(struct pcc_acpi *pcc, int keycode) | ||
458 | { | ||
459 | int i; | ||
460 | |||
461 | for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++) { | ||
462 | if (pcc->keymap[i] == keycode) | ||
463 | return i+1; | ||
464 | } | ||
465 | |||
466 | return 0; | ||
467 | } | ||
468 | |||
469 | static int pcc_setkeycode(struct input_dev *dev, int scancode, int keycode) | ||
470 | { | ||
471 | struct pcc_acpi *pcc = input_get_drvdata(dev); | ||
472 | int oldkeycode; | ||
473 | |||
474 | if (scancode >= ARRAY_SIZE(pcc->keymap)) | ||
475 | return -EINVAL; | ||
476 | |||
477 | if (keycode < 0 || keycode > KEY_MAX) | ||
478 | return -EINVAL; | ||
479 | |||
480 | oldkeycode = pcc->keymap[scancode]; | ||
481 | pcc->keymap[scancode] = keycode; | ||
482 | |||
483 | set_bit(keycode, dev->keybit); | ||
484 | |||
485 | if (!keymap_get_by_keycode(pcc, oldkeycode)) | ||
486 | clear_bit(oldkeycode, dev->keybit); | ||
487 | |||
488 | return 0; | ||
489 | } | ||
490 | |||
491 | static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc) | ||
492 | { | ||
493 | struct input_dev *hotk_input_dev = pcc->input_dev; | ||
494 | int rc; | ||
495 | int key_code, hkey_num; | ||
496 | unsigned long long result; | ||
497 | |||
498 | rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY, | ||
499 | NULL, &result); | ||
500 | if (!ACPI_SUCCESS(rc)) { | ||
501 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
502 | "error getting hotkey status\n")); | ||
503 | return; | ||
504 | } | ||
505 | |||
506 | acpi_bus_generate_proc_event(pcc->device, HKEY_NOTIFY, result); | ||
507 | |||
508 | hkey_num = result & 0xf; | ||
509 | |||
510 | if (hkey_num < 0 || hkey_num > ARRAY_SIZE(pcc->keymap)) { | ||
511 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
512 | "hotkey number out of range: %d\n", | ||
513 | hkey_num)); | ||
514 | return; | ||
515 | } | ||
516 | |||
517 | key_code = pcc->keymap[hkey_num]; | ||
518 | |||
519 | if (key_code != KEY_RESERVED) { | ||
520 | int pushed = (result & 0x80) ? TRUE : FALSE; | ||
521 | |||
522 | input_report_key(hotk_input_dev, key_code, pushed); | ||
523 | input_sync(hotk_input_dev); | ||
524 | } | ||
525 | |||
526 | return; | ||
527 | } | ||
528 | |||
529 | static void acpi_pcc_hotkey_notify(acpi_handle handle, u32 event, void *data) | ||
530 | { | ||
531 | struct pcc_acpi *pcc = (struct pcc_acpi *) data; | ||
532 | |||
533 | switch (event) { | ||
534 | case HKEY_NOTIFY: | ||
535 | acpi_pcc_generate_keyinput(pcc); | ||
536 | break; | ||
537 | default: | ||
538 | /* nothing to do */ | ||
539 | break; | ||
540 | } | ||
541 | } | ||
542 | |||
543 | static int acpi_pcc_init_input(struct pcc_acpi *pcc) | ||
544 | { | ||
545 | int i, rc; | ||
546 | |||
547 | pcc->input_dev = input_allocate_device(); | ||
548 | if (!pcc->input_dev) { | ||
549 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
550 | "Couldn't allocate input device for hotkey")); | ||
551 | return -ENOMEM; | ||
552 | } | ||
553 | |||
554 | pcc->input_dev->evbit[0] = BIT(EV_KEY); | ||
555 | |||
556 | pcc->input_dev->name = ACPI_PCC_DRIVER_NAME; | ||
557 | pcc->input_dev->phys = ACPI_PCC_INPUT_PHYS; | ||
558 | pcc->input_dev->id.bustype = BUS_HOST; | ||
559 | pcc->input_dev->id.vendor = 0x0001; | ||
560 | pcc->input_dev->id.product = 0x0001; | ||
561 | pcc->input_dev->id.version = 0x0100; | ||
562 | pcc->input_dev->getkeycode = pcc_getkeycode; | ||
563 | pcc->input_dev->setkeycode = pcc_setkeycode; | ||
564 | |||
565 | /* load initial keymap */ | ||
566 | memcpy(pcc->keymap, initial_keymap, sizeof(pcc->keymap)); | ||
567 | |||
568 | for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++) | ||
569 | __set_bit(pcc->keymap[i], pcc->input_dev->keybit); | ||
570 | __clear_bit(KEY_RESERVED, pcc->input_dev->keybit); | ||
571 | |||
572 | input_set_drvdata(pcc->input_dev, pcc); | ||
573 | |||
574 | rc = input_register_device(pcc->input_dev); | ||
575 | if (rc < 0) | ||
576 | input_free_device(pcc->input_dev); | ||
577 | |||
578 | return rc; | ||
579 | } | ||
580 | |||
581 | /* kernel module interface */ | ||
582 | |||
583 | static int acpi_pcc_hotkey_resume(struct acpi_device *device) | ||
584 | { | ||
585 | struct pcc_acpi *pcc = acpi_driver_data(device); | ||
586 | acpi_status status = AE_OK; | ||
587 | |||
588 | if (device == NULL || pcc == NULL) | ||
589 | return -EINVAL; | ||
590 | |||
591 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Sticky mode restore: %d\n", | ||
592 | pcc->sticky_mode)); | ||
593 | |||
594 | status = acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, pcc->sticky_mode); | ||
595 | |||
596 | return status == AE_OK ? 0 : -EINVAL; | ||
597 | } | ||
598 | |||
599 | static int acpi_pcc_hotkey_add(struct acpi_device *device) | ||
600 | { | ||
601 | acpi_status status; | ||
602 | struct pcc_acpi *pcc; | ||
603 | int num_sifr, result; | ||
604 | |||
605 | if (!device) | ||
606 | return -EINVAL; | ||
607 | |||
608 | num_sifr = acpi_pcc_get_sqty(device); | ||
609 | |||
610 | if (num_sifr > 255) { | ||
611 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "num_sifr too large")); | ||
612 | return -ENODEV; | ||
613 | } | ||
614 | |||
615 | pcc = kzalloc(sizeof(struct pcc_acpi), GFP_KERNEL); | ||
616 | if (!pcc) { | ||
617 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
618 | "Couldn't allocate mem for pcc")); | ||
619 | return -ENOMEM; | ||
620 | } | ||
621 | |||
622 | pcc->sinf = kzalloc(sizeof(u32) * (num_sifr + 1), GFP_KERNEL); | ||
623 | if (!pcc->sinf) { | ||
624 | result = -ENOMEM; | ||
625 | goto out_hotkey; | ||
626 | } | ||
627 | |||
628 | pcc->device = device; | ||
629 | pcc->handle = device->handle; | ||
630 | pcc->num_sifr = num_sifr; | ||
631 | device->driver_data = pcc; | ||
632 | strcpy(acpi_device_name(device), ACPI_PCC_DEVICE_NAME); | ||
633 | strcpy(acpi_device_class(device), ACPI_PCC_CLASS); | ||
634 | |||
635 | result = acpi_pcc_init_input(pcc); | ||
636 | if (result) { | ||
637 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
638 | "Error installing keyinput handler\n")); | ||
639 | goto out_sinf; | ||
640 | } | ||
641 | |||
642 | /* initialize hotkey input device */ | ||
643 | status = acpi_install_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY, | ||
644 | acpi_pcc_hotkey_notify, pcc); | ||
645 | |||
646 | if (ACPI_FAILURE(status)) { | ||
647 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
648 | "Error installing notify handler\n")); | ||
649 | result = -ENODEV; | ||
650 | goto out_input; | ||
651 | } | ||
652 | |||
653 | /* initialize backlight */ | ||
654 | pcc->backlight = backlight_device_register("panasonic", NULL, pcc, | ||
655 | &pcc_backlight_ops); | ||
656 | if (IS_ERR(pcc->backlight)) | ||
657 | goto out_notify; | ||
658 | |||
659 | if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) { | ||
660 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
661 | "Couldn't retrieve BIOS data\n")); | ||
662 | goto out_backlight; | ||
663 | } | ||
664 | |||
665 | /* read the initial brightness setting from the hardware */ | ||
666 | pcc->backlight->props.max_brightness = | ||
667 | pcc->sinf[SINF_AC_MAX_BRIGHT]; | ||
668 | pcc->backlight->props.brightness = pcc->sinf[SINF_AC_CUR_BRIGHT]; | ||
669 | |||
670 | /* read the initial sticky key mode from the hardware */ | ||
671 | pcc->sticky_mode = pcc->sinf[SINF_STICKY_KEY]; | ||
672 | |||
673 | /* add sysfs attributes */ | ||
674 | result = sysfs_create_group(&device->dev.kobj, &pcc_attr_group); | ||
675 | if (result) | ||
676 | goto out_backlight; | ||
677 | |||
678 | return 0; | ||
679 | |||
680 | out_backlight: | ||
681 | backlight_device_unregister(pcc->backlight); | ||
682 | out_notify: | ||
683 | acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY, | ||
684 | acpi_pcc_hotkey_notify); | ||
685 | out_input: | ||
686 | input_unregister_device(pcc->input_dev); | ||
687 | /* no need to input_free_device() since core input API refcount and | ||
688 | * free()s the device */ | ||
689 | out_sinf: | ||
690 | kfree(pcc->sinf); | ||
691 | out_hotkey: | ||
692 | kfree(pcc); | ||
693 | |||
694 | return result; | ||
695 | } | ||
696 | |||
697 | static int __init acpi_pcc_init(void) | ||
698 | { | ||
699 | int result = 0; | ||
700 | |||
701 | if (acpi_disabled) | ||
702 | return -ENODEV; | ||
703 | |||
704 | result = acpi_bus_register_driver(&acpi_pcc_driver); | ||
705 | if (result < 0) { | ||
706 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
707 | "Error registering hotkey driver\n")); | ||
708 | return -ENODEV; | ||
709 | } | ||
710 | |||
711 | return 0; | ||
712 | } | ||
713 | |||
714 | static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type) | ||
715 | { | ||
716 | struct pcc_acpi *pcc = acpi_driver_data(device); | ||
717 | |||
718 | if (!device || !pcc) | ||
719 | return -EINVAL; | ||
720 | |||
721 | sysfs_remove_group(&device->dev.kobj, &pcc_attr_group); | ||
722 | |||
723 | backlight_device_unregister(pcc->backlight); | ||
724 | |||
725 | acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY, | ||
726 | acpi_pcc_hotkey_notify); | ||
727 | |||
728 | input_unregister_device(pcc->input_dev); | ||
729 | /* no need to input_free_device() since core input API refcount and | ||
730 | * free()s the device */ | ||
731 | |||
732 | kfree(pcc->sinf); | ||
733 | kfree(pcc); | ||
734 | |||
735 | return 0; | ||
736 | } | ||
737 | |||
738 | static void __exit acpi_pcc_exit(void) | ||
739 | { | ||
740 | acpi_bus_unregister_driver(&acpi_pcc_driver); | ||
741 | } | ||
742 | |||
743 | module_init(acpi_pcc_init); | ||
744 | module_exit(acpi_pcc_exit); | ||
diff --git a/drivers/platform/x86/sony-laptop.c b/drivers/platform/x86/sony-laptop.c new file mode 100644 index 000000000000..537959d07148 --- /dev/null +++ b/drivers/platform/x86/sony-laptop.c | |||
@@ -0,0 +1,2784 @@ | |||
1 | /* | ||
2 | * ACPI Sony Notebook Control Driver (SNC and SPIC) | ||
3 | * | ||
4 | * Copyright (C) 2004-2005 Stelian Pop <stelian@popies.net> | ||
5 | * Copyright (C) 2007 Mattia Dongili <malattia@linux.it> | ||
6 | * | ||
7 | * Parts of this driver inspired from asus_acpi.c and ibm_acpi.c | ||
8 | * which are copyrighted by their respective authors. | ||
9 | * | ||
10 | * The SNY6001 driver part is based on the sonypi driver which includes | ||
11 | * material from: | ||
12 | * | ||
13 | * Copyright (C) 2001-2005 Stelian Pop <stelian@popies.net> | ||
14 | * | ||
15 | * Copyright (C) 2005 Narayanan R S <nars@kadamba.org> | ||
16 | * | ||
17 | * Copyright (C) 2001-2002 Alcôve <www.alcove.com> | ||
18 | * | ||
19 | * Copyright (C) 2001 Michael Ashley <m.ashley@unsw.edu.au> | ||
20 | * | ||
21 | * Copyright (C) 2001 Junichi Morita <jun1m@mars.dti.ne.jp> | ||
22 | * | ||
23 | * Copyright (C) 2000 Takaya Kinjo <t-kinjo@tc4.so-net.ne.jp> | ||
24 | * | ||
25 | * Copyright (C) 2000 Andrew Tridgell <tridge@valinux.com> | ||
26 | * | ||
27 | * Earlier work by Werner Almesberger, Paul `Rusty' Russell and Paul Mackerras. | ||
28 | * | ||
29 | * This program is free software; you can redistribute it and/or modify | ||
30 | * it under the terms of the GNU General Public License as published by | ||
31 | * the Free Software Foundation; either version 2 of the License, or | ||
32 | * (at your option) any later version. | ||
33 | * | ||
34 | * This program is distributed in the hope that it will be useful, | ||
35 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
36 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
37 | * GNU General Public License for more details. | ||
38 | * | ||
39 | * You should have received a copy of the GNU General Public License | ||
40 | * along with this program; if not, write to the Free Software | ||
41 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
42 | * | ||
43 | */ | ||
44 | |||
45 | #include <linux/kernel.h> | ||
46 | #include <linux/module.h> | ||
47 | #include <linux/moduleparam.h> | ||
48 | #include <linux/init.h> | ||
49 | #include <linux/smp_lock.h> | ||
50 | #include <linux/types.h> | ||
51 | #include <linux/backlight.h> | ||
52 | #include <linux/platform_device.h> | ||
53 | #include <linux/err.h> | ||
54 | #include <linux/dmi.h> | ||
55 | #include <linux/pci.h> | ||
56 | #include <linux/interrupt.h> | ||
57 | #include <linux/delay.h> | ||
58 | #include <linux/input.h> | ||
59 | #include <linux/kfifo.h> | ||
60 | #include <linux/workqueue.h> | ||
61 | #include <linux/acpi.h> | ||
62 | #include <acpi/acpi_drivers.h> | ||
63 | #include <acpi/acpi_bus.h> | ||
64 | #include <asm/uaccess.h> | ||
65 | #include <linux/sonypi.h> | ||
66 | #include <linux/sony-laptop.h> | ||
67 | #ifdef CONFIG_SONYPI_COMPAT | ||
68 | #include <linux/poll.h> | ||
69 | #include <linux/miscdevice.h> | ||
70 | #endif | ||
71 | |||
72 | #define DRV_PFX "sony-laptop: " | ||
73 | #define dprintk(msg...) do { \ | ||
74 | if (debug) printk(KERN_WARNING DRV_PFX msg); \ | ||
75 | } while (0) | ||
76 | |||
77 | #define SONY_LAPTOP_DRIVER_VERSION "0.6" | ||
78 | |||
79 | #define SONY_NC_CLASS "sony-nc" | ||
80 | #define SONY_NC_HID "SNY5001" | ||
81 | #define SONY_NC_DRIVER_NAME "Sony Notebook Control Driver" | ||
82 | |||
83 | #define SONY_PIC_CLASS "sony-pic" | ||
84 | #define SONY_PIC_HID "SNY6001" | ||
85 | #define SONY_PIC_DRIVER_NAME "Sony Programmable IO Control Driver" | ||
86 | |||
87 | MODULE_AUTHOR("Stelian Pop, Mattia Dongili"); | ||
88 | MODULE_DESCRIPTION("Sony laptop extras driver (SPIC and SNC ACPI device)"); | ||
89 | MODULE_LICENSE("GPL"); | ||
90 | MODULE_VERSION(SONY_LAPTOP_DRIVER_VERSION); | ||
91 | |||
92 | static int debug; | ||
93 | module_param(debug, int, 0); | ||
94 | MODULE_PARM_DESC(debug, "set this to 1 (and RTFM) if you want to help " | ||
95 | "the development of this driver"); | ||
96 | |||
97 | static int no_spic; /* = 0 */ | ||
98 | module_param(no_spic, int, 0444); | ||
99 | MODULE_PARM_DESC(no_spic, | ||
100 | "set this if you don't want to enable the SPIC device"); | ||
101 | |||
102 | static int compat; /* = 0 */ | ||
103 | module_param(compat, int, 0444); | ||
104 | MODULE_PARM_DESC(compat, | ||
105 | "set this if you want to enable backward compatibility mode"); | ||
106 | |||
107 | static unsigned long mask = 0xffffffff; | ||
108 | module_param(mask, ulong, 0644); | ||
109 | MODULE_PARM_DESC(mask, | ||
110 | "set this to the mask of event you want to enable (see doc)"); | ||
111 | |||
112 | static int camera; /* = 0 */ | ||
113 | module_param(camera, int, 0444); | ||
114 | MODULE_PARM_DESC(camera, | ||
115 | "set this to 1 to enable Motion Eye camera controls " | ||
116 | "(only use it if you have a C1VE or C1VN model)"); | ||
117 | |||
118 | #ifdef CONFIG_SONYPI_COMPAT | ||
119 | static int minor = -1; | ||
120 | module_param(minor, int, 0); | ||
121 | MODULE_PARM_DESC(minor, | ||
122 | "minor number of the misc device for the SPIC compatibility code, " | ||
123 | "default is -1 (automatic)"); | ||
124 | #endif | ||
125 | |||
126 | /*********** Input Devices ***********/ | ||
127 | |||
128 | #define SONY_LAPTOP_BUF_SIZE 128 | ||
129 | struct sony_laptop_input_s { | ||
130 | atomic_t users; | ||
131 | struct input_dev *jog_dev; | ||
132 | struct input_dev *key_dev; | ||
133 | struct kfifo *fifo; | ||
134 | spinlock_t fifo_lock; | ||
135 | struct workqueue_struct *wq; | ||
136 | }; | ||
137 | static struct sony_laptop_input_s sony_laptop_input = { | ||
138 | .users = ATOMIC_INIT(0), | ||
139 | }; | ||
140 | |||
141 | struct sony_laptop_keypress { | ||
142 | struct input_dev *dev; | ||
143 | int key; | ||
144 | }; | ||
145 | |||
146 | /* Correspondance table between sonypi events | ||
147 | * and input layer indexes in the keymap | ||
148 | */ | ||
149 | static int sony_laptop_input_index[] = { | ||
150 | -1, /* 0 no event */ | ||
151 | -1, /* 1 SONYPI_EVENT_JOGDIAL_DOWN */ | ||
152 | -1, /* 2 SONYPI_EVENT_JOGDIAL_UP */ | ||
153 | -1, /* 3 SONYPI_EVENT_JOGDIAL_DOWN_PRESSED */ | ||
154 | -1, /* 4 SONYPI_EVENT_JOGDIAL_UP_PRESSED */ | ||
155 | -1, /* 5 SONYPI_EVENT_JOGDIAL_PRESSED */ | ||
156 | -1, /* 6 SONYPI_EVENT_JOGDIAL_RELEASED */ | ||
157 | 0, /* 7 SONYPI_EVENT_CAPTURE_PRESSED */ | ||
158 | 1, /* 8 SONYPI_EVENT_CAPTURE_RELEASED */ | ||
159 | 2, /* 9 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */ | ||
160 | 3, /* 10 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */ | ||
161 | 4, /* 11 SONYPI_EVENT_FNKEY_ESC */ | ||
162 | 5, /* 12 SONYPI_EVENT_FNKEY_F1 */ | ||
163 | 6, /* 13 SONYPI_EVENT_FNKEY_F2 */ | ||
164 | 7, /* 14 SONYPI_EVENT_FNKEY_F3 */ | ||
165 | 8, /* 15 SONYPI_EVENT_FNKEY_F4 */ | ||
166 | 9, /* 16 SONYPI_EVENT_FNKEY_F5 */ | ||
167 | 10, /* 17 SONYPI_EVENT_FNKEY_F6 */ | ||
168 | 11, /* 18 SONYPI_EVENT_FNKEY_F7 */ | ||
169 | 12, /* 19 SONYPI_EVENT_FNKEY_F8 */ | ||
170 | 13, /* 20 SONYPI_EVENT_FNKEY_F9 */ | ||
171 | 14, /* 21 SONYPI_EVENT_FNKEY_F10 */ | ||
172 | 15, /* 22 SONYPI_EVENT_FNKEY_F11 */ | ||
173 | 16, /* 23 SONYPI_EVENT_FNKEY_F12 */ | ||
174 | 17, /* 24 SONYPI_EVENT_FNKEY_1 */ | ||
175 | 18, /* 25 SONYPI_EVENT_FNKEY_2 */ | ||
176 | 19, /* 26 SONYPI_EVENT_FNKEY_D */ | ||
177 | 20, /* 27 SONYPI_EVENT_FNKEY_E */ | ||
178 | 21, /* 28 SONYPI_EVENT_FNKEY_F */ | ||
179 | 22, /* 29 SONYPI_EVENT_FNKEY_S */ | ||
180 | 23, /* 30 SONYPI_EVENT_FNKEY_B */ | ||
181 | 24, /* 31 SONYPI_EVENT_BLUETOOTH_PRESSED */ | ||
182 | 25, /* 32 SONYPI_EVENT_PKEY_P1 */ | ||
183 | 26, /* 33 SONYPI_EVENT_PKEY_P2 */ | ||
184 | 27, /* 34 SONYPI_EVENT_PKEY_P3 */ | ||
185 | 28, /* 35 SONYPI_EVENT_BACK_PRESSED */ | ||
186 | -1, /* 36 SONYPI_EVENT_LID_CLOSED */ | ||
187 | -1, /* 37 SONYPI_EVENT_LID_OPENED */ | ||
188 | 29, /* 38 SONYPI_EVENT_BLUETOOTH_ON */ | ||
189 | 30, /* 39 SONYPI_EVENT_BLUETOOTH_OFF */ | ||
190 | 31, /* 40 SONYPI_EVENT_HELP_PRESSED */ | ||
191 | 32, /* 41 SONYPI_EVENT_FNKEY_ONLY */ | ||
192 | 33, /* 42 SONYPI_EVENT_JOGDIAL_FAST_DOWN */ | ||
193 | 34, /* 43 SONYPI_EVENT_JOGDIAL_FAST_UP */ | ||
194 | 35, /* 44 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */ | ||
195 | 36, /* 45 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */ | ||
196 | 37, /* 46 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */ | ||
197 | 38, /* 47 SONYPI_EVENT_JOGDIAL_VFAST_UP */ | ||
198 | 39, /* 48 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */ | ||
199 | 40, /* 49 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */ | ||
200 | 41, /* 50 SONYPI_EVENT_ZOOM_PRESSED */ | ||
201 | 42, /* 51 SONYPI_EVENT_THUMBPHRASE_PRESSED */ | ||
202 | 43, /* 52 SONYPI_EVENT_MEYE_FACE */ | ||
203 | 44, /* 53 SONYPI_EVENT_MEYE_OPPOSITE */ | ||
204 | 45, /* 54 SONYPI_EVENT_MEMORYSTICK_INSERT */ | ||
205 | 46, /* 55 SONYPI_EVENT_MEMORYSTICK_EJECT */ | ||
206 | -1, /* 56 SONYPI_EVENT_ANYBUTTON_RELEASED */ | ||
207 | -1, /* 57 SONYPI_EVENT_BATTERY_INSERT */ | ||
208 | -1, /* 58 SONYPI_EVENT_BATTERY_REMOVE */ | ||
209 | -1, /* 59 SONYPI_EVENT_FNKEY_RELEASED */ | ||
210 | 47, /* 60 SONYPI_EVENT_WIRELESS_ON */ | ||
211 | 48, /* 61 SONYPI_EVENT_WIRELESS_OFF */ | ||
212 | 49, /* 62 SONYPI_EVENT_ZOOM_IN_PRESSED */ | ||
213 | 50, /* 63 SONYPI_EVENT_ZOOM_OUT_PRESSED */ | ||
214 | }; | ||
215 | |||
216 | static int sony_laptop_input_keycode_map[] = { | ||
217 | KEY_CAMERA, /* 0 SONYPI_EVENT_CAPTURE_PRESSED */ | ||
218 | KEY_RESERVED, /* 1 SONYPI_EVENT_CAPTURE_RELEASED */ | ||
219 | KEY_RESERVED, /* 2 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */ | ||
220 | KEY_RESERVED, /* 3 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */ | ||
221 | KEY_FN_ESC, /* 4 SONYPI_EVENT_FNKEY_ESC */ | ||
222 | KEY_FN_F1, /* 5 SONYPI_EVENT_FNKEY_F1 */ | ||
223 | KEY_FN_F2, /* 6 SONYPI_EVENT_FNKEY_F2 */ | ||
224 | KEY_FN_F3, /* 7 SONYPI_EVENT_FNKEY_F3 */ | ||
225 | KEY_FN_F4, /* 8 SONYPI_EVENT_FNKEY_F4 */ | ||
226 | KEY_FN_F5, /* 9 SONYPI_EVENT_FNKEY_F5 */ | ||
227 | KEY_FN_F6, /* 10 SONYPI_EVENT_FNKEY_F6 */ | ||
228 | KEY_FN_F7, /* 11 SONYPI_EVENT_FNKEY_F7 */ | ||
229 | KEY_FN_F8, /* 12 SONYPI_EVENT_FNKEY_F8 */ | ||
230 | KEY_FN_F9, /* 13 SONYPI_EVENT_FNKEY_F9 */ | ||
231 | KEY_FN_F10, /* 14 SONYPI_EVENT_FNKEY_F10 */ | ||
232 | KEY_FN_F11, /* 15 SONYPI_EVENT_FNKEY_F11 */ | ||
233 | KEY_FN_F12, /* 16 SONYPI_EVENT_FNKEY_F12 */ | ||
234 | KEY_FN_F1, /* 17 SONYPI_EVENT_FNKEY_1 */ | ||
235 | KEY_FN_F2, /* 18 SONYPI_EVENT_FNKEY_2 */ | ||
236 | KEY_FN_D, /* 19 SONYPI_EVENT_FNKEY_D */ | ||
237 | KEY_FN_E, /* 20 SONYPI_EVENT_FNKEY_E */ | ||
238 | KEY_FN_F, /* 21 SONYPI_EVENT_FNKEY_F */ | ||
239 | KEY_FN_S, /* 22 SONYPI_EVENT_FNKEY_S */ | ||
240 | KEY_FN_B, /* 23 SONYPI_EVENT_FNKEY_B */ | ||
241 | KEY_BLUETOOTH, /* 24 SONYPI_EVENT_BLUETOOTH_PRESSED */ | ||
242 | KEY_PROG1, /* 25 SONYPI_EVENT_PKEY_P1 */ | ||
243 | KEY_PROG2, /* 26 SONYPI_EVENT_PKEY_P2 */ | ||
244 | KEY_PROG3, /* 27 SONYPI_EVENT_PKEY_P3 */ | ||
245 | KEY_BACK, /* 28 SONYPI_EVENT_BACK_PRESSED */ | ||
246 | KEY_BLUETOOTH, /* 29 SONYPI_EVENT_BLUETOOTH_ON */ | ||
247 | KEY_BLUETOOTH, /* 30 SONYPI_EVENT_BLUETOOTH_OFF */ | ||
248 | KEY_HELP, /* 31 SONYPI_EVENT_HELP_PRESSED */ | ||
249 | KEY_FN, /* 32 SONYPI_EVENT_FNKEY_ONLY */ | ||
250 | KEY_RESERVED, /* 33 SONYPI_EVENT_JOGDIAL_FAST_DOWN */ | ||
251 | KEY_RESERVED, /* 34 SONYPI_EVENT_JOGDIAL_FAST_UP */ | ||
252 | KEY_RESERVED, /* 35 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */ | ||
253 | KEY_RESERVED, /* 36 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */ | ||
254 | KEY_RESERVED, /* 37 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */ | ||
255 | KEY_RESERVED, /* 38 SONYPI_EVENT_JOGDIAL_VFAST_UP */ | ||
256 | KEY_RESERVED, /* 39 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */ | ||
257 | KEY_RESERVED, /* 40 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */ | ||
258 | KEY_ZOOM, /* 41 SONYPI_EVENT_ZOOM_PRESSED */ | ||
259 | BTN_THUMB, /* 42 SONYPI_EVENT_THUMBPHRASE_PRESSED */ | ||
260 | KEY_RESERVED, /* 43 SONYPI_EVENT_MEYE_FACE */ | ||
261 | KEY_RESERVED, /* 44 SONYPI_EVENT_MEYE_OPPOSITE */ | ||
262 | KEY_RESERVED, /* 45 SONYPI_EVENT_MEMORYSTICK_INSERT */ | ||
263 | KEY_RESERVED, /* 46 SONYPI_EVENT_MEMORYSTICK_EJECT */ | ||
264 | KEY_WLAN, /* 47 SONYPI_EVENT_WIRELESS_ON */ | ||
265 | KEY_WLAN, /* 48 SONYPI_EVENT_WIRELESS_OFF */ | ||
266 | KEY_ZOOMIN, /* 49 SONYPI_EVENT_ZOOM_IN_PRESSED */ | ||
267 | KEY_ZOOMOUT /* 50 SONYPI_EVENT_ZOOM_OUT_PRESSED */ | ||
268 | }; | ||
269 | |||
270 | /* release buttons after a short delay if pressed */ | ||
271 | static void do_sony_laptop_release_key(struct work_struct *work) | ||
272 | { | ||
273 | struct sony_laptop_keypress kp; | ||
274 | |||
275 | while (kfifo_get(sony_laptop_input.fifo, (unsigned char *)&kp, | ||
276 | sizeof(kp)) == sizeof(kp)) { | ||
277 | msleep(10); | ||
278 | input_report_key(kp.dev, kp.key, 0); | ||
279 | input_sync(kp.dev); | ||
280 | } | ||
281 | } | ||
282 | static DECLARE_WORK(sony_laptop_release_key_work, | ||
283 | do_sony_laptop_release_key); | ||
284 | |||
285 | /* forward event to the input subsystem */ | ||
286 | static void sony_laptop_report_input_event(u8 event) | ||
287 | { | ||
288 | struct input_dev *jog_dev = sony_laptop_input.jog_dev; | ||
289 | struct input_dev *key_dev = sony_laptop_input.key_dev; | ||
290 | struct sony_laptop_keypress kp = { NULL }; | ||
291 | |||
292 | if (event == SONYPI_EVENT_FNKEY_RELEASED) { | ||
293 | /* Nothing, not all VAIOs generate this event */ | ||
294 | return; | ||
295 | } | ||
296 | |||
297 | /* report events */ | ||
298 | switch (event) { | ||
299 | /* jog_dev events */ | ||
300 | case SONYPI_EVENT_JOGDIAL_UP: | ||
301 | case SONYPI_EVENT_JOGDIAL_UP_PRESSED: | ||
302 | input_report_rel(jog_dev, REL_WHEEL, 1); | ||
303 | input_sync(jog_dev); | ||
304 | return; | ||
305 | |||
306 | case SONYPI_EVENT_JOGDIAL_DOWN: | ||
307 | case SONYPI_EVENT_JOGDIAL_DOWN_PRESSED: | ||
308 | input_report_rel(jog_dev, REL_WHEEL, -1); | ||
309 | input_sync(jog_dev); | ||
310 | return; | ||
311 | |||
312 | /* key_dev events */ | ||
313 | case SONYPI_EVENT_JOGDIAL_PRESSED: | ||
314 | kp.key = BTN_MIDDLE; | ||
315 | kp.dev = jog_dev; | ||
316 | break; | ||
317 | |||
318 | default: | ||
319 | if (event >= ARRAY_SIZE(sony_laptop_input_index)) { | ||
320 | dprintk("sony_laptop_report_input_event, event not known: %d\n", event); | ||
321 | break; | ||
322 | } | ||
323 | if (sony_laptop_input_index[event] != -1) { | ||
324 | kp.key = sony_laptop_input_keycode_map[sony_laptop_input_index[event]]; | ||
325 | if (kp.key != KEY_UNKNOWN) | ||
326 | kp.dev = key_dev; | ||
327 | } | ||
328 | break; | ||
329 | } | ||
330 | |||
331 | if (kp.dev) { | ||
332 | input_report_key(kp.dev, kp.key, 1); | ||
333 | /* we emit the scancode so we can always remap the key */ | ||
334 | input_event(kp.dev, EV_MSC, MSC_SCAN, event); | ||
335 | input_sync(kp.dev); | ||
336 | kfifo_put(sony_laptop_input.fifo, | ||
337 | (unsigned char *)&kp, sizeof(kp)); | ||
338 | |||
339 | if (!work_pending(&sony_laptop_release_key_work)) | ||
340 | queue_work(sony_laptop_input.wq, | ||
341 | &sony_laptop_release_key_work); | ||
342 | } else | ||
343 | dprintk("unknown input event %.2x\n", event); | ||
344 | } | ||
345 | |||
346 | static int sony_laptop_setup_input(struct acpi_device *acpi_device) | ||
347 | { | ||
348 | struct input_dev *jog_dev; | ||
349 | struct input_dev *key_dev; | ||
350 | int i; | ||
351 | int error; | ||
352 | |||
353 | /* don't run again if already initialized */ | ||
354 | if (atomic_add_return(1, &sony_laptop_input.users) > 1) | ||
355 | return 0; | ||
356 | |||
357 | /* kfifo */ | ||
358 | spin_lock_init(&sony_laptop_input.fifo_lock); | ||
359 | sony_laptop_input.fifo = | ||
360 | kfifo_alloc(SONY_LAPTOP_BUF_SIZE, GFP_KERNEL, | ||
361 | &sony_laptop_input.fifo_lock); | ||
362 | if (IS_ERR(sony_laptop_input.fifo)) { | ||
363 | printk(KERN_ERR DRV_PFX "kfifo_alloc failed\n"); | ||
364 | error = PTR_ERR(sony_laptop_input.fifo); | ||
365 | goto err_dec_users; | ||
366 | } | ||
367 | |||
368 | /* init workqueue */ | ||
369 | sony_laptop_input.wq = create_singlethread_workqueue("sony-laptop"); | ||
370 | if (!sony_laptop_input.wq) { | ||
371 | printk(KERN_ERR DRV_PFX | ||
372 | "Unabe to create workqueue.\n"); | ||
373 | error = -ENXIO; | ||
374 | goto err_free_kfifo; | ||
375 | } | ||
376 | |||
377 | /* input keys */ | ||
378 | key_dev = input_allocate_device(); | ||
379 | if (!key_dev) { | ||
380 | error = -ENOMEM; | ||
381 | goto err_destroy_wq; | ||
382 | } | ||
383 | |||
384 | key_dev->name = "Sony Vaio Keys"; | ||
385 | key_dev->id.bustype = BUS_ISA; | ||
386 | key_dev->id.vendor = PCI_VENDOR_ID_SONY; | ||
387 | key_dev->dev.parent = &acpi_device->dev; | ||
388 | |||
389 | /* Initialize the Input Drivers: special keys */ | ||
390 | set_bit(EV_KEY, key_dev->evbit); | ||
391 | set_bit(EV_MSC, key_dev->evbit); | ||
392 | set_bit(MSC_SCAN, key_dev->mscbit); | ||
393 | key_dev->keycodesize = sizeof(sony_laptop_input_keycode_map[0]); | ||
394 | key_dev->keycodemax = ARRAY_SIZE(sony_laptop_input_keycode_map); | ||
395 | key_dev->keycode = &sony_laptop_input_keycode_map; | ||
396 | for (i = 0; i < ARRAY_SIZE(sony_laptop_input_keycode_map); i++) { | ||
397 | if (sony_laptop_input_keycode_map[i] != KEY_RESERVED) { | ||
398 | set_bit(sony_laptop_input_keycode_map[i], | ||
399 | key_dev->keybit); | ||
400 | } | ||
401 | } | ||
402 | |||
403 | error = input_register_device(key_dev); | ||
404 | if (error) | ||
405 | goto err_free_keydev; | ||
406 | |||
407 | sony_laptop_input.key_dev = key_dev; | ||
408 | |||
409 | /* jogdial */ | ||
410 | jog_dev = input_allocate_device(); | ||
411 | if (!jog_dev) { | ||
412 | error = -ENOMEM; | ||
413 | goto err_unregister_keydev; | ||
414 | } | ||
415 | |||
416 | jog_dev->name = "Sony Vaio Jogdial"; | ||
417 | jog_dev->id.bustype = BUS_ISA; | ||
418 | jog_dev->id.vendor = PCI_VENDOR_ID_SONY; | ||
419 | key_dev->dev.parent = &acpi_device->dev; | ||
420 | |||
421 | jog_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL); | ||
422 | jog_dev->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_MIDDLE); | ||
423 | jog_dev->relbit[0] = BIT_MASK(REL_WHEEL); | ||
424 | |||
425 | error = input_register_device(jog_dev); | ||
426 | if (error) | ||
427 | goto err_free_jogdev; | ||
428 | |||
429 | sony_laptop_input.jog_dev = jog_dev; | ||
430 | |||
431 | return 0; | ||
432 | |||
433 | err_free_jogdev: | ||
434 | input_free_device(jog_dev); | ||
435 | |||
436 | err_unregister_keydev: | ||
437 | input_unregister_device(key_dev); | ||
438 | /* to avoid kref underflow below at input_free_device */ | ||
439 | key_dev = NULL; | ||
440 | |||
441 | err_free_keydev: | ||
442 | input_free_device(key_dev); | ||
443 | |||
444 | err_destroy_wq: | ||
445 | destroy_workqueue(sony_laptop_input.wq); | ||
446 | |||
447 | err_free_kfifo: | ||
448 | kfifo_free(sony_laptop_input.fifo); | ||
449 | |||
450 | err_dec_users: | ||
451 | atomic_dec(&sony_laptop_input.users); | ||
452 | return error; | ||
453 | } | ||
454 | |||
455 | static void sony_laptop_remove_input(void) | ||
456 | { | ||
457 | /* cleanup only after the last user has gone */ | ||
458 | if (!atomic_dec_and_test(&sony_laptop_input.users)) | ||
459 | return; | ||
460 | |||
461 | /* flush workqueue first */ | ||
462 | flush_workqueue(sony_laptop_input.wq); | ||
463 | |||
464 | /* destroy input devs */ | ||
465 | input_unregister_device(sony_laptop_input.key_dev); | ||
466 | sony_laptop_input.key_dev = NULL; | ||
467 | |||
468 | if (sony_laptop_input.jog_dev) { | ||
469 | input_unregister_device(sony_laptop_input.jog_dev); | ||
470 | sony_laptop_input.jog_dev = NULL; | ||
471 | } | ||
472 | |||
473 | destroy_workqueue(sony_laptop_input.wq); | ||
474 | kfifo_free(sony_laptop_input.fifo); | ||
475 | } | ||
476 | |||
477 | /*********** Platform Device ***********/ | ||
478 | |||
479 | static atomic_t sony_pf_users = ATOMIC_INIT(0); | ||
480 | static struct platform_driver sony_pf_driver = { | ||
481 | .driver = { | ||
482 | .name = "sony-laptop", | ||
483 | .owner = THIS_MODULE, | ||
484 | } | ||
485 | }; | ||
486 | static struct platform_device *sony_pf_device; | ||
487 | |||
488 | static int sony_pf_add(void) | ||
489 | { | ||
490 | int ret = 0; | ||
491 | |||
492 | /* don't run again if already initialized */ | ||
493 | if (atomic_add_return(1, &sony_pf_users) > 1) | ||
494 | return 0; | ||
495 | |||
496 | ret = platform_driver_register(&sony_pf_driver); | ||
497 | if (ret) | ||
498 | goto out; | ||
499 | |||
500 | sony_pf_device = platform_device_alloc("sony-laptop", -1); | ||
501 | if (!sony_pf_device) { | ||
502 | ret = -ENOMEM; | ||
503 | goto out_platform_registered; | ||
504 | } | ||
505 | |||
506 | ret = platform_device_add(sony_pf_device); | ||
507 | if (ret) | ||
508 | goto out_platform_alloced; | ||
509 | |||
510 | return 0; | ||
511 | |||
512 | out_platform_alloced: | ||
513 | platform_device_put(sony_pf_device); | ||
514 | sony_pf_device = NULL; | ||
515 | out_platform_registered: | ||
516 | platform_driver_unregister(&sony_pf_driver); | ||
517 | out: | ||
518 | atomic_dec(&sony_pf_users); | ||
519 | return ret; | ||
520 | } | ||
521 | |||
522 | static void sony_pf_remove(void) | ||
523 | { | ||
524 | /* deregister only after the last user has gone */ | ||
525 | if (!atomic_dec_and_test(&sony_pf_users)) | ||
526 | return; | ||
527 | |||
528 | platform_device_del(sony_pf_device); | ||
529 | platform_device_put(sony_pf_device); | ||
530 | platform_driver_unregister(&sony_pf_driver); | ||
531 | } | ||
532 | |||
533 | /*********** SNC (SNY5001) Device ***********/ | ||
534 | |||
535 | /* the device uses 1-based values, while the backlight subsystem uses | ||
536 | 0-based values */ | ||
537 | #define SONY_MAX_BRIGHTNESS 8 | ||
538 | |||
539 | #define SNC_VALIDATE_IN 0 | ||
540 | #define SNC_VALIDATE_OUT 1 | ||
541 | |||
542 | static ssize_t sony_nc_sysfs_show(struct device *, struct device_attribute *, | ||
543 | char *); | ||
544 | static ssize_t sony_nc_sysfs_store(struct device *, struct device_attribute *, | ||
545 | const char *, size_t); | ||
546 | static int boolean_validate(const int, const int); | ||
547 | static int brightness_default_validate(const int, const int); | ||
548 | |||
549 | struct sony_nc_value { | ||
550 | char *name; /* name of the entry */ | ||
551 | char **acpiget; /* names of the ACPI get function */ | ||
552 | char **acpiset; /* names of the ACPI set function */ | ||
553 | int (*validate)(const int, const int); /* input/output validation */ | ||
554 | int value; /* current setting */ | ||
555 | int valid; /* Has ever been set */ | ||
556 | int debug; /* active only in debug mode ? */ | ||
557 | struct device_attribute devattr; /* sysfs atribute */ | ||
558 | }; | ||
559 | |||
560 | #define SNC_HANDLE_NAMES(_name, _values...) \ | ||
561 | static char *snc_##_name[] = { _values, NULL } | ||
562 | |||
563 | #define SNC_HANDLE(_name, _getters, _setters, _validate, _debug) \ | ||
564 | { \ | ||
565 | .name = __stringify(_name), \ | ||
566 | .acpiget = _getters, \ | ||
567 | .acpiset = _setters, \ | ||
568 | .validate = _validate, \ | ||
569 | .debug = _debug, \ | ||
570 | .devattr = __ATTR(_name, 0, sony_nc_sysfs_show, sony_nc_sysfs_store), \ | ||
571 | } | ||
572 | |||
573 | #define SNC_HANDLE_NULL { .name = NULL } | ||
574 | |||
575 | SNC_HANDLE_NAMES(fnkey_get, "GHKE"); | ||
576 | |||
577 | SNC_HANDLE_NAMES(brightness_def_get, "GPBR"); | ||
578 | SNC_HANDLE_NAMES(brightness_def_set, "SPBR"); | ||
579 | |||
580 | SNC_HANDLE_NAMES(cdpower_get, "GCDP"); | ||
581 | SNC_HANDLE_NAMES(cdpower_set, "SCDP", "CDPW"); | ||
582 | |||
583 | SNC_HANDLE_NAMES(audiopower_get, "GAZP"); | ||
584 | SNC_HANDLE_NAMES(audiopower_set, "AZPW"); | ||
585 | |||
586 | SNC_HANDLE_NAMES(lanpower_get, "GLNP"); | ||
587 | SNC_HANDLE_NAMES(lanpower_set, "LNPW"); | ||
588 | |||
589 | SNC_HANDLE_NAMES(lidstate_get, "GLID"); | ||
590 | |||
591 | SNC_HANDLE_NAMES(indicatorlamp_get, "GILS"); | ||
592 | SNC_HANDLE_NAMES(indicatorlamp_set, "SILS"); | ||
593 | |||
594 | SNC_HANDLE_NAMES(gainbass_get, "GMGB"); | ||
595 | SNC_HANDLE_NAMES(gainbass_set, "CMGB"); | ||
596 | |||
597 | SNC_HANDLE_NAMES(PID_get, "GPID"); | ||
598 | |||
599 | SNC_HANDLE_NAMES(CTR_get, "GCTR"); | ||
600 | SNC_HANDLE_NAMES(CTR_set, "SCTR"); | ||
601 | |||
602 | SNC_HANDLE_NAMES(PCR_get, "GPCR"); | ||
603 | SNC_HANDLE_NAMES(PCR_set, "SPCR"); | ||
604 | |||
605 | SNC_HANDLE_NAMES(CMI_get, "GCMI"); | ||
606 | SNC_HANDLE_NAMES(CMI_set, "SCMI"); | ||
607 | |||
608 | static struct sony_nc_value sony_nc_values[] = { | ||
609 | SNC_HANDLE(brightness_default, snc_brightness_def_get, | ||
610 | snc_brightness_def_set, brightness_default_validate, 0), | ||
611 | SNC_HANDLE(fnkey, snc_fnkey_get, NULL, NULL, 0), | ||
612 | SNC_HANDLE(cdpower, snc_cdpower_get, snc_cdpower_set, boolean_validate, 0), | ||
613 | SNC_HANDLE(audiopower, snc_audiopower_get, snc_audiopower_set, | ||
614 | boolean_validate, 0), | ||
615 | SNC_HANDLE(lanpower, snc_lanpower_get, snc_lanpower_set, | ||
616 | boolean_validate, 1), | ||
617 | SNC_HANDLE(lidstate, snc_lidstate_get, NULL, | ||
618 | boolean_validate, 0), | ||
619 | SNC_HANDLE(indicatorlamp, snc_indicatorlamp_get, snc_indicatorlamp_set, | ||
620 | boolean_validate, 0), | ||
621 | SNC_HANDLE(gainbass, snc_gainbass_get, snc_gainbass_set, | ||
622 | boolean_validate, 0), | ||
623 | /* unknown methods */ | ||
624 | SNC_HANDLE(PID, snc_PID_get, NULL, NULL, 1), | ||
625 | SNC_HANDLE(CTR, snc_CTR_get, snc_CTR_set, NULL, 1), | ||
626 | SNC_HANDLE(PCR, snc_PCR_get, snc_PCR_set, NULL, 1), | ||
627 | SNC_HANDLE(CMI, snc_CMI_get, snc_CMI_set, NULL, 1), | ||
628 | SNC_HANDLE_NULL | ||
629 | }; | ||
630 | |||
631 | static acpi_handle sony_nc_acpi_handle; | ||
632 | static struct acpi_device *sony_nc_acpi_device = NULL; | ||
633 | |||
634 | /* | ||
635 | * acpi_evaluate_object wrappers | ||
636 | */ | ||
637 | static int acpi_callgetfunc(acpi_handle handle, char *name, int *result) | ||
638 | { | ||
639 | struct acpi_buffer output; | ||
640 | union acpi_object out_obj; | ||
641 | acpi_status status; | ||
642 | |||
643 | output.length = sizeof(out_obj); | ||
644 | output.pointer = &out_obj; | ||
645 | |||
646 | status = acpi_evaluate_object(handle, name, NULL, &output); | ||
647 | if ((status == AE_OK) && (out_obj.type == ACPI_TYPE_INTEGER)) { | ||
648 | *result = out_obj.integer.value; | ||
649 | return 0; | ||
650 | } | ||
651 | |||
652 | printk(KERN_WARNING DRV_PFX "acpi_callreadfunc failed\n"); | ||
653 | |||
654 | return -1; | ||
655 | } | ||
656 | |||
657 | static int acpi_callsetfunc(acpi_handle handle, char *name, int value, | ||
658 | int *result) | ||
659 | { | ||
660 | struct acpi_object_list params; | ||
661 | union acpi_object in_obj; | ||
662 | struct acpi_buffer output; | ||
663 | union acpi_object out_obj; | ||
664 | acpi_status status; | ||
665 | |||
666 | params.count = 1; | ||
667 | params.pointer = &in_obj; | ||
668 | in_obj.type = ACPI_TYPE_INTEGER; | ||
669 | in_obj.integer.value = value; | ||
670 | |||
671 | output.length = sizeof(out_obj); | ||
672 | output.pointer = &out_obj; | ||
673 | |||
674 | status = acpi_evaluate_object(handle, name, ¶ms, &output); | ||
675 | if (status == AE_OK) { | ||
676 | if (result != NULL) { | ||
677 | if (out_obj.type != ACPI_TYPE_INTEGER) { | ||
678 | printk(KERN_WARNING DRV_PFX "acpi_evaluate_object bad " | ||
679 | "return type\n"); | ||
680 | return -1; | ||
681 | } | ||
682 | *result = out_obj.integer.value; | ||
683 | } | ||
684 | return 0; | ||
685 | } | ||
686 | |||
687 | printk(KERN_WARNING DRV_PFX "acpi_evaluate_object failed\n"); | ||
688 | |||
689 | return -1; | ||
690 | } | ||
691 | |||
692 | /* | ||
693 | * sony_nc_values input/output validate functions | ||
694 | */ | ||
695 | |||
696 | /* brightness_default_validate: | ||
697 | * | ||
698 | * manipulate input output values to keep consistency with the | ||
699 | * backlight framework for which brightness values are 0-based. | ||
700 | */ | ||
701 | static int brightness_default_validate(const int direction, const int value) | ||
702 | { | ||
703 | switch (direction) { | ||
704 | case SNC_VALIDATE_OUT: | ||
705 | return value - 1; | ||
706 | case SNC_VALIDATE_IN: | ||
707 | if (value >= 0 && value < SONY_MAX_BRIGHTNESS) | ||
708 | return value + 1; | ||
709 | } | ||
710 | return -EINVAL; | ||
711 | } | ||
712 | |||
713 | /* boolean_validate: | ||
714 | * | ||
715 | * on input validate boolean values 0/1, on output just pass the | ||
716 | * received value. | ||
717 | */ | ||
718 | static int boolean_validate(const int direction, const int value) | ||
719 | { | ||
720 | if (direction == SNC_VALIDATE_IN) { | ||
721 | if (value != 0 && value != 1) | ||
722 | return -EINVAL; | ||
723 | } | ||
724 | return value; | ||
725 | } | ||
726 | |||
727 | /* | ||
728 | * Sysfs show/store common to all sony_nc_values | ||
729 | */ | ||
730 | static ssize_t sony_nc_sysfs_show(struct device *dev, struct device_attribute *attr, | ||
731 | char *buffer) | ||
732 | { | ||
733 | int value; | ||
734 | struct sony_nc_value *item = | ||
735 | container_of(attr, struct sony_nc_value, devattr); | ||
736 | |||
737 | if (!*item->acpiget) | ||
738 | return -EIO; | ||
739 | |||
740 | if (acpi_callgetfunc(sony_nc_acpi_handle, *item->acpiget, &value) < 0) | ||
741 | return -EIO; | ||
742 | |||
743 | if (item->validate) | ||
744 | value = item->validate(SNC_VALIDATE_OUT, value); | ||
745 | |||
746 | return snprintf(buffer, PAGE_SIZE, "%d\n", value); | ||
747 | } | ||
748 | |||
749 | static ssize_t sony_nc_sysfs_store(struct device *dev, | ||
750 | struct device_attribute *attr, | ||
751 | const char *buffer, size_t count) | ||
752 | { | ||
753 | int value; | ||
754 | struct sony_nc_value *item = | ||
755 | container_of(attr, struct sony_nc_value, devattr); | ||
756 | |||
757 | if (!item->acpiset) | ||
758 | return -EIO; | ||
759 | |||
760 | if (count > 31) | ||
761 | return -EINVAL; | ||
762 | |||
763 | value = simple_strtoul(buffer, NULL, 10); | ||
764 | |||
765 | if (item->validate) | ||
766 | value = item->validate(SNC_VALIDATE_IN, value); | ||
767 | |||
768 | if (value < 0) | ||
769 | return value; | ||
770 | |||
771 | if (acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset, value, NULL) < 0) | ||
772 | return -EIO; | ||
773 | item->value = value; | ||
774 | item->valid = 1; | ||
775 | return count; | ||
776 | } | ||
777 | |||
778 | |||
779 | /* | ||
780 | * Backlight device | ||
781 | */ | ||
782 | static int sony_backlight_update_status(struct backlight_device *bd) | ||
783 | { | ||
784 | return acpi_callsetfunc(sony_nc_acpi_handle, "SBRT", | ||
785 | bd->props.brightness + 1, NULL); | ||
786 | } | ||
787 | |||
788 | static int sony_backlight_get_brightness(struct backlight_device *bd) | ||
789 | { | ||
790 | int value; | ||
791 | |||
792 | if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value)) | ||
793 | return 0; | ||
794 | /* brightness levels are 1-based, while backlight ones are 0-based */ | ||
795 | return value - 1; | ||
796 | } | ||
797 | |||
798 | static struct backlight_device *sony_backlight_device; | ||
799 | static struct backlight_ops sony_backlight_ops = { | ||
800 | .update_status = sony_backlight_update_status, | ||
801 | .get_brightness = sony_backlight_get_brightness, | ||
802 | }; | ||
803 | |||
804 | /* | ||
805 | * New SNC-only Vaios event mapping to driver known keys | ||
806 | */ | ||
807 | struct sony_nc_event { | ||
808 | u8 data; | ||
809 | u8 event; | ||
810 | }; | ||
811 | |||
812 | static struct sony_nc_event *sony_nc_events; | ||
813 | |||
814 | /* Vaio C* --maybe also FE*, N* and AR* ?-- special init sequence | ||
815 | * for Fn keys | ||
816 | */ | ||
817 | static int sony_nc_C_enable(const struct dmi_system_id *id) | ||
818 | { | ||
819 | int result = 0; | ||
820 | |||
821 | printk(KERN_NOTICE DRV_PFX "detected %s\n", id->ident); | ||
822 | |||
823 | sony_nc_events = id->driver_data; | ||
824 | |||
825 | if (acpi_callsetfunc(sony_nc_acpi_handle, "SN02", 0x4, &result) < 0 | ||
826 | || acpi_callsetfunc(sony_nc_acpi_handle, "SN07", 0x2, &result) < 0 | ||
827 | || acpi_callsetfunc(sony_nc_acpi_handle, "SN02", 0x10, &result) < 0 | ||
828 | || acpi_callsetfunc(sony_nc_acpi_handle, "SN07", 0x0, &result) < 0 | ||
829 | || acpi_callsetfunc(sony_nc_acpi_handle, "SN03", 0x2, &result) < 0 | ||
830 | || acpi_callsetfunc(sony_nc_acpi_handle, "SN07", 0x101, &result) < 0) { | ||
831 | printk(KERN_WARNING DRV_PFX "failed to initialize SNC, some " | ||
832 | "functionalities may be missing\n"); | ||
833 | return 1; | ||
834 | } | ||
835 | return 0; | ||
836 | } | ||
837 | |||
838 | static struct sony_nc_event sony_C_events[] = { | ||
839 | { 0x81, SONYPI_EVENT_FNKEY_F1 }, | ||
840 | { 0x01, SONYPI_EVENT_FNKEY_RELEASED }, | ||
841 | { 0x85, SONYPI_EVENT_FNKEY_F5 }, | ||
842 | { 0x05, SONYPI_EVENT_FNKEY_RELEASED }, | ||
843 | { 0x86, SONYPI_EVENT_FNKEY_F6 }, | ||
844 | { 0x06, SONYPI_EVENT_FNKEY_RELEASED }, | ||
845 | { 0x87, SONYPI_EVENT_FNKEY_F7 }, | ||
846 | { 0x07, SONYPI_EVENT_FNKEY_RELEASED }, | ||
847 | { 0x8A, SONYPI_EVENT_FNKEY_F10 }, | ||
848 | { 0x0A, SONYPI_EVENT_FNKEY_RELEASED }, | ||
849 | { 0x8C, SONYPI_EVENT_FNKEY_F12 }, | ||
850 | { 0x0C, SONYPI_EVENT_FNKEY_RELEASED }, | ||
851 | { 0, 0 }, | ||
852 | }; | ||
853 | |||
854 | /* SNC-only model map */ | ||
855 | static const struct dmi_system_id sony_nc_ids[] = { | ||
856 | { | ||
857 | .ident = "Sony Vaio FE Series", | ||
858 | .callback = sony_nc_C_enable, | ||
859 | .driver_data = sony_C_events, | ||
860 | .matches = { | ||
861 | DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | ||
862 | DMI_MATCH(DMI_PRODUCT_NAME, "VGN-FE"), | ||
863 | }, | ||
864 | }, | ||
865 | { | ||
866 | .ident = "Sony Vaio FZ Series", | ||
867 | .callback = sony_nc_C_enable, | ||
868 | .driver_data = sony_C_events, | ||
869 | .matches = { | ||
870 | DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | ||
871 | DMI_MATCH(DMI_PRODUCT_NAME, "VGN-FZ"), | ||
872 | }, | ||
873 | }, | ||
874 | { | ||
875 | .ident = "Sony Vaio C Series", | ||
876 | .callback = sony_nc_C_enable, | ||
877 | .driver_data = sony_C_events, | ||
878 | .matches = { | ||
879 | DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | ||
880 | DMI_MATCH(DMI_PRODUCT_NAME, "VGN-C"), | ||
881 | }, | ||
882 | }, | ||
883 | { | ||
884 | .ident = "Sony Vaio N Series", | ||
885 | .callback = sony_nc_C_enable, | ||
886 | .driver_data = sony_C_events, | ||
887 | .matches = { | ||
888 | DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | ||
889 | DMI_MATCH(DMI_PRODUCT_NAME, "VGN-N"), | ||
890 | }, | ||
891 | }, | ||
892 | { } | ||
893 | }; | ||
894 | |||
895 | /* | ||
896 | * ACPI callbacks | ||
897 | */ | ||
898 | static void sony_acpi_notify(acpi_handle handle, u32 event, void *data) | ||
899 | { | ||
900 | struct sony_nc_event *evmap; | ||
901 | u32 ev = event; | ||
902 | int result; | ||
903 | |||
904 | if (ev == 0x92) { | ||
905 | /* read the key pressed from EC.GECR | ||
906 | * A call to SN07 with 0x0202 will do it as well respecting | ||
907 | * the current protocol on different OSes | ||
908 | * | ||
909 | * Note: the path for GECR may be | ||
910 | * \_SB.PCI0.LPCB.EC (C, FE, AR, N and friends) | ||
911 | * \_SB.PCI0.PIB.EC0 (VGN-FR notifications are sent directly, no GECR) | ||
912 | * | ||
913 | * TODO: we may want to do the same for the older GHKE -need | ||
914 | * dmi list- so this snippet may become one more callback. | ||
915 | */ | ||
916 | if (acpi_callsetfunc(handle, "SN07", 0x0202, &result) < 0) | ||
917 | dprintk("sony_acpi_notify, unable to decode event 0x%.2x\n", ev); | ||
918 | else | ||
919 | ev = result & 0xFF; | ||
920 | } | ||
921 | |||
922 | if (sony_nc_events) | ||
923 | for (evmap = sony_nc_events; evmap->event; evmap++) { | ||
924 | if (evmap->data == ev) { | ||
925 | ev = evmap->event; | ||
926 | break; | ||
927 | } | ||
928 | } | ||
929 | |||
930 | dprintk("sony_acpi_notify, event: 0x%.2x\n", ev); | ||
931 | sony_laptop_report_input_event(ev); | ||
932 | acpi_bus_generate_proc_event(sony_nc_acpi_device, 1, ev); | ||
933 | } | ||
934 | |||
935 | static acpi_status sony_walk_callback(acpi_handle handle, u32 level, | ||
936 | void *context, void **return_value) | ||
937 | { | ||
938 | struct acpi_device_info *info; | ||
939 | struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; | ||
940 | |||
941 | if (ACPI_SUCCESS(acpi_get_object_info(handle, &buffer))) { | ||
942 | info = buffer.pointer; | ||
943 | |||
944 | printk(KERN_WARNING DRV_PFX "method: name: %4.4s, args %X\n", | ||
945 | (char *)&info->name, info->param_count); | ||
946 | |||
947 | kfree(buffer.pointer); | ||
948 | } | ||
949 | |||
950 | return AE_OK; | ||
951 | } | ||
952 | |||
953 | /* | ||
954 | * ACPI device | ||
955 | */ | ||
956 | static int sony_nc_resume(struct acpi_device *device) | ||
957 | { | ||
958 | struct sony_nc_value *item; | ||
959 | |||
960 | for (item = sony_nc_values; item->name; item++) { | ||
961 | int ret; | ||
962 | |||
963 | if (!item->valid) | ||
964 | continue; | ||
965 | ret = acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset, | ||
966 | item->value, NULL); | ||
967 | if (ret < 0) { | ||
968 | printk("%s: %d\n", __func__, ret); | ||
969 | break; | ||
970 | } | ||
971 | } | ||
972 | |||
973 | /* set the last requested brightness level */ | ||
974 | if (sony_backlight_device && | ||
975 | !sony_backlight_update_status(sony_backlight_device)) | ||
976 | printk(KERN_WARNING DRV_PFX "unable to restore brightness level\n"); | ||
977 | |||
978 | /* re-initialize models with specific requirements */ | ||
979 | dmi_check_system(sony_nc_ids); | ||
980 | |||
981 | return 0; | ||
982 | } | ||
983 | |||
984 | static int sony_nc_add(struct acpi_device *device) | ||
985 | { | ||
986 | acpi_status status; | ||
987 | int result = 0; | ||
988 | acpi_handle handle; | ||
989 | struct sony_nc_value *item; | ||
990 | |||
991 | printk(KERN_INFO DRV_PFX "%s v%s.\n", | ||
992 | SONY_NC_DRIVER_NAME, SONY_LAPTOP_DRIVER_VERSION); | ||
993 | |||
994 | sony_nc_acpi_device = device; | ||
995 | strcpy(acpi_device_class(device), "sony/hotkey"); | ||
996 | |||
997 | sony_nc_acpi_handle = device->handle; | ||
998 | |||
999 | /* read device status */ | ||
1000 | result = acpi_bus_get_status(device); | ||
1001 | /* bail IFF the above call was successful and the device is not present */ | ||
1002 | if (!result && !device->status.present) { | ||
1003 | dprintk("Device not present\n"); | ||
1004 | result = -ENODEV; | ||
1005 | goto outwalk; | ||
1006 | } | ||
1007 | |||
1008 | if (debug) { | ||
1009 | status = acpi_walk_namespace(ACPI_TYPE_METHOD, sony_nc_acpi_handle, | ||
1010 | 1, sony_walk_callback, NULL, NULL); | ||
1011 | if (ACPI_FAILURE(status)) { | ||
1012 | printk(KERN_WARNING DRV_PFX "unable to walk acpi resources\n"); | ||
1013 | result = -ENODEV; | ||
1014 | goto outwalk; | ||
1015 | } | ||
1016 | } | ||
1017 | |||
1018 | /* try to _INI the device if such method exists (ACPI spec 3.0-6.5.1 | ||
1019 | * should be respected as we already checked for the device presence above */ | ||
1020 | if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, METHOD_NAME__INI, &handle))) { | ||
1021 | dprintk("Invoking _INI\n"); | ||
1022 | if (ACPI_FAILURE(acpi_evaluate_object(sony_nc_acpi_handle, METHOD_NAME__INI, | ||
1023 | NULL, NULL))) | ||
1024 | dprintk("_INI Method failed\n"); | ||
1025 | } | ||
1026 | |||
1027 | /* setup input devices and helper fifo */ | ||
1028 | result = sony_laptop_setup_input(device); | ||
1029 | if (result) { | ||
1030 | printk(KERN_ERR DRV_PFX | ||
1031 | "Unabe to create input devices.\n"); | ||
1032 | goto outwalk; | ||
1033 | } | ||
1034 | |||
1035 | status = acpi_install_notify_handler(sony_nc_acpi_handle, | ||
1036 | ACPI_DEVICE_NOTIFY, | ||
1037 | sony_acpi_notify, NULL); | ||
1038 | if (ACPI_FAILURE(status)) { | ||
1039 | printk(KERN_WARNING DRV_PFX "unable to install notify handler (%u)\n", status); | ||
1040 | result = -ENODEV; | ||
1041 | goto outinput; | ||
1042 | } | ||
1043 | |||
1044 | if (acpi_video_backlight_support()) { | ||
1045 | printk(KERN_INFO DRV_PFX "brightness ignored, must be " | ||
1046 | "controlled by ACPI video driver\n"); | ||
1047 | } else if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "GBRT", | ||
1048 | &handle))) { | ||
1049 | sony_backlight_device = backlight_device_register("sony", NULL, | ||
1050 | NULL, | ||
1051 | &sony_backlight_ops); | ||
1052 | |||
1053 | if (IS_ERR(sony_backlight_device)) { | ||
1054 | printk(KERN_WARNING DRV_PFX "unable to register backlight device\n"); | ||
1055 | sony_backlight_device = NULL; | ||
1056 | } else { | ||
1057 | sony_backlight_device->props.brightness = | ||
1058 | sony_backlight_get_brightness | ||
1059 | (sony_backlight_device); | ||
1060 | sony_backlight_device->props.max_brightness = | ||
1061 | SONY_MAX_BRIGHTNESS - 1; | ||
1062 | } | ||
1063 | |||
1064 | } | ||
1065 | |||
1066 | /* initialize models with specific requirements */ | ||
1067 | dmi_check_system(sony_nc_ids); | ||
1068 | |||
1069 | result = sony_pf_add(); | ||
1070 | if (result) | ||
1071 | goto outbacklight; | ||
1072 | |||
1073 | /* create sony_pf sysfs attributes related to the SNC device */ | ||
1074 | for (item = sony_nc_values; item->name; ++item) { | ||
1075 | |||
1076 | if (!debug && item->debug) | ||
1077 | continue; | ||
1078 | |||
1079 | /* find the available acpiget as described in the DSDT */ | ||
1080 | for (; item->acpiget && *item->acpiget; ++item->acpiget) { | ||
1081 | if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, | ||
1082 | *item->acpiget, | ||
1083 | &handle))) { | ||
1084 | dprintk("Found %s getter: %s\n", | ||
1085 | item->name, *item->acpiget); | ||
1086 | item->devattr.attr.mode |= S_IRUGO; | ||
1087 | break; | ||
1088 | } | ||
1089 | } | ||
1090 | |||
1091 | /* find the available acpiset as described in the DSDT */ | ||
1092 | for (; item->acpiset && *item->acpiset; ++item->acpiset) { | ||
1093 | if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, | ||
1094 | *item->acpiset, | ||
1095 | &handle))) { | ||
1096 | dprintk("Found %s setter: %s\n", | ||
1097 | item->name, *item->acpiset); | ||
1098 | item->devattr.attr.mode |= S_IWUSR; | ||
1099 | break; | ||
1100 | } | ||
1101 | } | ||
1102 | |||
1103 | if (item->devattr.attr.mode != 0) { | ||
1104 | result = | ||
1105 | device_create_file(&sony_pf_device->dev, | ||
1106 | &item->devattr); | ||
1107 | if (result) | ||
1108 | goto out_sysfs; | ||
1109 | } | ||
1110 | } | ||
1111 | |||
1112 | return 0; | ||
1113 | |||
1114 | out_sysfs: | ||
1115 | for (item = sony_nc_values; item->name; ++item) { | ||
1116 | device_remove_file(&sony_pf_device->dev, &item->devattr); | ||
1117 | } | ||
1118 | sony_pf_remove(); | ||
1119 | |||
1120 | outbacklight: | ||
1121 | if (sony_backlight_device) | ||
1122 | backlight_device_unregister(sony_backlight_device); | ||
1123 | |||
1124 | status = acpi_remove_notify_handler(sony_nc_acpi_handle, | ||
1125 | ACPI_DEVICE_NOTIFY, | ||
1126 | sony_acpi_notify); | ||
1127 | if (ACPI_FAILURE(status)) | ||
1128 | printk(KERN_WARNING DRV_PFX "unable to remove notify handler\n"); | ||
1129 | |||
1130 | outinput: | ||
1131 | sony_laptop_remove_input(); | ||
1132 | |||
1133 | outwalk: | ||
1134 | return result; | ||
1135 | } | ||
1136 | |||
1137 | static int sony_nc_remove(struct acpi_device *device, int type) | ||
1138 | { | ||
1139 | acpi_status status; | ||
1140 | struct sony_nc_value *item; | ||
1141 | |||
1142 | if (sony_backlight_device) | ||
1143 | backlight_device_unregister(sony_backlight_device); | ||
1144 | |||
1145 | sony_nc_acpi_device = NULL; | ||
1146 | |||
1147 | status = acpi_remove_notify_handler(sony_nc_acpi_handle, | ||
1148 | ACPI_DEVICE_NOTIFY, | ||
1149 | sony_acpi_notify); | ||
1150 | if (ACPI_FAILURE(status)) | ||
1151 | printk(KERN_WARNING DRV_PFX "unable to remove notify handler\n"); | ||
1152 | |||
1153 | for (item = sony_nc_values; item->name; ++item) { | ||
1154 | device_remove_file(&sony_pf_device->dev, &item->devattr); | ||
1155 | } | ||
1156 | |||
1157 | sony_pf_remove(); | ||
1158 | sony_laptop_remove_input(); | ||
1159 | dprintk(SONY_NC_DRIVER_NAME " removed.\n"); | ||
1160 | |||
1161 | return 0; | ||
1162 | } | ||
1163 | |||
1164 | static const struct acpi_device_id sony_device_ids[] = { | ||
1165 | {SONY_NC_HID, 0}, | ||
1166 | {SONY_PIC_HID, 0}, | ||
1167 | {"", 0}, | ||
1168 | }; | ||
1169 | MODULE_DEVICE_TABLE(acpi, sony_device_ids); | ||
1170 | |||
1171 | static const struct acpi_device_id sony_nc_device_ids[] = { | ||
1172 | {SONY_NC_HID, 0}, | ||
1173 | {"", 0}, | ||
1174 | }; | ||
1175 | |||
1176 | static struct acpi_driver sony_nc_driver = { | ||
1177 | .name = SONY_NC_DRIVER_NAME, | ||
1178 | .class = SONY_NC_CLASS, | ||
1179 | .ids = sony_nc_device_ids, | ||
1180 | .owner = THIS_MODULE, | ||
1181 | .ops = { | ||
1182 | .add = sony_nc_add, | ||
1183 | .remove = sony_nc_remove, | ||
1184 | .resume = sony_nc_resume, | ||
1185 | }, | ||
1186 | }; | ||
1187 | |||
1188 | /*********** SPIC (SNY6001) Device ***********/ | ||
1189 | |||
1190 | #define SONYPI_DEVICE_TYPE1 0x00000001 | ||
1191 | #define SONYPI_DEVICE_TYPE2 0x00000002 | ||
1192 | #define SONYPI_DEVICE_TYPE3 0x00000004 | ||
1193 | #define SONYPI_DEVICE_TYPE4 0x00000008 | ||
1194 | |||
1195 | #define SONYPI_TYPE1_OFFSET 0x04 | ||
1196 | #define SONYPI_TYPE2_OFFSET 0x12 | ||
1197 | #define SONYPI_TYPE3_OFFSET 0x12 | ||
1198 | #define SONYPI_TYPE4_OFFSET 0x12 | ||
1199 | |||
1200 | struct sony_pic_ioport { | ||
1201 | struct acpi_resource_io io1; | ||
1202 | struct acpi_resource_io io2; | ||
1203 | struct list_head list; | ||
1204 | }; | ||
1205 | |||
1206 | struct sony_pic_irq { | ||
1207 | struct acpi_resource_irq irq; | ||
1208 | struct list_head list; | ||
1209 | }; | ||
1210 | |||
1211 | struct sonypi_eventtypes { | ||
1212 | u8 data; | ||
1213 | unsigned long mask; | ||
1214 | struct sonypi_event *events; | ||
1215 | }; | ||
1216 | |||
1217 | struct device_ctrl { | ||
1218 | int model; | ||
1219 | int (*handle_irq)(const u8, const u8); | ||
1220 | u16 evport_offset; | ||
1221 | u8 has_camera; | ||
1222 | u8 has_bluetooth; | ||
1223 | u8 has_wwan; | ||
1224 | struct sonypi_eventtypes *event_types; | ||
1225 | }; | ||
1226 | |||
1227 | struct sony_pic_dev { | ||
1228 | struct device_ctrl *control; | ||
1229 | struct acpi_device *acpi_dev; | ||
1230 | struct sony_pic_irq *cur_irq; | ||
1231 | struct sony_pic_ioport *cur_ioport; | ||
1232 | struct list_head interrupts; | ||
1233 | struct list_head ioports; | ||
1234 | struct mutex lock; | ||
1235 | u8 camera_power; | ||
1236 | u8 bluetooth_power; | ||
1237 | u8 wwan_power; | ||
1238 | }; | ||
1239 | |||
1240 | static struct sony_pic_dev spic_dev = { | ||
1241 | .interrupts = LIST_HEAD_INIT(spic_dev.interrupts), | ||
1242 | .ioports = LIST_HEAD_INIT(spic_dev.ioports), | ||
1243 | }; | ||
1244 | |||
1245 | /* Event masks */ | ||
1246 | #define SONYPI_JOGGER_MASK 0x00000001 | ||
1247 | #define SONYPI_CAPTURE_MASK 0x00000002 | ||
1248 | #define SONYPI_FNKEY_MASK 0x00000004 | ||
1249 | #define SONYPI_BLUETOOTH_MASK 0x00000008 | ||
1250 | #define SONYPI_PKEY_MASK 0x00000010 | ||
1251 | #define SONYPI_BACK_MASK 0x00000020 | ||
1252 | #define SONYPI_HELP_MASK 0x00000040 | ||
1253 | #define SONYPI_LID_MASK 0x00000080 | ||
1254 | #define SONYPI_ZOOM_MASK 0x00000100 | ||
1255 | #define SONYPI_THUMBPHRASE_MASK 0x00000200 | ||
1256 | #define SONYPI_MEYE_MASK 0x00000400 | ||
1257 | #define SONYPI_MEMORYSTICK_MASK 0x00000800 | ||
1258 | #define SONYPI_BATTERY_MASK 0x00001000 | ||
1259 | #define SONYPI_WIRELESS_MASK 0x00002000 | ||
1260 | |||
1261 | struct sonypi_event { | ||
1262 | u8 data; | ||
1263 | u8 event; | ||
1264 | }; | ||
1265 | |||
1266 | /* The set of possible button release events */ | ||
1267 | static struct sonypi_event sonypi_releaseev[] = { | ||
1268 | { 0x00, SONYPI_EVENT_ANYBUTTON_RELEASED }, | ||
1269 | { 0, 0 } | ||
1270 | }; | ||
1271 | |||
1272 | /* The set of possible jogger events */ | ||
1273 | static struct sonypi_event sonypi_joggerev[] = { | ||
1274 | { 0x1f, SONYPI_EVENT_JOGDIAL_UP }, | ||
1275 | { 0x01, SONYPI_EVENT_JOGDIAL_DOWN }, | ||
1276 | { 0x5f, SONYPI_EVENT_JOGDIAL_UP_PRESSED }, | ||
1277 | { 0x41, SONYPI_EVENT_JOGDIAL_DOWN_PRESSED }, | ||
1278 | { 0x1e, SONYPI_EVENT_JOGDIAL_FAST_UP }, | ||
1279 | { 0x02, SONYPI_EVENT_JOGDIAL_FAST_DOWN }, | ||
1280 | { 0x5e, SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED }, | ||
1281 | { 0x42, SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED }, | ||
1282 | { 0x1d, SONYPI_EVENT_JOGDIAL_VFAST_UP }, | ||
1283 | { 0x03, SONYPI_EVENT_JOGDIAL_VFAST_DOWN }, | ||
1284 | { 0x5d, SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED }, | ||
1285 | { 0x43, SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED }, | ||
1286 | { 0x40, SONYPI_EVENT_JOGDIAL_PRESSED }, | ||
1287 | { 0, 0 } | ||
1288 | }; | ||
1289 | |||
1290 | /* The set of possible capture button events */ | ||
1291 | static struct sonypi_event sonypi_captureev[] = { | ||
1292 | { 0x05, SONYPI_EVENT_CAPTURE_PARTIALPRESSED }, | ||
1293 | { 0x07, SONYPI_EVENT_CAPTURE_PRESSED }, | ||
1294 | { 0x40, SONYPI_EVENT_CAPTURE_PRESSED }, | ||
1295 | { 0x01, SONYPI_EVENT_CAPTURE_PARTIALRELEASED }, | ||
1296 | { 0, 0 } | ||
1297 | }; | ||
1298 | |||
1299 | /* The set of possible fnkeys events */ | ||
1300 | static struct sonypi_event sonypi_fnkeyev[] = { | ||
1301 | { 0x10, SONYPI_EVENT_FNKEY_ESC }, | ||
1302 | { 0x11, SONYPI_EVENT_FNKEY_F1 }, | ||
1303 | { 0x12, SONYPI_EVENT_FNKEY_F2 }, | ||
1304 | { 0x13, SONYPI_EVENT_FNKEY_F3 }, | ||
1305 | { 0x14, SONYPI_EVENT_FNKEY_F4 }, | ||
1306 | { 0x15, SONYPI_EVENT_FNKEY_F5 }, | ||
1307 | { 0x16, SONYPI_EVENT_FNKEY_F6 }, | ||
1308 | { 0x17, SONYPI_EVENT_FNKEY_F7 }, | ||
1309 | { 0x18, SONYPI_EVENT_FNKEY_F8 }, | ||
1310 | { 0x19, SONYPI_EVENT_FNKEY_F9 }, | ||
1311 | { 0x1a, SONYPI_EVENT_FNKEY_F10 }, | ||
1312 | { 0x1b, SONYPI_EVENT_FNKEY_F11 }, | ||
1313 | { 0x1c, SONYPI_EVENT_FNKEY_F12 }, | ||
1314 | { 0x1f, SONYPI_EVENT_FNKEY_RELEASED }, | ||
1315 | { 0x21, SONYPI_EVENT_FNKEY_1 }, | ||
1316 | { 0x22, SONYPI_EVENT_FNKEY_2 }, | ||
1317 | { 0x31, SONYPI_EVENT_FNKEY_D }, | ||
1318 | { 0x32, SONYPI_EVENT_FNKEY_E }, | ||
1319 | { 0x33, SONYPI_EVENT_FNKEY_F }, | ||
1320 | { 0x34, SONYPI_EVENT_FNKEY_S }, | ||
1321 | { 0x35, SONYPI_EVENT_FNKEY_B }, | ||
1322 | { 0x36, SONYPI_EVENT_FNKEY_ONLY }, | ||
1323 | { 0, 0 } | ||
1324 | }; | ||
1325 | |||
1326 | /* The set of possible program key events */ | ||
1327 | static struct sonypi_event sonypi_pkeyev[] = { | ||
1328 | { 0x01, SONYPI_EVENT_PKEY_P1 }, | ||
1329 | { 0x02, SONYPI_EVENT_PKEY_P2 }, | ||
1330 | { 0x04, SONYPI_EVENT_PKEY_P3 }, | ||
1331 | { 0, 0 } | ||
1332 | }; | ||
1333 | |||
1334 | /* The set of possible bluetooth events */ | ||
1335 | static struct sonypi_event sonypi_blueev[] = { | ||
1336 | { 0x55, SONYPI_EVENT_BLUETOOTH_PRESSED }, | ||
1337 | { 0x59, SONYPI_EVENT_BLUETOOTH_ON }, | ||
1338 | { 0x5a, SONYPI_EVENT_BLUETOOTH_OFF }, | ||
1339 | { 0, 0 } | ||
1340 | }; | ||
1341 | |||
1342 | /* The set of possible wireless events */ | ||
1343 | static struct sonypi_event sonypi_wlessev[] = { | ||
1344 | { 0x59, SONYPI_EVENT_WIRELESS_ON }, | ||
1345 | { 0x5a, SONYPI_EVENT_WIRELESS_OFF }, | ||
1346 | { 0, 0 } | ||
1347 | }; | ||
1348 | |||
1349 | /* The set of possible back button events */ | ||
1350 | static struct sonypi_event sonypi_backev[] = { | ||
1351 | { 0x20, SONYPI_EVENT_BACK_PRESSED }, | ||
1352 | { 0, 0 } | ||
1353 | }; | ||
1354 | |||
1355 | /* The set of possible help button events */ | ||
1356 | static struct sonypi_event sonypi_helpev[] = { | ||
1357 | { 0x3b, SONYPI_EVENT_HELP_PRESSED }, | ||
1358 | { 0, 0 } | ||
1359 | }; | ||
1360 | |||
1361 | |||
1362 | /* The set of possible lid events */ | ||
1363 | static struct sonypi_event sonypi_lidev[] = { | ||
1364 | { 0x51, SONYPI_EVENT_LID_CLOSED }, | ||
1365 | { 0x50, SONYPI_EVENT_LID_OPENED }, | ||
1366 | { 0, 0 } | ||
1367 | }; | ||
1368 | |||
1369 | /* The set of possible zoom events */ | ||
1370 | static struct sonypi_event sonypi_zoomev[] = { | ||
1371 | { 0x39, SONYPI_EVENT_ZOOM_PRESSED }, | ||
1372 | { 0x10, SONYPI_EVENT_ZOOM_IN_PRESSED }, | ||
1373 | { 0x20, SONYPI_EVENT_ZOOM_OUT_PRESSED }, | ||
1374 | { 0, 0 } | ||
1375 | }; | ||
1376 | |||
1377 | /* The set of possible thumbphrase events */ | ||
1378 | static struct sonypi_event sonypi_thumbphraseev[] = { | ||
1379 | { 0x3a, SONYPI_EVENT_THUMBPHRASE_PRESSED }, | ||
1380 | { 0, 0 } | ||
1381 | }; | ||
1382 | |||
1383 | /* The set of possible motioneye camera events */ | ||
1384 | static struct sonypi_event sonypi_meyeev[] = { | ||
1385 | { 0x00, SONYPI_EVENT_MEYE_FACE }, | ||
1386 | { 0x01, SONYPI_EVENT_MEYE_OPPOSITE }, | ||
1387 | { 0, 0 } | ||
1388 | }; | ||
1389 | |||
1390 | /* The set of possible memorystick events */ | ||
1391 | static struct sonypi_event sonypi_memorystickev[] = { | ||
1392 | { 0x53, SONYPI_EVENT_MEMORYSTICK_INSERT }, | ||
1393 | { 0x54, SONYPI_EVENT_MEMORYSTICK_EJECT }, | ||
1394 | { 0, 0 } | ||
1395 | }; | ||
1396 | |||
1397 | /* The set of possible battery events */ | ||
1398 | static struct sonypi_event sonypi_batteryev[] = { | ||
1399 | { 0x20, SONYPI_EVENT_BATTERY_INSERT }, | ||
1400 | { 0x30, SONYPI_EVENT_BATTERY_REMOVE }, | ||
1401 | { 0, 0 } | ||
1402 | }; | ||
1403 | |||
1404 | static struct sonypi_eventtypes type1_events[] = { | ||
1405 | { 0, 0xffffffff, sonypi_releaseev }, | ||
1406 | { 0x70, SONYPI_MEYE_MASK, sonypi_meyeev }, | ||
1407 | { 0x30, SONYPI_LID_MASK, sonypi_lidev }, | ||
1408 | { 0x60, SONYPI_CAPTURE_MASK, sonypi_captureev }, | ||
1409 | { 0x10, SONYPI_JOGGER_MASK, sonypi_joggerev }, | ||
1410 | { 0x20, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, | ||
1411 | { 0x30, SONYPI_BLUETOOTH_MASK, sonypi_blueev }, | ||
1412 | { 0x40, SONYPI_PKEY_MASK, sonypi_pkeyev }, | ||
1413 | { 0x30, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, | ||
1414 | { 0x40, SONYPI_BATTERY_MASK, sonypi_batteryev }, | ||
1415 | { 0 }, | ||
1416 | }; | ||
1417 | static struct sonypi_eventtypes type2_events[] = { | ||
1418 | { 0, 0xffffffff, sonypi_releaseev }, | ||
1419 | { 0x38, SONYPI_LID_MASK, sonypi_lidev }, | ||
1420 | { 0x11, SONYPI_JOGGER_MASK, sonypi_joggerev }, | ||
1421 | { 0x61, SONYPI_CAPTURE_MASK, sonypi_captureev }, | ||
1422 | { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, | ||
1423 | { 0x31, SONYPI_BLUETOOTH_MASK, sonypi_blueev }, | ||
1424 | { 0x08, SONYPI_PKEY_MASK, sonypi_pkeyev }, | ||
1425 | { 0x11, SONYPI_BACK_MASK, sonypi_backev }, | ||
1426 | { 0x21, SONYPI_HELP_MASK, sonypi_helpev }, | ||
1427 | { 0x21, SONYPI_ZOOM_MASK, sonypi_zoomev }, | ||
1428 | { 0x20, SONYPI_THUMBPHRASE_MASK, sonypi_thumbphraseev }, | ||
1429 | { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, | ||
1430 | { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev }, | ||
1431 | { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev }, | ||
1432 | { 0 }, | ||
1433 | }; | ||
1434 | static struct sonypi_eventtypes type3_events[] = { | ||
1435 | { 0, 0xffffffff, sonypi_releaseev }, | ||
1436 | { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, | ||
1437 | { 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev }, | ||
1438 | { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, | ||
1439 | { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev }, | ||
1440 | { 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev }, | ||
1441 | { 0 }, | ||
1442 | }; | ||
1443 | static struct sonypi_eventtypes type4_events[] = { | ||
1444 | { 0, 0xffffffff, sonypi_releaseev }, | ||
1445 | { 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev }, | ||
1446 | { 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev }, | ||
1447 | { 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev }, | ||
1448 | { 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev }, | ||
1449 | { 0x05, SONYPI_PKEY_MASK, sonypi_pkeyev }, | ||
1450 | { 0x05, SONYPI_ZOOM_MASK, sonypi_zoomev }, | ||
1451 | { 0x05, SONYPI_CAPTURE_MASK, sonypi_captureev }, | ||
1452 | { 0 }, | ||
1453 | }; | ||
1454 | |||
1455 | /* low level spic calls */ | ||
1456 | #define ITERATIONS_LONG 10000 | ||
1457 | #define ITERATIONS_SHORT 10 | ||
1458 | #define wait_on_command(command, iterations) { \ | ||
1459 | unsigned int n = iterations; \ | ||
1460 | while (--n && (command)) \ | ||
1461 | udelay(1); \ | ||
1462 | if (!n) \ | ||
1463 | dprintk("command failed at %s : %s (line %d)\n", \ | ||
1464 | __FILE__, __func__, __LINE__); \ | ||
1465 | } | ||
1466 | |||
1467 | static u8 sony_pic_call1(u8 dev) | ||
1468 | { | ||
1469 | u8 v1, v2; | ||
1470 | |||
1471 | wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, | ||
1472 | ITERATIONS_LONG); | ||
1473 | outb(dev, spic_dev.cur_ioport->io1.minimum + 4); | ||
1474 | v1 = inb_p(spic_dev.cur_ioport->io1.minimum + 4); | ||
1475 | v2 = inb_p(spic_dev.cur_ioport->io1.minimum); | ||
1476 | dprintk("sony_pic_call1(0x%.2x): 0x%.4x\n", dev, (v2 << 8) | v1); | ||
1477 | return v2; | ||
1478 | } | ||
1479 | |||
1480 | static u8 sony_pic_call2(u8 dev, u8 fn) | ||
1481 | { | ||
1482 | u8 v1; | ||
1483 | |||
1484 | wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, | ||
1485 | ITERATIONS_LONG); | ||
1486 | outb(dev, spic_dev.cur_ioport->io1.minimum + 4); | ||
1487 | wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, | ||
1488 | ITERATIONS_LONG); | ||
1489 | outb(fn, spic_dev.cur_ioport->io1.minimum); | ||
1490 | v1 = inb_p(spic_dev.cur_ioport->io1.minimum); | ||
1491 | dprintk("sony_pic_call2(0x%.2x - 0x%.2x): 0x%.4x\n", dev, fn, v1); | ||
1492 | return v1; | ||
1493 | } | ||
1494 | |||
1495 | static u8 sony_pic_call3(u8 dev, u8 fn, u8 v) | ||
1496 | { | ||
1497 | u8 v1; | ||
1498 | |||
1499 | wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG); | ||
1500 | outb(dev, spic_dev.cur_ioport->io1.minimum + 4); | ||
1501 | wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG); | ||
1502 | outb(fn, spic_dev.cur_ioport->io1.minimum); | ||
1503 | wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG); | ||
1504 | outb(v, spic_dev.cur_ioport->io1.minimum); | ||
1505 | v1 = inb_p(spic_dev.cur_ioport->io1.minimum); | ||
1506 | dprintk("sony_pic_call3(0x%.2x - 0x%.2x - 0x%.2x): 0x%.4x\n", | ||
1507 | dev, fn, v, v1); | ||
1508 | return v1; | ||
1509 | } | ||
1510 | |||
1511 | /* | ||
1512 | * minidrivers for SPIC models | ||
1513 | */ | ||
1514 | static int type4_handle_irq(const u8 data_mask, const u8 ev) | ||
1515 | { | ||
1516 | /* | ||
1517 | * 0x31 could mean we have to take some extra action and wait for | ||
1518 | * the next irq for some Type4 models, it will generate a new | ||
1519 | * irq and we can read new data from the device: | ||
1520 | * - 0x5c and 0x5f requires 0xA0 | ||
1521 | * - 0x61 requires 0xB3 | ||
1522 | */ | ||
1523 | if (data_mask == 0x31) { | ||
1524 | if (ev == 0x5c || ev == 0x5f) | ||
1525 | sony_pic_call1(0xA0); | ||
1526 | else if (ev == 0x61) | ||
1527 | sony_pic_call1(0xB3); | ||
1528 | return 0; | ||
1529 | } | ||
1530 | return 1; | ||
1531 | } | ||
1532 | |||
1533 | static struct device_ctrl spic_types[] = { | ||
1534 | { | ||
1535 | .model = SONYPI_DEVICE_TYPE1, | ||
1536 | .handle_irq = NULL, | ||
1537 | .evport_offset = SONYPI_TYPE1_OFFSET, | ||
1538 | .event_types = type1_events, | ||
1539 | }, | ||
1540 | { | ||
1541 | .model = SONYPI_DEVICE_TYPE2, | ||
1542 | .handle_irq = NULL, | ||
1543 | .evport_offset = SONYPI_TYPE2_OFFSET, | ||
1544 | .event_types = type2_events, | ||
1545 | }, | ||
1546 | { | ||
1547 | .model = SONYPI_DEVICE_TYPE3, | ||
1548 | .handle_irq = NULL, | ||
1549 | .evport_offset = SONYPI_TYPE3_OFFSET, | ||
1550 | .event_types = type3_events, | ||
1551 | }, | ||
1552 | { | ||
1553 | .model = SONYPI_DEVICE_TYPE4, | ||
1554 | .handle_irq = type4_handle_irq, | ||
1555 | .evport_offset = SONYPI_TYPE4_OFFSET, | ||
1556 | .event_types = type4_events, | ||
1557 | }, | ||
1558 | }; | ||
1559 | |||
1560 | static void sony_pic_detect_device_type(struct sony_pic_dev *dev) | ||
1561 | { | ||
1562 | struct pci_dev *pcidev; | ||
1563 | |||
1564 | pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, | ||
1565 | PCI_DEVICE_ID_INTEL_82371AB_3, NULL); | ||
1566 | if (pcidev) { | ||
1567 | dev->control = &spic_types[0]; | ||
1568 | goto out; | ||
1569 | } | ||
1570 | |||
1571 | pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, | ||
1572 | PCI_DEVICE_ID_INTEL_ICH6_1, NULL); | ||
1573 | if (pcidev) { | ||
1574 | dev->control = &spic_types[2]; | ||
1575 | goto out; | ||
1576 | } | ||
1577 | |||
1578 | pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, | ||
1579 | PCI_DEVICE_ID_INTEL_ICH7_1, NULL); | ||
1580 | if (pcidev) { | ||
1581 | dev->control = &spic_types[3]; | ||
1582 | goto out; | ||
1583 | } | ||
1584 | |||
1585 | pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, | ||
1586 | PCI_DEVICE_ID_INTEL_ICH8_4, NULL); | ||
1587 | if (pcidev) { | ||
1588 | dev->control = &spic_types[3]; | ||
1589 | goto out; | ||
1590 | } | ||
1591 | |||
1592 | /* default */ | ||
1593 | dev->control = &spic_types[1]; | ||
1594 | |||
1595 | out: | ||
1596 | if (pcidev) | ||
1597 | pci_dev_put(pcidev); | ||
1598 | |||
1599 | printk(KERN_INFO DRV_PFX "detected Type%d model\n", | ||
1600 | dev->control->model == SONYPI_DEVICE_TYPE1 ? 1 : | ||
1601 | dev->control->model == SONYPI_DEVICE_TYPE2 ? 2 : | ||
1602 | dev->control->model == SONYPI_DEVICE_TYPE3 ? 3 : 4); | ||
1603 | } | ||
1604 | |||
1605 | /* camera tests and poweron/poweroff */ | ||
1606 | #define SONYPI_CAMERA_PICTURE 5 | ||
1607 | #define SONYPI_CAMERA_CONTROL 0x10 | ||
1608 | |||
1609 | #define SONYPI_CAMERA_BRIGHTNESS 0 | ||
1610 | #define SONYPI_CAMERA_CONTRAST 1 | ||
1611 | #define SONYPI_CAMERA_HUE 2 | ||
1612 | #define SONYPI_CAMERA_COLOR 3 | ||
1613 | #define SONYPI_CAMERA_SHARPNESS 4 | ||
1614 | |||
1615 | #define SONYPI_CAMERA_EXPOSURE_MASK 0xC | ||
1616 | #define SONYPI_CAMERA_WHITE_BALANCE_MASK 0x3 | ||
1617 | #define SONYPI_CAMERA_PICTURE_MODE_MASK 0x30 | ||
1618 | #define SONYPI_CAMERA_MUTE_MASK 0x40 | ||
1619 | |||
1620 | /* the rest don't need a loop until not 0xff */ | ||
1621 | #define SONYPI_CAMERA_AGC 6 | ||
1622 | #define SONYPI_CAMERA_AGC_MASK 0x30 | ||
1623 | #define SONYPI_CAMERA_SHUTTER_MASK 0x7 | ||
1624 | |||
1625 | #define SONYPI_CAMERA_SHUTDOWN_REQUEST 7 | ||
1626 | #define SONYPI_CAMERA_CONTROL 0x10 | ||
1627 | |||
1628 | #define SONYPI_CAMERA_STATUS 7 | ||
1629 | #define SONYPI_CAMERA_STATUS_READY 0x2 | ||
1630 | #define SONYPI_CAMERA_STATUS_POSITION 0x4 | ||
1631 | |||
1632 | #define SONYPI_DIRECTION_BACKWARDS 0x4 | ||
1633 | |||
1634 | #define SONYPI_CAMERA_REVISION 8 | ||
1635 | #define SONYPI_CAMERA_ROMVERSION 9 | ||
1636 | |||
1637 | static int __sony_pic_camera_ready(void) | ||
1638 | { | ||
1639 | u8 v; | ||
1640 | |||
1641 | v = sony_pic_call2(0x8f, SONYPI_CAMERA_STATUS); | ||
1642 | return (v != 0xff && (v & SONYPI_CAMERA_STATUS_READY)); | ||
1643 | } | ||
1644 | |||
1645 | static int __sony_pic_camera_off(void) | ||
1646 | { | ||
1647 | if (!camera) { | ||
1648 | printk(KERN_WARNING DRV_PFX "camera control not enabled\n"); | ||
1649 | return -ENODEV; | ||
1650 | } | ||
1651 | |||
1652 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, | ||
1653 | SONYPI_CAMERA_MUTE_MASK), | ||
1654 | ITERATIONS_SHORT); | ||
1655 | |||
1656 | if (spic_dev.camera_power) { | ||
1657 | sony_pic_call2(0x91, 0); | ||
1658 | spic_dev.camera_power = 0; | ||
1659 | } | ||
1660 | return 0; | ||
1661 | } | ||
1662 | |||
1663 | static int __sony_pic_camera_on(void) | ||
1664 | { | ||
1665 | int i, j, x; | ||
1666 | |||
1667 | if (!camera) { | ||
1668 | printk(KERN_WARNING DRV_PFX "camera control not enabled\n"); | ||
1669 | return -ENODEV; | ||
1670 | } | ||
1671 | |||
1672 | if (spic_dev.camera_power) | ||
1673 | return 0; | ||
1674 | |||
1675 | for (j = 5; j > 0; j--) { | ||
1676 | |||
1677 | for (x = 0; x < 100 && sony_pic_call2(0x91, 0x1); x++) | ||
1678 | msleep(10); | ||
1679 | sony_pic_call1(0x93); | ||
1680 | |||
1681 | for (i = 400; i > 0; i--) { | ||
1682 | if (__sony_pic_camera_ready()) | ||
1683 | break; | ||
1684 | msleep(10); | ||
1685 | } | ||
1686 | if (i) | ||
1687 | break; | ||
1688 | } | ||
1689 | |||
1690 | if (j == 0) { | ||
1691 | printk(KERN_WARNING DRV_PFX "failed to power on camera\n"); | ||
1692 | return -ENODEV; | ||
1693 | } | ||
1694 | |||
1695 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTROL, | ||
1696 | 0x5a), | ||
1697 | ITERATIONS_SHORT); | ||
1698 | |||
1699 | spic_dev.camera_power = 1; | ||
1700 | return 0; | ||
1701 | } | ||
1702 | |||
1703 | /* External camera command (exported to the motion eye v4l driver) */ | ||
1704 | int sony_pic_camera_command(int command, u8 value) | ||
1705 | { | ||
1706 | if (!camera) | ||
1707 | return -EIO; | ||
1708 | |||
1709 | mutex_lock(&spic_dev.lock); | ||
1710 | |||
1711 | switch (command) { | ||
1712 | case SONY_PIC_COMMAND_SETCAMERA: | ||
1713 | if (value) | ||
1714 | __sony_pic_camera_on(); | ||
1715 | else | ||
1716 | __sony_pic_camera_off(); | ||
1717 | break; | ||
1718 | case SONY_PIC_COMMAND_SETCAMERABRIGHTNESS: | ||
1719 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_BRIGHTNESS, value), | ||
1720 | ITERATIONS_SHORT); | ||
1721 | break; | ||
1722 | case SONY_PIC_COMMAND_SETCAMERACONTRAST: | ||
1723 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTRAST, value), | ||
1724 | ITERATIONS_SHORT); | ||
1725 | break; | ||
1726 | case SONY_PIC_COMMAND_SETCAMERAHUE: | ||
1727 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_HUE, value), | ||
1728 | ITERATIONS_SHORT); | ||
1729 | break; | ||
1730 | case SONY_PIC_COMMAND_SETCAMERACOLOR: | ||
1731 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_COLOR, value), | ||
1732 | ITERATIONS_SHORT); | ||
1733 | break; | ||
1734 | case SONY_PIC_COMMAND_SETCAMERASHARPNESS: | ||
1735 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_SHARPNESS, value), | ||
1736 | ITERATIONS_SHORT); | ||
1737 | break; | ||
1738 | case SONY_PIC_COMMAND_SETCAMERAPICTURE: | ||
1739 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, value), | ||
1740 | ITERATIONS_SHORT); | ||
1741 | break; | ||
1742 | case SONY_PIC_COMMAND_SETCAMERAAGC: | ||
1743 | wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_AGC, value), | ||
1744 | ITERATIONS_SHORT); | ||
1745 | break; | ||
1746 | default: | ||
1747 | printk(KERN_ERR DRV_PFX "sony_pic_camera_command invalid: %d\n", | ||
1748 | command); | ||
1749 | break; | ||
1750 | } | ||
1751 | mutex_unlock(&spic_dev.lock); | ||
1752 | return 0; | ||
1753 | } | ||
1754 | EXPORT_SYMBOL(sony_pic_camera_command); | ||
1755 | |||
1756 | /* gprs/edge modem (SZ460N and SZ210P), thanks to Joshua Wise */ | ||
1757 | static void sony_pic_set_wwanpower(u8 state) | ||
1758 | { | ||
1759 | state = !!state; | ||
1760 | mutex_lock(&spic_dev.lock); | ||
1761 | if (spic_dev.wwan_power == state) { | ||
1762 | mutex_unlock(&spic_dev.lock); | ||
1763 | return; | ||
1764 | } | ||
1765 | sony_pic_call2(0xB0, state); | ||
1766 | spic_dev.wwan_power = state; | ||
1767 | mutex_unlock(&spic_dev.lock); | ||
1768 | } | ||
1769 | |||
1770 | static ssize_t sony_pic_wwanpower_store(struct device *dev, | ||
1771 | struct device_attribute *attr, | ||
1772 | const char *buffer, size_t count) | ||
1773 | { | ||
1774 | unsigned long value; | ||
1775 | if (count > 31) | ||
1776 | return -EINVAL; | ||
1777 | |||
1778 | value = simple_strtoul(buffer, NULL, 10); | ||
1779 | sony_pic_set_wwanpower(value); | ||
1780 | |||
1781 | return count; | ||
1782 | } | ||
1783 | |||
1784 | static ssize_t sony_pic_wwanpower_show(struct device *dev, | ||
1785 | struct device_attribute *attr, char *buffer) | ||
1786 | { | ||
1787 | ssize_t count; | ||
1788 | mutex_lock(&spic_dev.lock); | ||
1789 | count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.wwan_power); | ||
1790 | mutex_unlock(&spic_dev.lock); | ||
1791 | return count; | ||
1792 | } | ||
1793 | |||
1794 | /* bluetooth subsystem power state */ | ||
1795 | static void __sony_pic_set_bluetoothpower(u8 state) | ||
1796 | { | ||
1797 | state = !!state; | ||
1798 | if (spic_dev.bluetooth_power == state) | ||
1799 | return; | ||
1800 | sony_pic_call2(0x96, state); | ||
1801 | sony_pic_call1(0x82); | ||
1802 | spic_dev.bluetooth_power = state; | ||
1803 | } | ||
1804 | |||
1805 | static ssize_t sony_pic_bluetoothpower_store(struct device *dev, | ||
1806 | struct device_attribute *attr, | ||
1807 | const char *buffer, size_t count) | ||
1808 | { | ||
1809 | unsigned long value; | ||
1810 | if (count > 31) | ||
1811 | return -EINVAL; | ||
1812 | |||
1813 | value = simple_strtoul(buffer, NULL, 10); | ||
1814 | mutex_lock(&spic_dev.lock); | ||
1815 | __sony_pic_set_bluetoothpower(value); | ||
1816 | mutex_unlock(&spic_dev.lock); | ||
1817 | |||
1818 | return count; | ||
1819 | } | ||
1820 | |||
1821 | static ssize_t sony_pic_bluetoothpower_show(struct device *dev, | ||
1822 | struct device_attribute *attr, char *buffer) | ||
1823 | { | ||
1824 | ssize_t count = 0; | ||
1825 | mutex_lock(&spic_dev.lock); | ||
1826 | count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.bluetooth_power); | ||
1827 | mutex_unlock(&spic_dev.lock); | ||
1828 | return count; | ||
1829 | } | ||
1830 | |||
1831 | /* fan speed */ | ||
1832 | /* FAN0 information (reverse engineered from ACPI tables) */ | ||
1833 | #define SONY_PIC_FAN0_STATUS 0x93 | ||
1834 | static int sony_pic_set_fanspeed(unsigned long value) | ||
1835 | { | ||
1836 | return ec_write(SONY_PIC_FAN0_STATUS, value); | ||
1837 | } | ||
1838 | |||
1839 | static int sony_pic_get_fanspeed(u8 *value) | ||
1840 | { | ||
1841 | return ec_read(SONY_PIC_FAN0_STATUS, value); | ||
1842 | } | ||
1843 | |||
1844 | static ssize_t sony_pic_fanspeed_store(struct device *dev, | ||
1845 | struct device_attribute *attr, | ||
1846 | const char *buffer, size_t count) | ||
1847 | { | ||
1848 | unsigned long value; | ||
1849 | if (count > 31) | ||
1850 | return -EINVAL; | ||
1851 | |||
1852 | value = simple_strtoul(buffer, NULL, 10); | ||
1853 | if (sony_pic_set_fanspeed(value)) | ||
1854 | return -EIO; | ||
1855 | |||
1856 | return count; | ||
1857 | } | ||
1858 | |||
1859 | static ssize_t sony_pic_fanspeed_show(struct device *dev, | ||
1860 | struct device_attribute *attr, char *buffer) | ||
1861 | { | ||
1862 | u8 value = 0; | ||
1863 | if (sony_pic_get_fanspeed(&value)) | ||
1864 | return -EIO; | ||
1865 | |||
1866 | return snprintf(buffer, PAGE_SIZE, "%d\n", value); | ||
1867 | } | ||
1868 | |||
1869 | #define SPIC_ATTR(_name, _mode) \ | ||
1870 | struct device_attribute spic_attr_##_name = __ATTR(_name, \ | ||
1871 | _mode, sony_pic_## _name ##_show, \ | ||
1872 | sony_pic_## _name ##_store) | ||
1873 | |||
1874 | static SPIC_ATTR(bluetoothpower, 0644); | ||
1875 | static SPIC_ATTR(wwanpower, 0644); | ||
1876 | static SPIC_ATTR(fanspeed, 0644); | ||
1877 | |||
1878 | static struct attribute *spic_attributes[] = { | ||
1879 | &spic_attr_bluetoothpower.attr, | ||
1880 | &spic_attr_wwanpower.attr, | ||
1881 | &spic_attr_fanspeed.attr, | ||
1882 | NULL | ||
1883 | }; | ||
1884 | |||
1885 | static struct attribute_group spic_attribute_group = { | ||
1886 | .attrs = spic_attributes | ||
1887 | }; | ||
1888 | |||
1889 | /******** SONYPI compatibility **********/ | ||
1890 | #ifdef CONFIG_SONYPI_COMPAT | ||
1891 | |||
1892 | /* battery / brightness / temperature addresses */ | ||
1893 | #define SONYPI_BAT_FLAGS 0x81 | ||
1894 | #define SONYPI_LCD_LIGHT 0x96 | ||
1895 | #define SONYPI_BAT1_PCTRM 0xa0 | ||
1896 | #define SONYPI_BAT1_LEFT 0xa2 | ||
1897 | #define SONYPI_BAT1_MAXRT 0xa4 | ||
1898 | #define SONYPI_BAT2_PCTRM 0xa8 | ||
1899 | #define SONYPI_BAT2_LEFT 0xaa | ||
1900 | #define SONYPI_BAT2_MAXRT 0xac | ||
1901 | #define SONYPI_BAT1_MAXTK 0xb0 | ||
1902 | #define SONYPI_BAT1_FULL 0xb2 | ||
1903 | #define SONYPI_BAT2_MAXTK 0xb8 | ||
1904 | #define SONYPI_BAT2_FULL 0xba | ||
1905 | #define SONYPI_TEMP_STATUS 0xC1 | ||
1906 | |||
1907 | struct sonypi_compat_s { | ||
1908 | struct fasync_struct *fifo_async; | ||
1909 | struct kfifo *fifo; | ||
1910 | spinlock_t fifo_lock; | ||
1911 | wait_queue_head_t fifo_proc_list; | ||
1912 | atomic_t open_count; | ||
1913 | }; | ||
1914 | static struct sonypi_compat_s sonypi_compat = { | ||
1915 | .open_count = ATOMIC_INIT(0), | ||
1916 | }; | ||
1917 | |||
1918 | static int sonypi_misc_fasync(int fd, struct file *filp, int on) | ||
1919 | { | ||
1920 | int retval; | ||
1921 | |||
1922 | retval = fasync_helper(fd, filp, on, &sonypi_compat.fifo_async); | ||
1923 | if (retval < 0) | ||
1924 | return retval; | ||
1925 | return 0; | ||
1926 | } | ||
1927 | |||
1928 | static int sonypi_misc_release(struct inode *inode, struct file *file) | ||
1929 | { | ||
1930 | atomic_dec(&sonypi_compat.open_count); | ||
1931 | return 0; | ||
1932 | } | ||
1933 | |||
1934 | static int sonypi_misc_open(struct inode *inode, struct file *file) | ||
1935 | { | ||
1936 | /* Flush input queue on first open */ | ||
1937 | lock_kernel(); | ||
1938 | if (atomic_inc_return(&sonypi_compat.open_count) == 1) | ||
1939 | kfifo_reset(sonypi_compat.fifo); | ||
1940 | unlock_kernel(); | ||
1941 | return 0; | ||
1942 | } | ||
1943 | |||
1944 | static ssize_t sonypi_misc_read(struct file *file, char __user *buf, | ||
1945 | size_t count, loff_t *pos) | ||
1946 | { | ||
1947 | ssize_t ret; | ||
1948 | unsigned char c; | ||
1949 | |||
1950 | if ((kfifo_len(sonypi_compat.fifo) == 0) && | ||
1951 | (file->f_flags & O_NONBLOCK)) | ||
1952 | return -EAGAIN; | ||
1953 | |||
1954 | ret = wait_event_interruptible(sonypi_compat.fifo_proc_list, | ||
1955 | kfifo_len(sonypi_compat.fifo) != 0); | ||
1956 | if (ret) | ||
1957 | return ret; | ||
1958 | |||
1959 | while (ret < count && | ||
1960 | (kfifo_get(sonypi_compat.fifo, &c, sizeof(c)) == sizeof(c))) { | ||
1961 | if (put_user(c, buf++)) | ||
1962 | return -EFAULT; | ||
1963 | ret++; | ||
1964 | } | ||
1965 | |||
1966 | if (ret > 0) { | ||
1967 | struct inode *inode = file->f_path.dentry->d_inode; | ||
1968 | inode->i_atime = current_fs_time(inode->i_sb); | ||
1969 | } | ||
1970 | |||
1971 | return ret; | ||
1972 | } | ||
1973 | |||
1974 | static unsigned int sonypi_misc_poll(struct file *file, poll_table *wait) | ||
1975 | { | ||
1976 | poll_wait(file, &sonypi_compat.fifo_proc_list, wait); | ||
1977 | if (kfifo_len(sonypi_compat.fifo)) | ||
1978 | return POLLIN | POLLRDNORM; | ||
1979 | return 0; | ||
1980 | } | ||
1981 | |||
1982 | static int ec_read16(u8 addr, u16 *value) | ||
1983 | { | ||
1984 | u8 val_lb, val_hb; | ||
1985 | if (ec_read(addr, &val_lb)) | ||
1986 | return -1; | ||
1987 | if (ec_read(addr + 1, &val_hb)) | ||
1988 | return -1; | ||
1989 | *value = val_lb | (val_hb << 8); | ||
1990 | return 0; | ||
1991 | } | ||
1992 | |||
1993 | static int sonypi_misc_ioctl(struct inode *ip, struct file *fp, | ||
1994 | unsigned int cmd, unsigned long arg) | ||
1995 | { | ||
1996 | int ret = 0; | ||
1997 | void __user *argp = (void __user *)arg; | ||
1998 | u8 val8; | ||
1999 | u16 val16; | ||
2000 | int value; | ||
2001 | |||
2002 | mutex_lock(&spic_dev.lock); | ||
2003 | switch (cmd) { | ||
2004 | case SONYPI_IOCGBRT: | ||
2005 | if (sony_backlight_device == NULL) { | ||
2006 | ret = -EIO; | ||
2007 | break; | ||
2008 | } | ||
2009 | if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value)) { | ||
2010 | ret = -EIO; | ||
2011 | break; | ||
2012 | } | ||
2013 | val8 = ((value & 0xff) - 1) << 5; | ||
2014 | if (copy_to_user(argp, &val8, sizeof(val8))) | ||
2015 | ret = -EFAULT; | ||
2016 | break; | ||
2017 | case SONYPI_IOCSBRT: | ||
2018 | if (sony_backlight_device == NULL) { | ||
2019 | ret = -EIO; | ||
2020 | break; | ||
2021 | } | ||
2022 | if (copy_from_user(&val8, argp, sizeof(val8))) { | ||
2023 | ret = -EFAULT; | ||
2024 | break; | ||
2025 | } | ||
2026 | if (acpi_callsetfunc(sony_nc_acpi_handle, "SBRT", | ||
2027 | (val8 >> 5) + 1, NULL)) { | ||
2028 | ret = -EIO; | ||
2029 | break; | ||
2030 | } | ||
2031 | /* sync the backlight device status */ | ||
2032 | sony_backlight_device->props.brightness = | ||
2033 | sony_backlight_get_brightness(sony_backlight_device); | ||
2034 | break; | ||
2035 | case SONYPI_IOCGBAT1CAP: | ||
2036 | if (ec_read16(SONYPI_BAT1_FULL, &val16)) { | ||
2037 | ret = -EIO; | ||
2038 | break; | ||
2039 | } | ||
2040 | if (copy_to_user(argp, &val16, sizeof(val16))) | ||
2041 | ret = -EFAULT; | ||
2042 | break; | ||
2043 | case SONYPI_IOCGBAT1REM: | ||
2044 | if (ec_read16(SONYPI_BAT1_LEFT, &val16)) { | ||
2045 | ret = -EIO; | ||
2046 | break; | ||
2047 | } | ||
2048 | if (copy_to_user(argp, &val16, sizeof(val16))) | ||
2049 | ret = -EFAULT; | ||
2050 | break; | ||
2051 | case SONYPI_IOCGBAT2CAP: | ||
2052 | if (ec_read16(SONYPI_BAT2_FULL, &val16)) { | ||
2053 | ret = -EIO; | ||
2054 | break; | ||
2055 | } | ||
2056 | if (copy_to_user(argp, &val16, sizeof(val16))) | ||
2057 | ret = -EFAULT; | ||
2058 | break; | ||
2059 | case SONYPI_IOCGBAT2REM: | ||
2060 | if (ec_read16(SONYPI_BAT2_LEFT, &val16)) { | ||
2061 | ret = -EIO; | ||
2062 | break; | ||
2063 | } | ||
2064 | if (copy_to_user(argp, &val16, sizeof(val16))) | ||
2065 | ret = -EFAULT; | ||
2066 | break; | ||
2067 | case SONYPI_IOCGBATFLAGS: | ||
2068 | if (ec_read(SONYPI_BAT_FLAGS, &val8)) { | ||
2069 | ret = -EIO; | ||
2070 | break; | ||
2071 | } | ||
2072 | val8 &= 0x07; | ||
2073 | if (copy_to_user(argp, &val8, sizeof(val8))) | ||
2074 | ret = -EFAULT; | ||
2075 | break; | ||
2076 | case SONYPI_IOCGBLUE: | ||
2077 | val8 = spic_dev.bluetooth_power; | ||
2078 | if (copy_to_user(argp, &val8, sizeof(val8))) | ||
2079 | ret = -EFAULT; | ||
2080 | break; | ||
2081 | case SONYPI_IOCSBLUE: | ||
2082 | if (copy_from_user(&val8, argp, sizeof(val8))) { | ||
2083 | ret = -EFAULT; | ||
2084 | break; | ||
2085 | } | ||
2086 | __sony_pic_set_bluetoothpower(val8); | ||
2087 | break; | ||
2088 | /* FAN Controls */ | ||
2089 | case SONYPI_IOCGFAN: | ||
2090 | if (sony_pic_get_fanspeed(&val8)) { | ||
2091 | ret = -EIO; | ||
2092 | break; | ||
2093 | } | ||
2094 | if (copy_to_user(argp, &val8, sizeof(val8))) | ||
2095 | ret = -EFAULT; | ||
2096 | break; | ||
2097 | case SONYPI_IOCSFAN: | ||
2098 | if (copy_from_user(&val8, argp, sizeof(val8))) { | ||
2099 | ret = -EFAULT; | ||
2100 | break; | ||
2101 | } | ||
2102 | if (sony_pic_set_fanspeed(val8)) | ||
2103 | ret = -EIO; | ||
2104 | break; | ||
2105 | /* GET Temperature (useful under APM) */ | ||
2106 | case SONYPI_IOCGTEMP: | ||
2107 | if (ec_read(SONYPI_TEMP_STATUS, &val8)) { | ||
2108 | ret = -EIO; | ||
2109 | break; | ||
2110 | } | ||
2111 | if (copy_to_user(argp, &val8, sizeof(val8))) | ||
2112 | ret = -EFAULT; | ||
2113 | break; | ||
2114 | default: | ||
2115 | ret = -EINVAL; | ||
2116 | } | ||
2117 | mutex_unlock(&spic_dev.lock); | ||
2118 | return ret; | ||
2119 | } | ||
2120 | |||
2121 | static const struct file_operations sonypi_misc_fops = { | ||
2122 | .owner = THIS_MODULE, | ||
2123 | .read = sonypi_misc_read, | ||
2124 | .poll = sonypi_misc_poll, | ||
2125 | .open = sonypi_misc_open, | ||
2126 | .release = sonypi_misc_release, | ||
2127 | .fasync = sonypi_misc_fasync, | ||
2128 | .ioctl = sonypi_misc_ioctl, | ||
2129 | }; | ||
2130 | |||
2131 | static struct miscdevice sonypi_misc_device = { | ||
2132 | .minor = MISC_DYNAMIC_MINOR, | ||
2133 | .name = "sonypi", | ||
2134 | .fops = &sonypi_misc_fops, | ||
2135 | }; | ||
2136 | |||
2137 | static void sonypi_compat_report_event(u8 event) | ||
2138 | { | ||
2139 | kfifo_put(sonypi_compat.fifo, (unsigned char *)&event, sizeof(event)); | ||
2140 | kill_fasync(&sonypi_compat.fifo_async, SIGIO, POLL_IN); | ||
2141 | wake_up_interruptible(&sonypi_compat.fifo_proc_list); | ||
2142 | } | ||
2143 | |||
2144 | static int sonypi_compat_init(void) | ||
2145 | { | ||
2146 | int error; | ||
2147 | |||
2148 | spin_lock_init(&sonypi_compat.fifo_lock); | ||
2149 | sonypi_compat.fifo = kfifo_alloc(SONY_LAPTOP_BUF_SIZE, GFP_KERNEL, | ||
2150 | &sonypi_compat.fifo_lock); | ||
2151 | if (IS_ERR(sonypi_compat.fifo)) { | ||
2152 | printk(KERN_ERR DRV_PFX "kfifo_alloc failed\n"); | ||
2153 | return PTR_ERR(sonypi_compat.fifo); | ||
2154 | } | ||
2155 | |||
2156 | init_waitqueue_head(&sonypi_compat.fifo_proc_list); | ||
2157 | |||
2158 | if (minor != -1) | ||
2159 | sonypi_misc_device.minor = minor; | ||
2160 | error = misc_register(&sonypi_misc_device); | ||
2161 | if (error) { | ||
2162 | printk(KERN_ERR DRV_PFX "misc_register failed\n"); | ||
2163 | goto err_free_kfifo; | ||
2164 | } | ||
2165 | if (minor == -1) | ||
2166 | printk(KERN_INFO DRV_PFX "device allocated minor is %d\n", | ||
2167 | sonypi_misc_device.minor); | ||
2168 | |||
2169 | return 0; | ||
2170 | |||
2171 | err_free_kfifo: | ||
2172 | kfifo_free(sonypi_compat.fifo); | ||
2173 | return error; | ||
2174 | } | ||
2175 | |||
2176 | static void sonypi_compat_exit(void) | ||
2177 | { | ||
2178 | misc_deregister(&sonypi_misc_device); | ||
2179 | kfifo_free(sonypi_compat.fifo); | ||
2180 | } | ||
2181 | #else | ||
2182 | static int sonypi_compat_init(void) { return 0; } | ||
2183 | static void sonypi_compat_exit(void) { } | ||
2184 | static void sonypi_compat_report_event(u8 event) { } | ||
2185 | #endif /* CONFIG_SONYPI_COMPAT */ | ||
2186 | |||
2187 | /* | ||
2188 | * ACPI callbacks | ||
2189 | */ | ||
2190 | static acpi_status | ||
2191 | sony_pic_read_possible_resource(struct acpi_resource *resource, void *context) | ||
2192 | { | ||
2193 | u32 i; | ||
2194 | struct sony_pic_dev *dev = (struct sony_pic_dev *)context; | ||
2195 | |||
2196 | switch (resource->type) { | ||
2197 | case ACPI_RESOURCE_TYPE_START_DEPENDENT: | ||
2198 | { | ||
2199 | /* start IO enumeration */ | ||
2200 | struct sony_pic_ioport *ioport = kzalloc(sizeof(*ioport), GFP_KERNEL); | ||
2201 | if (!ioport) | ||
2202 | return AE_ERROR; | ||
2203 | |||
2204 | list_add(&ioport->list, &dev->ioports); | ||
2205 | return AE_OK; | ||
2206 | } | ||
2207 | |||
2208 | case ACPI_RESOURCE_TYPE_END_DEPENDENT: | ||
2209 | /* end IO enumeration */ | ||
2210 | return AE_OK; | ||
2211 | |||
2212 | case ACPI_RESOURCE_TYPE_IRQ: | ||
2213 | { | ||
2214 | struct acpi_resource_irq *p = &resource->data.irq; | ||
2215 | struct sony_pic_irq *interrupt = NULL; | ||
2216 | if (!p || !p->interrupt_count) { | ||
2217 | /* | ||
2218 | * IRQ descriptors may have no IRQ# bits set, | ||
2219 | * particularly those those w/ _STA disabled | ||
2220 | */ | ||
2221 | dprintk("Blank IRQ resource\n"); | ||
2222 | return AE_OK; | ||
2223 | } | ||
2224 | for (i = 0; i < p->interrupt_count; i++) { | ||
2225 | if (!p->interrupts[i]) { | ||
2226 | printk(KERN_WARNING DRV_PFX | ||
2227 | "Invalid IRQ %d\n", | ||
2228 | p->interrupts[i]); | ||
2229 | continue; | ||
2230 | } | ||
2231 | interrupt = kzalloc(sizeof(*interrupt), | ||
2232 | GFP_KERNEL); | ||
2233 | if (!interrupt) | ||
2234 | return AE_ERROR; | ||
2235 | |||
2236 | list_add(&interrupt->list, &dev->interrupts); | ||
2237 | interrupt->irq.triggering = p->triggering; | ||
2238 | interrupt->irq.polarity = p->polarity; | ||
2239 | interrupt->irq.sharable = p->sharable; | ||
2240 | interrupt->irq.interrupt_count = 1; | ||
2241 | interrupt->irq.interrupts[0] = p->interrupts[i]; | ||
2242 | } | ||
2243 | return AE_OK; | ||
2244 | } | ||
2245 | case ACPI_RESOURCE_TYPE_IO: | ||
2246 | { | ||
2247 | struct acpi_resource_io *io = &resource->data.io; | ||
2248 | struct sony_pic_ioport *ioport = | ||
2249 | list_first_entry(&dev->ioports, struct sony_pic_ioport, list); | ||
2250 | if (!io) { | ||
2251 | dprintk("Blank IO resource\n"); | ||
2252 | return AE_OK; | ||
2253 | } | ||
2254 | |||
2255 | if (!ioport->io1.minimum) { | ||
2256 | memcpy(&ioport->io1, io, sizeof(*io)); | ||
2257 | dprintk("IO1 at 0x%.4x (0x%.2x)\n", ioport->io1.minimum, | ||
2258 | ioport->io1.address_length); | ||
2259 | } | ||
2260 | else if (!ioport->io2.minimum) { | ||
2261 | memcpy(&ioport->io2, io, sizeof(*io)); | ||
2262 | dprintk("IO2 at 0x%.4x (0x%.2x)\n", ioport->io2.minimum, | ||
2263 | ioport->io2.address_length); | ||
2264 | } | ||
2265 | else { | ||
2266 | printk(KERN_ERR DRV_PFX "Unknown SPIC Type, more than 2 IO Ports\n"); | ||
2267 | return AE_ERROR; | ||
2268 | } | ||
2269 | return AE_OK; | ||
2270 | } | ||
2271 | default: | ||
2272 | dprintk("Resource %d isn't an IRQ nor an IO port\n", | ||
2273 | resource->type); | ||
2274 | |||
2275 | case ACPI_RESOURCE_TYPE_END_TAG: | ||
2276 | return AE_OK; | ||
2277 | } | ||
2278 | return AE_CTRL_TERMINATE; | ||
2279 | } | ||
2280 | |||
2281 | static int sony_pic_possible_resources(struct acpi_device *device) | ||
2282 | { | ||
2283 | int result = 0; | ||
2284 | acpi_status status = AE_OK; | ||
2285 | |||
2286 | if (!device) | ||
2287 | return -EINVAL; | ||
2288 | |||
2289 | /* get device status */ | ||
2290 | /* see acpi_pci_link_get_current acpi_pci_link_get_possible */ | ||
2291 | dprintk("Evaluating _STA\n"); | ||
2292 | result = acpi_bus_get_status(device); | ||
2293 | if (result) { | ||
2294 | printk(KERN_WARNING DRV_PFX "Unable to read status\n"); | ||
2295 | goto end; | ||
2296 | } | ||
2297 | |||
2298 | if (!device->status.enabled) | ||
2299 | dprintk("Device disabled\n"); | ||
2300 | else | ||
2301 | dprintk("Device enabled\n"); | ||
2302 | |||
2303 | /* | ||
2304 | * Query and parse 'method' | ||
2305 | */ | ||
2306 | dprintk("Evaluating %s\n", METHOD_NAME__PRS); | ||
2307 | status = acpi_walk_resources(device->handle, METHOD_NAME__PRS, | ||
2308 | sony_pic_read_possible_resource, &spic_dev); | ||
2309 | if (ACPI_FAILURE(status)) { | ||
2310 | printk(KERN_WARNING DRV_PFX | ||
2311 | "Failure evaluating %s\n", | ||
2312 | METHOD_NAME__PRS); | ||
2313 | result = -ENODEV; | ||
2314 | } | ||
2315 | end: | ||
2316 | return result; | ||
2317 | } | ||
2318 | |||
2319 | /* | ||
2320 | * Disable the spic device by calling its _DIS method | ||
2321 | */ | ||
2322 | static int sony_pic_disable(struct acpi_device *device) | ||
2323 | { | ||
2324 | acpi_status ret = acpi_evaluate_object(device->handle, "_DIS", NULL, | ||
2325 | NULL); | ||
2326 | |||
2327 | if (ACPI_FAILURE(ret) && ret != AE_NOT_FOUND) | ||
2328 | return -ENXIO; | ||
2329 | |||
2330 | dprintk("Device disabled\n"); | ||
2331 | return 0; | ||
2332 | } | ||
2333 | |||
2334 | |||
2335 | /* | ||
2336 | * Based on drivers/acpi/pci_link.c:acpi_pci_link_set | ||
2337 | * | ||
2338 | * Call _SRS to set current resources | ||
2339 | */ | ||
2340 | static int sony_pic_enable(struct acpi_device *device, | ||
2341 | struct sony_pic_ioport *ioport, struct sony_pic_irq *irq) | ||
2342 | { | ||
2343 | acpi_status status; | ||
2344 | int result = 0; | ||
2345 | /* Type 1 resource layout is: | ||
2346 | * IO | ||
2347 | * IO | ||
2348 | * IRQNoFlags | ||
2349 | * End | ||
2350 | * | ||
2351 | * Type 2 and 3 resource layout is: | ||
2352 | * IO | ||
2353 | * IRQNoFlags | ||
2354 | * End | ||
2355 | */ | ||
2356 | struct { | ||
2357 | struct acpi_resource res1; | ||
2358 | struct acpi_resource res2; | ||
2359 | struct acpi_resource res3; | ||
2360 | struct acpi_resource res4; | ||
2361 | } *resource; | ||
2362 | struct acpi_buffer buffer = { 0, NULL }; | ||
2363 | |||
2364 | if (!ioport || !irq) | ||
2365 | return -EINVAL; | ||
2366 | |||
2367 | /* init acpi_buffer */ | ||
2368 | resource = kzalloc(sizeof(*resource) + 1, GFP_KERNEL); | ||
2369 | if (!resource) | ||
2370 | return -ENOMEM; | ||
2371 | |||
2372 | buffer.length = sizeof(*resource) + 1; | ||
2373 | buffer.pointer = resource; | ||
2374 | |||
2375 | /* setup Type 1 resources */ | ||
2376 | if (spic_dev.control->model == SONYPI_DEVICE_TYPE1) { | ||
2377 | |||
2378 | /* setup io resources */ | ||
2379 | resource->res1.type = ACPI_RESOURCE_TYPE_IO; | ||
2380 | resource->res1.length = sizeof(struct acpi_resource); | ||
2381 | memcpy(&resource->res1.data.io, &ioport->io1, | ||
2382 | sizeof(struct acpi_resource_io)); | ||
2383 | |||
2384 | resource->res2.type = ACPI_RESOURCE_TYPE_IO; | ||
2385 | resource->res2.length = sizeof(struct acpi_resource); | ||
2386 | memcpy(&resource->res2.data.io, &ioport->io2, | ||
2387 | sizeof(struct acpi_resource_io)); | ||
2388 | |||
2389 | /* setup irq resource */ | ||
2390 | resource->res3.type = ACPI_RESOURCE_TYPE_IRQ; | ||
2391 | resource->res3.length = sizeof(struct acpi_resource); | ||
2392 | memcpy(&resource->res3.data.irq, &irq->irq, | ||
2393 | sizeof(struct acpi_resource_irq)); | ||
2394 | /* we requested a shared irq */ | ||
2395 | resource->res3.data.irq.sharable = ACPI_SHARED; | ||
2396 | |||
2397 | resource->res4.type = ACPI_RESOURCE_TYPE_END_TAG; | ||
2398 | |||
2399 | } | ||
2400 | /* setup Type 2/3 resources */ | ||
2401 | else { | ||
2402 | /* setup io resource */ | ||
2403 | resource->res1.type = ACPI_RESOURCE_TYPE_IO; | ||
2404 | resource->res1.length = sizeof(struct acpi_resource); | ||
2405 | memcpy(&resource->res1.data.io, &ioport->io1, | ||
2406 | sizeof(struct acpi_resource_io)); | ||
2407 | |||
2408 | /* setup irq resource */ | ||
2409 | resource->res2.type = ACPI_RESOURCE_TYPE_IRQ; | ||
2410 | resource->res2.length = sizeof(struct acpi_resource); | ||
2411 | memcpy(&resource->res2.data.irq, &irq->irq, | ||
2412 | sizeof(struct acpi_resource_irq)); | ||
2413 | /* we requested a shared irq */ | ||
2414 | resource->res2.data.irq.sharable = ACPI_SHARED; | ||
2415 | |||
2416 | resource->res3.type = ACPI_RESOURCE_TYPE_END_TAG; | ||
2417 | } | ||
2418 | |||
2419 | /* Attempt to set the resource */ | ||
2420 | dprintk("Evaluating _SRS\n"); | ||
2421 | status = acpi_set_current_resources(device->handle, &buffer); | ||
2422 | |||
2423 | /* check for total failure */ | ||
2424 | if (ACPI_FAILURE(status)) { | ||
2425 | printk(KERN_ERR DRV_PFX "Error evaluating _SRS\n"); | ||
2426 | result = -ENODEV; | ||
2427 | goto end; | ||
2428 | } | ||
2429 | |||
2430 | /* Necessary device initializations calls (from sonypi) */ | ||
2431 | sony_pic_call1(0x82); | ||
2432 | sony_pic_call2(0x81, 0xff); | ||
2433 | sony_pic_call1(compat ? 0x92 : 0x82); | ||
2434 | |||
2435 | end: | ||
2436 | kfree(resource); | ||
2437 | return result; | ||
2438 | } | ||
2439 | |||
2440 | /***************** | ||
2441 | * | ||
2442 | * ISR: some event is available | ||
2443 | * | ||
2444 | *****************/ | ||
2445 | static irqreturn_t sony_pic_irq(int irq, void *dev_id) | ||
2446 | { | ||
2447 | int i, j; | ||
2448 | u8 ev = 0; | ||
2449 | u8 data_mask = 0; | ||
2450 | u8 device_event = 0; | ||
2451 | |||
2452 | struct sony_pic_dev *dev = (struct sony_pic_dev *) dev_id; | ||
2453 | |||
2454 | ev = inb_p(dev->cur_ioport->io1.minimum); | ||
2455 | if (dev->cur_ioport->io2.minimum) | ||
2456 | data_mask = inb_p(dev->cur_ioport->io2.minimum); | ||
2457 | else | ||
2458 | data_mask = inb_p(dev->cur_ioport->io1.minimum + | ||
2459 | dev->control->evport_offset); | ||
2460 | |||
2461 | dprintk("event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n", | ||
2462 | ev, data_mask, dev->cur_ioport->io1.minimum, | ||
2463 | dev->control->evport_offset); | ||
2464 | |||
2465 | if (ev == 0x00 || ev == 0xff) | ||
2466 | return IRQ_HANDLED; | ||
2467 | |||
2468 | for (i = 0; dev->control->event_types[i].mask; i++) { | ||
2469 | |||
2470 | if ((data_mask & dev->control->event_types[i].data) != | ||
2471 | dev->control->event_types[i].data) | ||
2472 | continue; | ||
2473 | |||
2474 | if (!(mask & dev->control->event_types[i].mask)) | ||
2475 | continue; | ||
2476 | |||
2477 | for (j = 0; dev->control->event_types[i].events[j].event; j++) { | ||
2478 | if (ev == dev->control->event_types[i].events[j].data) { | ||
2479 | device_event = | ||
2480 | dev->control-> | ||
2481 | event_types[i].events[j].event; | ||
2482 | goto found; | ||
2483 | } | ||
2484 | } | ||
2485 | } | ||
2486 | /* Still not able to decode the event try to pass | ||
2487 | * it over to the minidriver | ||
2488 | */ | ||
2489 | if (dev->control->handle_irq && | ||
2490 | dev->control->handle_irq(data_mask, ev) == 0) | ||
2491 | return IRQ_HANDLED; | ||
2492 | |||
2493 | dprintk("unknown event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n", | ||
2494 | ev, data_mask, dev->cur_ioport->io1.minimum, | ||
2495 | dev->control->evport_offset); | ||
2496 | return IRQ_HANDLED; | ||
2497 | |||
2498 | found: | ||
2499 | sony_laptop_report_input_event(device_event); | ||
2500 | acpi_bus_generate_proc_event(dev->acpi_dev, 1, device_event); | ||
2501 | sonypi_compat_report_event(device_event); | ||
2502 | |||
2503 | return IRQ_HANDLED; | ||
2504 | } | ||
2505 | |||
2506 | /***************** | ||
2507 | * | ||
2508 | * ACPI driver | ||
2509 | * | ||
2510 | *****************/ | ||
2511 | static int sony_pic_remove(struct acpi_device *device, int type) | ||
2512 | { | ||
2513 | struct sony_pic_ioport *io, *tmp_io; | ||
2514 | struct sony_pic_irq *irq, *tmp_irq; | ||
2515 | |||
2516 | if (sony_pic_disable(device)) { | ||
2517 | printk(KERN_ERR DRV_PFX "Couldn't disable device.\n"); | ||
2518 | return -ENXIO; | ||
2519 | } | ||
2520 | |||
2521 | free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev); | ||
2522 | release_region(spic_dev.cur_ioport->io1.minimum, | ||
2523 | spic_dev.cur_ioport->io1.address_length); | ||
2524 | if (spic_dev.cur_ioport->io2.minimum) | ||
2525 | release_region(spic_dev.cur_ioport->io2.minimum, | ||
2526 | spic_dev.cur_ioport->io2.address_length); | ||
2527 | |||
2528 | sonypi_compat_exit(); | ||
2529 | |||
2530 | sony_laptop_remove_input(); | ||
2531 | |||
2532 | /* pf attrs */ | ||
2533 | sysfs_remove_group(&sony_pf_device->dev.kobj, &spic_attribute_group); | ||
2534 | sony_pf_remove(); | ||
2535 | |||
2536 | list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) { | ||
2537 | list_del(&io->list); | ||
2538 | kfree(io); | ||
2539 | } | ||
2540 | list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) { | ||
2541 | list_del(&irq->list); | ||
2542 | kfree(irq); | ||
2543 | } | ||
2544 | spic_dev.cur_ioport = NULL; | ||
2545 | spic_dev.cur_irq = NULL; | ||
2546 | |||
2547 | dprintk(SONY_PIC_DRIVER_NAME " removed.\n"); | ||
2548 | return 0; | ||
2549 | } | ||
2550 | |||
2551 | static int sony_pic_add(struct acpi_device *device) | ||
2552 | { | ||
2553 | int result; | ||
2554 | struct sony_pic_ioport *io, *tmp_io; | ||
2555 | struct sony_pic_irq *irq, *tmp_irq; | ||
2556 | |||
2557 | printk(KERN_INFO DRV_PFX "%s v%s.\n", | ||
2558 | SONY_PIC_DRIVER_NAME, SONY_LAPTOP_DRIVER_VERSION); | ||
2559 | |||
2560 | spic_dev.acpi_dev = device; | ||
2561 | strcpy(acpi_device_class(device), "sony/hotkey"); | ||
2562 | sony_pic_detect_device_type(&spic_dev); | ||
2563 | mutex_init(&spic_dev.lock); | ||
2564 | |||
2565 | /* read _PRS resources */ | ||
2566 | result = sony_pic_possible_resources(device); | ||
2567 | if (result) { | ||
2568 | printk(KERN_ERR DRV_PFX | ||
2569 | "Unabe to read possible resources.\n"); | ||
2570 | goto err_free_resources; | ||
2571 | } | ||
2572 | |||
2573 | /* setup input devices and helper fifo */ | ||
2574 | result = sony_laptop_setup_input(device); | ||
2575 | if (result) { | ||
2576 | printk(KERN_ERR DRV_PFX | ||
2577 | "Unabe to create input devices.\n"); | ||
2578 | goto err_free_resources; | ||
2579 | } | ||
2580 | |||
2581 | if (sonypi_compat_init()) | ||
2582 | goto err_remove_input; | ||
2583 | |||
2584 | /* request io port */ | ||
2585 | list_for_each_entry_reverse(io, &spic_dev.ioports, list) { | ||
2586 | if (request_region(io->io1.minimum, io->io1.address_length, | ||
2587 | "Sony Programable I/O Device")) { | ||
2588 | dprintk("I/O port1: 0x%.4x (0x%.4x) + 0x%.2x\n", | ||
2589 | io->io1.minimum, io->io1.maximum, | ||
2590 | io->io1.address_length); | ||
2591 | /* Type 1 have 2 ioports */ | ||
2592 | if (io->io2.minimum) { | ||
2593 | if (request_region(io->io2.minimum, | ||
2594 | io->io2.address_length, | ||
2595 | "Sony Programable I/O Device")) { | ||
2596 | dprintk("I/O port2: 0x%.4x (0x%.4x) + 0x%.2x\n", | ||
2597 | io->io2.minimum, io->io2.maximum, | ||
2598 | io->io2.address_length); | ||
2599 | spic_dev.cur_ioport = io; | ||
2600 | break; | ||
2601 | } | ||
2602 | else { | ||
2603 | dprintk("Unable to get I/O port2: " | ||
2604 | "0x%.4x (0x%.4x) + 0x%.2x\n", | ||
2605 | io->io2.minimum, io->io2.maximum, | ||
2606 | io->io2.address_length); | ||
2607 | release_region(io->io1.minimum, | ||
2608 | io->io1.address_length); | ||
2609 | } | ||
2610 | } | ||
2611 | else { | ||
2612 | spic_dev.cur_ioport = io; | ||
2613 | break; | ||
2614 | } | ||
2615 | } | ||
2616 | } | ||
2617 | if (!spic_dev.cur_ioport) { | ||
2618 | printk(KERN_ERR DRV_PFX "Failed to request_region.\n"); | ||
2619 | result = -ENODEV; | ||
2620 | goto err_remove_compat; | ||
2621 | } | ||
2622 | |||
2623 | /* request IRQ */ | ||
2624 | list_for_each_entry_reverse(irq, &spic_dev.interrupts, list) { | ||
2625 | if (!request_irq(irq->irq.interrupts[0], sony_pic_irq, | ||
2626 | IRQF_SHARED, "sony-laptop", &spic_dev)) { | ||
2627 | dprintk("IRQ: %d - triggering: %d - " | ||
2628 | "polarity: %d - shr: %d\n", | ||
2629 | irq->irq.interrupts[0], | ||
2630 | irq->irq.triggering, | ||
2631 | irq->irq.polarity, | ||
2632 | irq->irq.sharable); | ||
2633 | spic_dev.cur_irq = irq; | ||
2634 | break; | ||
2635 | } | ||
2636 | } | ||
2637 | if (!spic_dev.cur_irq) { | ||
2638 | printk(KERN_ERR DRV_PFX "Failed to request_irq.\n"); | ||
2639 | result = -ENODEV; | ||
2640 | goto err_release_region; | ||
2641 | } | ||
2642 | |||
2643 | /* set resource status _SRS */ | ||
2644 | result = sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq); | ||
2645 | if (result) { | ||
2646 | printk(KERN_ERR DRV_PFX "Couldn't enable device.\n"); | ||
2647 | goto err_free_irq; | ||
2648 | } | ||
2649 | |||
2650 | spic_dev.bluetooth_power = -1; | ||
2651 | /* create device attributes */ | ||
2652 | result = sony_pf_add(); | ||
2653 | if (result) | ||
2654 | goto err_disable_device; | ||
2655 | |||
2656 | result = sysfs_create_group(&sony_pf_device->dev.kobj, &spic_attribute_group); | ||
2657 | if (result) | ||
2658 | goto err_remove_pf; | ||
2659 | |||
2660 | return 0; | ||
2661 | |||
2662 | err_remove_pf: | ||
2663 | sony_pf_remove(); | ||
2664 | |||
2665 | err_disable_device: | ||
2666 | sony_pic_disable(device); | ||
2667 | |||
2668 | err_free_irq: | ||
2669 | free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev); | ||
2670 | |||
2671 | err_release_region: | ||
2672 | release_region(spic_dev.cur_ioport->io1.minimum, | ||
2673 | spic_dev.cur_ioport->io1.address_length); | ||
2674 | if (spic_dev.cur_ioport->io2.minimum) | ||
2675 | release_region(spic_dev.cur_ioport->io2.minimum, | ||
2676 | spic_dev.cur_ioport->io2.address_length); | ||
2677 | |||
2678 | err_remove_compat: | ||
2679 | sonypi_compat_exit(); | ||
2680 | |||
2681 | err_remove_input: | ||
2682 | sony_laptop_remove_input(); | ||
2683 | |||
2684 | err_free_resources: | ||
2685 | list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) { | ||
2686 | list_del(&io->list); | ||
2687 | kfree(io); | ||
2688 | } | ||
2689 | list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) { | ||
2690 | list_del(&irq->list); | ||
2691 | kfree(irq); | ||
2692 | } | ||
2693 | spic_dev.cur_ioport = NULL; | ||
2694 | spic_dev.cur_irq = NULL; | ||
2695 | |||
2696 | return result; | ||
2697 | } | ||
2698 | |||
2699 | static int sony_pic_suspend(struct acpi_device *device, pm_message_t state) | ||
2700 | { | ||
2701 | if (sony_pic_disable(device)) | ||
2702 | return -ENXIO; | ||
2703 | return 0; | ||
2704 | } | ||
2705 | |||
2706 | static int sony_pic_resume(struct acpi_device *device) | ||
2707 | { | ||
2708 | sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq); | ||
2709 | return 0; | ||
2710 | } | ||
2711 | |||
2712 | static const struct acpi_device_id sony_pic_device_ids[] = { | ||
2713 | {SONY_PIC_HID, 0}, | ||
2714 | {"", 0}, | ||
2715 | }; | ||
2716 | |||
2717 | static struct acpi_driver sony_pic_driver = { | ||
2718 | .name = SONY_PIC_DRIVER_NAME, | ||
2719 | .class = SONY_PIC_CLASS, | ||
2720 | .ids = sony_pic_device_ids, | ||
2721 | .owner = THIS_MODULE, | ||
2722 | .ops = { | ||
2723 | .add = sony_pic_add, | ||
2724 | .remove = sony_pic_remove, | ||
2725 | .suspend = sony_pic_suspend, | ||
2726 | .resume = sony_pic_resume, | ||
2727 | }, | ||
2728 | }; | ||
2729 | |||
2730 | static struct dmi_system_id __initdata sonypi_dmi_table[] = { | ||
2731 | { | ||
2732 | .ident = "Sony Vaio", | ||
2733 | .matches = { | ||
2734 | DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | ||
2735 | DMI_MATCH(DMI_PRODUCT_NAME, "PCG-"), | ||
2736 | }, | ||
2737 | }, | ||
2738 | { | ||
2739 | .ident = "Sony Vaio", | ||
2740 | .matches = { | ||
2741 | DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | ||
2742 | DMI_MATCH(DMI_PRODUCT_NAME, "VGN-"), | ||
2743 | }, | ||
2744 | }, | ||
2745 | { } | ||
2746 | }; | ||
2747 | |||
2748 | static int __init sony_laptop_init(void) | ||
2749 | { | ||
2750 | int result; | ||
2751 | |||
2752 | if (!no_spic && dmi_check_system(sonypi_dmi_table)) { | ||
2753 | result = acpi_bus_register_driver(&sony_pic_driver); | ||
2754 | if (result) { | ||
2755 | printk(KERN_ERR DRV_PFX | ||
2756 | "Unable to register SPIC driver."); | ||
2757 | goto out; | ||
2758 | } | ||
2759 | } | ||
2760 | |||
2761 | result = acpi_bus_register_driver(&sony_nc_driver); | ||
2762 | if (result) { | ||
2763 | printk(KERN_ERR DRV_PFX "Unable to register SNC driver."); | ||
2764 | goto out_unregister_pic; | ||
2765 | } | ||
2766 | |||
2767 | return 0; | ||
2768 | |||
2769 | out_unregister_pic: | ||
2770 | if (!no_spic) | ||
2771 | acpi_bus_unregister_driver(&sony_pic_driver); | ||
2772 | out: | ||
2773 | return result; | ||
2774 | } | ||
2775 | |||
2776 | static void __exit sony_laptop_exit(void) | ||
2777 | { | ||
2778 | acpi_bus_unregister_driver(&sony_nc_driver); | ||
2779 | if (!no_spic) | ||
2780 | acpi_bus_unregister_driver(&sony_pic_driver); | ||
2781 | } | ||
2782 | |||
2783 | module_init(sony_laptop_init); | ||
2784 | module_exit(sony_laptop_exit); | ||
diff --git a/drivers/platform/x86/tc1100-wmi.c b/drivers/platform/x86/tc1100-wmi.c new file mode 100644 index 000000000000..b4a4aa9ee482 --- /dev/null +++ b/drivers/platform/x86/tc1100-wmi.c | |||
@@ -0,0 +1,289 @@ | |||
1 | /* | ||
2 | * HP Compaq TC1100 Tablet WMI Extras Driver | ||
3 | * | ||
4 | * Copyright (C) 2007 Carlos Corbacho <carlos@strangeworlds.co.uk> | ||
5 | * Copyright (C) 2004 Jamey Hicks <jamey.hicks@hp.com> | ||
6 | * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com> | ||
7 | * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com> | ||
8 | * | ||
9 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
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 (at | ||
14 | * your option) any later version. | ||
15 | * | ||
16 | * This program is distributed in the hope that it will be useful, but | ||
17 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
19 | * General Public License for more details. | ||
20 | * | ||
21 | * You should have received a copy of the GNU General Public License along | ||
22 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
23 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. | ||
24 | * | ||
25 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
26 | */ | ||
27 | |||
28 | #include <linux/kernel.h> | ||
29 | #include <linux/module.h> | ||
30 | #include <linux/init.h> | ||
31 | #include <linux/types.h> | ||
32 | #include <acpi/acpi.h> | ||
33 | #include <acpi/acpi_bus.h> | ||
34 | #include <acpi/acpi_drivers.h> | ||
35 | #include <linux/platform_device.h> | ||
36 | |||
37 | #define GUID "C364AC71-36DB-495A-8494-B439D472A505" | ||
38 | |||
39 | #define TC1100_INSTANCE_WIRELESS 1 | ||
40 | #define TC1100_INSTANCE_JOGDIAL 2 | ||
41 | |||
42 | #define TC1100_LOGPREFIX "tc1100-wmi: " | ||
43 | #define TC1100_INFO KERN_INFO TC1100_LOGPREFIX | ||
44 | |||
45 | MODULE_AUTHOR("Jamey Hicks, Carlos Corbacho"); | ||
46 | MODULE_DESCRIPTION("HP Compaq TC1100 Tablet WMI Extras"); | ||
47 | MODULE_LICENSE("GPL"); | ||
48 | MODULE_ALIAS("wmi:C364AC71-36DB-495A-8494-B439D472A505"); | ||
49 | |||
50 | static int tc1100_probe(struct platform_device *device); | ||
51 | static int tc1100_remove(struct platform_device *device); | ||
52 | static int tc1100_suspend(struct platform_device *device, pm_message_t state); | ||
53 | static int tc1100_resume(struct platform_device *device); | ||
54 | |||
55 | static struct platform_driver tc1100_driver = { | ||
56 | .driver = { | ||
57 | .name = "tc1100-wmi", | ||
58 | .owner = THIS_MODULE, | ||
59 | }, | ||
60 | .probe = tc1100_probe, | ||
61 | .remove = tc1100_remove, | ||
62 | .suspend = tc1100_suspend, | ||
63 | .resume = tc1100_resume, | ||
64 | }; | ||
65 | |||
66 | static struct platform_device *tc1100_device; | ||
67 | |||
68 | struct tc1100_data { | ||
69 | u32 wireless; | ||
70 | u32 jogdial; | ||
71 | }; | ||
72 | |||
73 | static struct tc1100_data suspend_data; | ||
74 | |||
75 | /* -------------------------------------------------------------------------- | ||
76 | Device Management | ||
77 | -------------------------------------------------------------------------- */ | ||
78 | |||
79 | static int get_state(u32 *out, u8 instance) | ||
80 | { | ||
81 | u32 tmp; | ||
82 | acpi_status status; | ||
83 | struct acpi_buffer result = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
84 | union acpi_object *obj; | ||
85 | |||
86 | if (!out) | ||
87 | return -EINVAL; | ||
88 | |||
89 | if (instance > 2) | ||
90 | return -ENODEV; | ||
91 | |||
92 | status = wmi_query_block(GUID, instance, &result); | ||
93 | if (ACPI_FAILURE(status)) | ||
94 | return -ENODEV; | ||
95 | |||
96 | obj = (union acpi_object *) result.pointer; | ||
97 | if (obj && obj->type == ACPI_TYPE_BUFFER && | ||
98 | obj->buffer.length == sizeof(u32)) { | ||
99 | tmp = *((u32 *) obj->buffer.pointer); | ||
100 | } else { | ||
101 | tmp = 0; | ||
102 | } | ||
103 | |||
104 | if (result.length > 0 && result.pointer) | ||
105 | kfree(result.pointer); | ||
106 | |||
107 | switch (instance) { | ||
108 | case TC1100_INSTANCE_WIRELESS: | ||
109 | *out = (tmp == 3) ? 1 : 0; | ||
110 | return 0; | ||
111 | case TC1100_INSTANCE_JOGDIAL: | ||
112 | *out = (tmp == 1) ? 1 : 0; | ||
113 | return 0; | ||
114 | default: | ||
115 | return -ENODEV; | ||
116 | } | ||
117 | } | ||
118 | |||
119 | static int set_state(u32 *in, u8 instance) | ||
120 | { | ||
121 | u32 value; | ||
122 | acpi_status status; | ||
123 | struct acpi_buffer input; | ||
124 | |||
125 | if (!in) | ||
126 | return -EINVAL; | ||
127 | |||
128 | if (instance > 2) | ||
129 | return -ENODEV; | ||
130 | |||
131 | switch (instance) { | ||
132 | case TC1100_INSTANCE_WIRELESS: | ||
133 | value = (*in) ? 1 : 2; | ||
134 | break; | ||
135 | case TC1100_INSTANCE_JOGDIAL: | ||
136 | value = (*in) ? 0 : 1; | ||
137 | break; | ||
138 | default: | ||
139 | return -ENODEV; | ||
140 | } | ||
141 | |||
142 | input.length = sizeof(u32); | ||
143 | input.pointer = &value; | ||
144 | |||
145 | status = wmi_set_block(GUID, instance, &input); | ||
146 | if (ACPI_FAILURE(status)) | ||
147 | return -ENODEV; | ||
148 | |||
149 | return 0; | ||
150 | } | ||
151 | |||
152 | /* -------------------------------------------------------------------------- | ||
153 | FS Interface (/sys) | ||
154 | -------------------------------------------------------------------------- */ | ||
155 | |||
156 | /* | ||
157 | * Read/ write bool sysfs macro | ||
158 | */ | ||
159 | #define show_set_bool(value, instance) \ | ||
160 | static ssize_t \ | ||
161 | show_bool_##value(struct device *dev, struct device_attribute *attr, \ | ||
162 | char *buf) \ | ||
163 | { \ | ||
164 | u32 result; \ | ||
165 | acpi_status status = get_state(&result, instance); \ | ||
166 | if (ACPI_SUCCESS(status)) \ | ||
167 | return sprintf(buf, "%d\n", result); \ | ||
168 | return sprintf(buf, "Read error\n"); \ | ||
169 | } \ | ||
170 | \ | ||
171 | static ssize_t \ | ||
172 | set_bool_##value(struct device *dev, struct device_attribute *attr, \ | ||
173 | const char *buf, size_t count) \ | ||
174 | { \ | ||
175 | u32 tmp = simple_strtoul(buf, NULL, 10); \ | ||
176 | acpi_status status = set_state(&tmp, instance); \ | ||
177 | if (ACPI_FAILURE(status)) \ | ||
178 | return -EINVAL; \ | ||
179 | return count; \ | ||
180 | } \ | ||
181 | static DEVICE_ATTR(value, S_IWUGO | S_IRUGO | S_IWUSR, \ | ||
182 | show_bool_##value, set_bool_##value); | ||
183 | |||
184 | show_set_bool(wireless, TC1100_INSTANCE_WIRELESS); | ||
185 | show_set_bool(jogdial, TC1100_INSTANCE_JOGDIAL); | ||
186 | |||
187 | static void remove_fs(void) | ||
188 | { | ||
189 | device_remove_file(&tc1100_device->dev, &dev_attr_wireless); | ||
190 | device_remove_file(&tc1100_device->dev, &dev_attr_jogdial); | ||
191 | } | ||
192 | |||
193 | static int add_fs(void) | ||
194 | { | ||
195 | int ret; | ||
196 | |||
197 | ret = device_create_file(&tc1100_device->dev, &dev_attr_wireless); | ||
198 | if (ret) | ||
199 | goto add_sysfs_error; | ||
200 | |||
201 | ret = device_create_file(&tc1100_device->dev, &dev_attr_jogdial); | ||
202 | if (ret) | ||
203 | goto add_sysfs_error; | ||
204 | |||
205 | return ret; | ||
206 | |||
207 | add_sysfs_error: | ||
208 | remove_fs(); | ||
209 | return ret; | ||
210 | } | ||
211 | |||
212 | /* -------------------------------------------------------------------------- | ||
213 | Driver Model | ||
214 | -------------------------------------------------------------------------- */ | ||
215 | |||
216 | static int tc1100_probe(struct platform_device *device) | ||
217 | { | ||
218 | int result = 0; | ||
219 | |||
220 | result = add_fs(); | ||
221 | return result; | ||
222 | } | ||
223 | |||
224 | |||
225 | static int tc1100_remove(struct platform_device *device) | ||
226 | { | ||
227 | remove_fs(); | ||
228 | return 0; | ||
229 | } | ||
230 | |||
231 | static int tc1100_suspend(struct platform_device *dev, pm_message_t state) | ||
232 | { | ||
233 | int ret; | ||
234 | |||
235 | ret = get_state(&suspend_data.wireless, TC1100_INSTANCE_WIRELESS); | ||
236 | if (ret) | ||
237 | return ret; | ||
238 | |||
239 | ret = get_state(&suspend_data.jogdial, TC1100_INSTANCE_JOGDIAL); | ||
240 | if (ret) | ||
241 | return ret; | ||
242 | |||
243 | return ret; | ||
244 | } | ||
245 | |||
246 | static int tc1100_resume(struct platform_device *dev) | ||
247 | { | ||
248 | int ret; | ||
249 | |||
250 | ret = set_state(&suspend_data.wireless, TC1100_INSTANCE_WIRELESS); | ||
251 | if (ret) | ||
252 | return ret; | ||
253 | |||
254 | ret = set_state(&suspend_data.jogdial, TC1100_INSTANCE_JOGDIAL); | ||
255 | if (ret) | ||
256 | return ret; | ||
257 | |||
258 | return ret; | ||
259 | } | ||
260 | |||
261 | static int __init tc1100_init(void) | ||
262 | { | ||
263 | int result = 0; | ||
264 | |||
265 | if (!wmi_has_guid(GUID)) | ||
266 | return -ENODEV; | ||
267 | |||
268 | result = platform_driver_register(&tc1100_driver); | ||
269 | if (result) | ||
270 | return result; | ||
271 | |||
272 | tc1100_device = platform_device_alloc("tc1100-wmi", -1); | ||
273 | platform_device_add(tc1100_device); | ||
274 | |||
275 | printk(TC1100_INFO "HP Compaq TC1100 Tablet WMI Extras loaded\n"); | ||
276 | |||
277 | return result; | ||
278 | } | ||
279 | |||
280 | static void __exit tc1100_exit(void) | ||
281 | { | ||
282 | platform_device_del(tc1100_device); | ||
283 | platform_driver_unregister(&tc1100_driver); | ||
284 | |||
285 | printk(TC1100_INFO "HP Compaq TC1100 Tablet WMI Extras unloaded\n"); | ||
286 | } | ||
287 | |||
288 | module_init(tc1100_init); | ||
289 | module_exit(tc1100_exit); | ||
diff --git a/drivers/platform/x86/thinkpad_acpi.c b/drivers/platform/x86/thinkpad_acpi.c new file mode 100644 index 000000000000..3478453eba7a --- /dev/null +++ b/drivers/platform/x86/thinkpad_acpi.c | |||
@@ -0,0 +1,6948 @@ | |||
1 | /* | ||
2 | * thinkpad_acpi.c - ThinkPad ACPI Extras | ||
3 | * | ||
4 | * | ||
5 | * Copyright (C) 2004-2005 Borislav Deianov <borislav@users.sf.net> | ||
6 | * Copyright (C) 2006-2008 Henrique de Moraes Holschuh <hmh@hmh.eng.br> | ||
7 | * | ||
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. | ||
12 | * | ||
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. | ||
17 | * | ||
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., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | */ | ||
23 | |||
24 | #define TPACPI_VERSION "0.21" | ||
25 | #define TPACPI_SYSFS_VERSION 0x020200 | ||
26 | |||
27 | /* | ||
28 | * Changelog: | ||
29 | * 2007-10-20 changelog trimmed down | ||
30 | * | ||
31 | * 2007-03-27 0.14 renamed to thinkpad_acpi and moved to | ||
32 | * drivers/misc. | ||
33 | * | ||
34 | * 2006-11-22 0.13 new maintainer | ||
35 | * changelog now lives in git commit history, and will | ||
36 | * not be updated further in-file. | ||
37 | * | ||
38 | * 2005-03-17 0.11 support for 600e, 770x | ||
39 | * thanks to Jamie Lentin <lentinj@dial.pipex.com> | ||
40 | * | ||
41 | * 2005-01-16 0.9 use MODULE_VERSION | ||
42 | * thanks to Henrik Brix Andersen <brix@gentoo.org> | ||
43 | * fix parameter passing on module loading | ||
44 | * thanks to Rusty Russell <rusty@rustcorp.com.au> | ||
45 | * thanks to Jim Radford <radford@blackbean.org> | ||
46 | * 2004-11-08 0.8 fix init error case, don't return from a macro | ||
47 | * thanks to Chris Wright <chrisw@osdl.org> | ||
48 | */ | ||
49 | |||
50 | #include <linux/kernel.h> | ||
51 | #include <linux/module.h> | ||
52 | #include <linux/init.h> | ||
53 | #include <linux/types.h> | ||
54 | #include <linux/string.h> | ||
55 | #include <linux/list.h> | ||
56 | #include <linux/mutex.h> | ||
57 | #include <linux/kthread.h> | ||
58 | #include <linux/freezer.h> | ||
59 | #include <linux/delay.h> | ||
60 | |||
61 | #include <linux/nvram.h> | ||
62 | #include <linux/proc_fs.h> | ||
63 | #include <linux/sysfs.h> | ||
64 | #include <linux/backlight.h> | ||
65 | #include <linux/fb.h> | ||
66 | #include <linux/platform_device.h> | ||
67 | #include <linux/hwmon.h> | ||
68 | #include <linux/hwmon-sysfs.h> | ||
69 | #include <linux/input.h> | ||
70 | #include <linux/leds.h> | ||
71 | #include <linux/rfkill.h> | ||
72 | #include <asm/uaccess.h> | ||
73 | |||
74 | #include <linux/dmi.h> | ||
75 | #include <linux/jiffies.h> | ||
76 | #include <linux/workqueue.h> | ||
77 | |||
78 | #include <acpi/acpi_drivers.h> | ||
79 | |||
80 | #include <linux/pci_ids.h> | ||
81 | |||
82 | |||
83 | /* ThinkPad CMOS commands */ | ||
84 | #define TP_CMOS_VOLUME_DOWN 0 | ||
85 | #define TP_CMOS_VOLUME_UP 1 | ||
86 | #define TP_CMOS_VOLUME_MUTE 2 | ||
87 | #define TP_CMOS_BRIGHTNESS_UP 4 | ||
88 | #define TP_CMOS_BRIGHTNESS_DOWN 5 | ||
89 | #define TP_CMOS_THINKLIGHT_ON 12 | ||
90 | #define TP_CMOS_THINKLIGHT_OFF 13 | ||
91 | |||
92 | /* NVRAM Addresses */ | ||
93 | enum tp_nvram_addr { | ||
94 | TP_NVRAM_ADDR_HK2 = 0x57, | ||
95 | TP_NVRAM_ADDR_THINKLIGHT = 0x58, | ||
96 | TP_NVRAM_ADDR_VIDEO = 0x59, | ||
97 | TP_NVRAM_ADDR_BRIGHTNESS = 0x5e, | ||
98 | TP_NVRAM_ADDR_MIXER = 0x60, | ||
99 | }; | ||
100 | |||
101 | /* NVRAM bit masks */ | ||
102 | enum { | ||
103 | TP_NVRAM_MASK_HKT_THINKPAD = 0x08, | ||
104 | TP_NVRAM_MASK_HKT_ZOOM = 0x20, | ||
105 | TP_NVRAM_MASK_HKT_DISPLAY = 0x40, | ||
106 | TP_NVRAM_MASK_HKT_HIBERNATE = 0x80, | ||
107 | TP_NVRAM_MASK_THINKLIGHT = 0x10, | ||
108 | TP_NVRAM_MASK_HKT_DISPEXPND = 0x30, | ||
109 | TP_NVRAM_MASK_HKT_BRIGHTNESS = 0x20, | ||
110 | TP_NVRAM_MASK_LEVEL_BRIGHTNESS = 0x0f, | ||
111 | TP_NVRAM_POS_LEVEL_BRIGHTNESS = 0, | ||
112 | TP_NVRAM_MASK_MUTE = 0x40, | ||
113 | TP_NVRAM_MASK_HKT_VOLUME = 0x80, | ||
114 | TP_NVRAM_MASK_LEVEL_VOLUME = 0x0f, | ||
115 | TP_NVRAM_POS_LEVEL_VOLUME = 0, | ||
116 | }; | ||
117 | |||
118 | /* ACPI HIDs */ | ||
119 | #define TPACPI_ACPI_HKEY_HID "IBM0068" | ||
120 | |||
121 | /* Input IDs */ | ||
122 | #define TPACPI_HKEY_INPUT_PRODUCT 0x5054 /* "TP" */ | ||
123 | #define TPACPI_HKEY_INPUT_VERSION 0x4101 | ||
124 | |||
125 | |||
126 | /**************************************************************************** | ||
127 | * Main driver | ||
128 | */ | ||
129 | |||
130 | #define TPACPI_NAME "thinkpad" | ||
131 | #define TPACPI_DESC "ThinkPad ACPI Extras" | ||
132 | #define TPACPI_FILE TPACPI_NAME "_acpi" | ||
133 | #define TPACPI_URL "http://ibm-acpi.sf.net/" | ||
134 | #define TPACPI_MAIL "ibm-acpi-devel@lists.sourceforge.net" | ||
135 | |||
136 | #define TPACPI_PROC_DIR "ibm" | ||
137 | #define TPACPI_ACPI_EVENT_PREFIX "ibm" | ||
138 | #define TPACPI_DRVR_NAME TPACPI_FILE | ||
139 | #define TPACPI_DRVR_SHORTNAME "tpacpi" | ||
140 | #define TPACPI_HWMON_DRVR_NAME TPACPI_NAME "_hwmon" | ||
141 | |||
142 | #define TPACPI_NVRAM_KTHREAD_NAME "ktpacpi_nvramd" | ||
143 | #define TPACPI_WORKQUEUE_NAME "ktpacpid" | ||
144 | |||
145 | #define TPACPI_MAX_ACPI_ARGS 3 | ||
146 | |||
147 | /* rfkill switches */ | ||
148 | enum { | ||
149 | TPACPI_RFK_BLUETOOTH_SW_ID = 0, | ||
150 | TPACPI_RFK_WWAN_SW_ID, | ||
151 | }; | ||
152 | |||
153 | /* Debugging */ | ||
154 | #define TPACPI_LOG TPACPI_FILE ": " | ||
155 | #define TPACPI_ERR KERN_ERR TPACPI_LOG | ||
156 | #define TPACPI_NOTICE KERN_NOTICE TPACPI_LOG | ||
157 | #define TPACPI_INFO KERN_INFO TPACPI_LOG | ||
158 | #define TPACPI_DEBUG KERN_DEBUG TPACPI_LOG | ||
159 | |||
160 | #define TPACPI_DBG_ALL 0xffff | ||
161 | #define TPACPI_DBG_INIT 0x0001 | ||
162 | #define TPACPI_DBG_EXIT 0x0002 | ||
163 | #define dbg_printk(a_dbg_level, format, arg...) \ | ||
164 | do { if (dbg_level & a_dbg_level) \ | ||
165 | printk(TPACPI_DEBUG "%s: " format, __func__ , ## arg); \ | ||
166 | } while (0) | ||
167 | #ifdef CONFIG_THINKPAD_ACPI_DEBUG | ||
168 | #define vdbg_printk(a_dbg_level, format, arg...) \ | ||
169 | dbg_printk(a_dbg_level, format, ## arg) | ||
170 | static const char *str_supported(int is_supported); | ||
171 | #else | ||
172 | #define vdbg_printk(a_dbg_level, format, arg...) | ||
173 | #endif | ||
174 | |||
175 | #define onoff(status, bit) ((status) & (1 << (bit)) ? "on" : "off") | ||
176 | #define enabled(status, bit) ((status) & (1 << (bit)) ? "enabled" : "disabled") | ||
177 | #define strlencmp(a, b) (strncmp((a), (b), strlen(b))) | ||
178 | |||
179 | |||
180 | /**************************************************************************** | ||
181 | * Driver-wide structs and misc. variables | ||
182 | */ | ||
183 | |||
184 | struct ibm_struct; | ||
185 | |||
186 | struct tp_acpi_drv_struct { | ||
187 | const struct acpi_device_id *hid; | ||
188 | struct acpi_driver *driver; | ||
189 | |||
190 | void (*notify) (struct ibm_struct *, u32); | ||
191 | acpi_handle *handle; | ||
192 | u32 type; | ||
193 | struct acpi_device *device; | ||
194 | }; | ||
195 | |||
196 | struct ibm_struct { | ||
197 | char *name; | ||
198 | |||
199 | int (*read) (char *); | ||
200 | int (*write) (char *); | ||
201 | void (*exit) (void); | ||
202 | void (*resume) (void); | ||
203 | void (*suspend) (pm_message_t state); | ||
204 | |||
205 | struct list_head all_drivers; | ||
206 | |||
207 | struct tp_acpi_drv_struct *acpi; | ||
208 | |||
209 | struct { | ||
210 | u8 acpi_driver_registered:1; | ||
211 | u8 acpi_notify_installed:1; | ||
212 | u8 proc_created:1; | ||
213 | u8 init_called:1; | ||
214 | u8 experimental:1; | ||
215 | } flags; | ||
216 | }; | ||
217 | |||
218 | struct ibm_init_struct { | ||
219 | char param[32]; | ||
220 | |||
221 | int (*init) (struct ibm_init_struct *); | ||
222 | struct ibm_struct *data; | ||
223 | }; | ||
224 | |||
225 | static struct { | ||
226 | #ifdef CONFIG_THINKPAD_ACPI_BAY | ||
227 | u32 bay_status:1; | ||
228 | u32 bay_eject:1; | ||
229 | u32 bay_status2:1; | ||
230 | u32 bay_eject2:1; | ||
231 | #endif | ||
232 | u32 bluetooth:1; | ||
233 | u32 hotkey:1; | ||
234 | u32 hotkey_mask:1; | ||
235 | u32 hotkey_wlsw:1; | ||
236 | u32 hotkey_tablet:1; | ||
237 | u32 light:1; | ||
238 | u32 light_status:1; | ||
239 | u32 bright_16levels:1; | ||
240 | u32 bright_acpimode:1; | ||
241 | u32 wan:1; | ||
242 | u32 fan_ctrl_status_undef:1; | ||
243 | u32 input_device_registered:1; | ||
244 | u32 platform_drv_registered:1; | ||
245 | u32 platform_drv_attrs_registered:1; | ||
246 | u32 sensors_pdrv_registered:1; | ||
247 | u32 sensors_pdrv_attrs_registered:1; | ||
248 | u32 sensors_pdev_attrs_registered:1; | ||
249 | u32 hotkey_poll_active:1; | ||
250 | } tp_features; | ||
251 | |||
252 | static struct { | ||
253 | u16 hotkey_mask_ff:1; | ||
254 | u16 bright_cmos_ec_unsync:1; | ||
255 | } tp_warned; | ||
256 | |||
257 | struct thinkpad_id_data { | ||
258 | unsigned int vendor; /* ThinkPad vendor: | ||
259 | * PCI_VENDOR_ID_IBM/PCI_VENDOR_ID_LENOVO */ | ||
260 | |||
261 | char *bios_version_str; /* Something like 1ZET51WW (1.03z) */ | ||
262 | char *ec_version_str; /* Something like 1ZHT51WW-1.04a */ | ||
263 | |||
264 | u16 bios_model; /* Big Endian, TP-1Y = 0x5931, 0 = unknown */ | ||
265 | u16 ec_model; | ||
266 | |||
267 | char *model_str; /* ThinkPad T43 */ | ||
268 | char *nummodel_str; /* 9384A9C for a 9384-A9C model */ | ||
269 | }; | ||
270 | static struct thinkpad_id_data thinkpad_id; | ||
271 | |||
272 | static enum { | ||
273 | TPACPI_LIFE_INIT = 0, | ||
274 | TPACPI_LIFE_RUNNING, | ||
275 | TPACPI_LIFE_EXITING, | ||
276 | } tpacpi_lifecycle; | ||
277 | |||
278 | static int experimental; | ||
279 | static u32 dbg_level; | ||
280 | |||
281 | static struct workqueue_struct *tpacpi_wq; | ||
282 | |||
283 | /* Special LED class that can defer work */ | ||
284 | struct tpacpi_led_classdev { | ||
285 | struct led_classdev led_classdev; | ||
286 | struct work_struct work; | ||
287 | enum led_brightness new_brightness; | ||
288 | unsigned int led; | ||
289 | }; | ||
290 | |||
291 | /**************************************************************************** | ||
292 | **************************************************************************** | ||
293 | * | ||
294 | * ACPI Helpers and device model | ||
295 | * | ||
296 | **************************************************************************** | ||
297 | ****************************************************************************/ | ||
298 | |||
299 | /************************************************************************* | ||
300 | * ACPI basic handles | ||
301 | */ | ||
302 | |||
303 | static acpi_handle root_handle; | ||
304 | |||
305 | #define TPACPI_HANDLE(object, parent, paths...) \ | ||
306 | static acpi_handle object##_handle; \ | ||
307 | static acpi_handle *object##_parent = &parent##_handle; \ | ||
308 | static char *object##_path; \ | ||
309 | static char *object##_paths[] = { paths } | ||
310 | |||
311 | TPACPI_HANDLE(ec, root, "\\_SB.PCI0.ISA.EC0", /* 240, 240x */ | ||
312 | "\\_SB.PCI.ISA.EC", /* 570 */ | ||
313 | "\\_SB.PCI0.ISA0.EC0", /* 600e/x, 770e, 770x */ | ||
314 | "\\_SB.PCI0.ISA.EC", /* A21e, A2xm/p, T20-22, X20-21 */ | ||
315 | "\\_SB.PCI0.AD4S.EC0", /* i1400, R30 */ | ||
316 | "\\_SB.PCI0.ICH3.EC0", /* R31 */ | ||
317 | "\\_SB.PCI0.LPC.EC", /* all others */ | ||
318 | ); | ||
319 | |||
320 | TPACPI_HANDLE(ecrd, ec, "ECRD"); /* 570 */ | ||
321 | TPACPI_HANDLE(ecwr, ec, "ECWR"); /* 570 */ | ||
322 | |||
323 | TPACPI_HANDLE(cmos, root, "\\UCMS", /* R50, R50e, R50p, R51, */ | ||
324 | /* T4x, X31, X40 */ | ||
325 | "\\CMOS", /* A3x, G4x, R32, T23, T30, X22-24, X30 */ | ||
326 | "\\CMS", /* R40, R40e */ | ||
327 | ); /* all others */ | ||
328 | |||
329 | TPACPI_HANDLE(hkey, ec, "\\_SB.HKEY", /* 600e/x, 770e, 770x */ | ||
330 | "^HKEY", /* R30, R31 */ | ||
331 | "HKEY", /* all others */ | ||
332 | ); /* 570 */ | ||
333 | |||
334 | TPACPI_HANDLE(vid, root, "\\_SB.PCI.AGP.VGA", /* 570 */ | ||
335 | "\\_SB.PCI0.AGP0.VID0", /* 600e/x, 770x */ | ||
336 | "\\_SB.PCI0.VID0", /* 770e */ | ||
337 | "\\_SB.PCI0.VID", /* A21e, G4x, R50e, X30, X40 */ | ||
338 | "\\_SB.PCI0.AGP.VID", /* all others */ | ||
339 | ); /* R30, R31 */ | ||
340 | |||
341 | |||
342 | /************************************************************************* | ||
343 | * ACPI helpers | ||
344 | */ | ||
345 | |||
346 | static int acpi_evalf(acpi_handle handle, | ||
347 | void *res, char *method, char *fmt, ...) | ||
348 | { | ||
349 | char *fmt0 = fmt; | ||
350 | struct acpi_object_list params; | ||
351 | union acpi_object in_objs[TPACPI_MAX_ACPI_ARGS]; | ||
352 | struct acpi_buffer result, *resultp; | ||
353 | union acpi_object out_obj; | ||
354 | acpi_status status; | ||
355 | va_list ap; | ||
356 | char res_type; | ||
357 | int success; | ||
358 | int quiet; | ||
359 | |||
360 | if (!*fmt) { | ||
361 | printk(TPACPI_ERR "acpi_evalf() called with empty format\n"); | ||
362 | return 0; | ||
363 | } | ||
364 | |||
365 | if (*fmt == 'q') { | ||
366 | quiet = 1; | ||
367 | fmt++; | ||
368 | } else | ||
369 | quiet = 0; | ||
370 | |||
371 | res_type = *(fmt++); | ||
372 | |||
373 | params.count = 0; | ||
374 | params.pointer = &in_objs[0]; | ||
375 | |||
376 | va_start(ap, fmt); | ||
377 | while (*fmt) { | ||
378 | char c = *(fmt++); | ||
379 | switch (c) { | ||
380 | case 'd': /* int */ | ||
381 | in_objs[params.count].integer.value = va_arg(ap, int); | ||
382 | in_objs[params.count++].type = ACPI_TYPE_INTEGER; | ||
383 | break; | ||
384 | /* add more types as needed */ | ||
385 | default: | ||
386 | printk(TPACPI_ERR "acpi_evalf() called " | ||
387 | "with invalid format character '%c'\n", c); | ||
388 | return 0; | ||
389 | } | ||
390 | } | ||
391 | va_end(ap); | ||
392 | |||
393 | if (res_type != 'v') { | ||
394 | result.length = sizeof(out_obj); | ||
395 | result.pointer = &out_obj; | ||
396 | resultp = &result; | ||
397 | } else | ||
398 | resultp = NULL; | ||
399 | |||
400 | status = acpi_evaluate_object(handle, method, ¶ms, resultp); | ||
401 | |||
402 | switch (res_type) { | ||
403 | case 'd': /* int */ | ||
404 | if (res) | ||
405 | *(int *)res = out_obj.integer.value; | ||
406 | success = status == AE_OK && out_obj.type == ACPI_TYPE_INTEGER; | ||
407 | break; | ||
408 | case 'v': /* void */ | ||
409 | success = status == AE_OK; | ||
410 | break; | ||
411 | /* add more types as needed */ | ||
412 | default: | ||
413 | printk(TPACPI_ERR "acpi_evalf() called " | ||
414 | "with invalid format character '%c'\n", res_type); | ||
415 | return 0; | ||
416 | } | ||
417 | |||
418 | if (!success && !quiet) | ||
419 | printk(TPACPI_ERR "acpi_evalf(%s, %s, ...) failed: %d\n", | ||
420 | method, fmt0, status); | ||
421 | |||
422 | return success; | ||
423 | } | ||
424 | |||
425 | static int acpi_ec_read(int i, u8 *p) | ||
426 | { | ||
427 | int v; | ||
428 | |||
429 | if (ecrd_handle) { | ||
430 | if (!acpi_evalf(ecrd_handle, &v, NULL, "dd", i)) | ||
431 | return 0; | ||
432 | *p = v; | ||
433 | } else { | ||
434 | if (ec_read(i, p) < 0) | ||
435 | return 0; | ||
436 | } | ||
437 | |||
438 | return 1; | ||
439 | } | ||
440 | |||
441 | static int acpi_ec_write(int i, u8 v) | ||
442 | { | ||
443 | if (ecwr_handle) { | ||
444 | if (!acpi_evalf(ecwr_handle, NULL, NULL, "vdd", i, v)) | ||
445 | return 0; | ||
446 | } else { | ||
447 | if (ec_write(i, v) < 0) | ||
448 | return 0; | ||
449 | } | ||
450 | |||
451 | return 1; | ||
452 | } | ||
453 | |||
454 | #if defined(CONFIG_THINKPAD_ACPI_DOCK) || defined(CONFIG_THINKPAD_ACPI_BAY) | ||
455 | static int _sta(acpi_handle handle) | ||
456 | { | ||
457 | int status; | ||
458 | |||
459 | if (!handle || !acpi_evalf(handle, &status, "_STA", "d")) | ||
460 | status = 0; | ||
461 | |||
462 | return status; | ||
463 | } | ||
464 | #endif | ||
465 | |||
466 | static int issue_thinkpad_cmos_command(int cmos_cmd) | ||
467 | { | ||
468 | if (!cmos_handle) | ||
469 | return -ENXIO; | ||
470 | |||
471 | if (!acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd)) | ||
472 | return -EIO; | ||
473 | |||
474 | return 0; | ||
475 | } | ||
476 | |||
477 | /************************************************************************* | ||
478 | * ACPI device model | ||
479 | */ | ||
480 | |||
481 | #define TPACPI_ACPIHANDLE_INIT(object) \ | ||
482 | drv_acpi_handle_init(#object, &object##_handle, *object##_parent, \ | ||
483 | object##_paths, ARRAY_SIZE(object##_paths), &object##_path) | ||
484 | |||
485 | static void drv_acpi_handle_init(char *name, | ||
486 | acpi_handle *handle, acpi_handle parent, | ||
487 | char **paths, int num_paths, char **path) | ||
488 | { | ||
489 | int i; | ||
490 | acpi_status status; | ||
491 | |||
492 | vdbg_printk(TPACPI_DBG_INIT, "trying to locate ACPI handle for %s\n", | ||
493 | name); | ||
494 | |||
495 | for (i = 0; i < num_paths; i++) { | ||
496 | status = acpi_get_handle(parent, paths[i], handle); | ||
497 | if (ACPI_SUCCESS(status)) { | ||
498 | *path = paths[i]; | ||
499 | dbg_printk(TPACPI_DBG_INIT, | ||
500 | "Found ACPI handle %s for %s\n", | ||
501 | *path, name); | ||
502 | return; | ||
503 | } | ||
504 | } | ||
505 | |||
506 | vdbg_printk(TPACPI_DBG_INIT, "ACPI handle for %s not found\n", | ||
507 | name); | ||
508 | *handle = NULL; | ||
509 | } | ||
510 | |||
511 | static void dispatch_acpi_notify(acpi_handle handle, u32 event, void *data) | ||
512 | { | ||
513 | struct ibm_struct *ibm = data; | ||
514 | |||
515 | if (tpacpi_lifecycle != TPACPI_LIFE_RUNNING) | ||
516 | return; | ||
517 | |||
518 | if (!ibm || !ibm->acpi || !ibm->acpi->notify) | ||
519 | return; | ||
520 | |||
521 | ibm->acpi->notify(ibm, event); | ||
522 | } | ||
523 | |||
524 | static int __init setup_acpi_notify(struct ibm_struct *ibm) | ||
525 | { | ||
526 | acpi_status status; | ||
527 | int rc; | ||
528 | |||
529 | BUG_ON(!ibm->acpi); | ||
530 | |||
531 | if (!*ibm->acpi->handle) | ||
532 | return 0; | ||
533 | |||
534 | vdbg_printk(TPACPI_DBG_INIT, | ||
535 | "setting up ACPI notify for %s\n", ibm->name); | ||
536 | |||
537 | rc = acpi_bus_get_device(*ibm->acpi->handle, &ibm->acpi->device); | ||
538 | if (rc < 0) { | ||
539 | printk(TPACPI_ERR "acpi_bus_get_device(%s) failed: %d\n", | ||
540 | ibm->name, rc); | ||
541 | return -ENODEV; | ||
542 | } | ||
543 | |||
544 | ibm->acpi->device->driver_data = ibm; | ||
545 | sprintf(acpi_device_class(ibm->acpi->device), "%s/%s", | ||
546 | TPACPI_ACPI_EVENT_PREFIX, | ||
547 | ibm->name); | ||
548 | |||
549 | status = acpi_install_notify_handler(*ibm->acpi->handle, | ||
550 | ibm->acpi->type, dispatch_acpi_notify, ibm); | ||
551 | if (ACPI_FAILURE(status)) { | ||
552 | if (status == AE_ALREADY_EXISTS) { | ||
553 | printk(TPACPI_NOTICE | ||
554 | "another device driver is already " | ||
555 | "handling %s events\n", ibm->name); | ||
556 | } else { | ||
557 | printk(TPACPI_ERR | ||
558 | "acpi_install_notify_handler(%s) failed: %d\n", | ||
559 | ibm->name, status); | ||
560 | } | ||
561 | return -ENODEV; | ||
562 | } | ||
563 | ibm->flags.acpi_notify_installed = 1; | ||
564 | return 0; | ||
565 | } | ||
566 | |||
567 | static int __init tpacpi_device_add(struct acpi_device *device) | ||
568 | { | ||
569 | return 0; | ||
570 | } | ||
571 | |||
572 | static int __init register_tpacpi_subdriver(struct ibm_struct *ibm) | ||
573 | { | ||
574 | int rc; | ||
575 | |||
576 | dbg_printk(TPACPI_DBG_INIT, | ||
577 | "registering %s as an ACPI driver\n", ibm->name); | ||
578 | |||
579 | BUG_ON(!ibm->acpi); | ||
580 | |||
581 | ibm->acpi->driver = kzalloc(sizeof(struct acpi_driver), GFP_KERNEL); | ||
582 | if (!ibm->acpi->driver) { | ||
583 | printk(TPACPI_ERR | ||
584 | "failed to allocate memory for ibm->acpi->driver\n"); | ||
585 | return -ENOMEM; | ||
586 | } | ||
587 | |||
588 | sprintf(ibm->acpi->driver->name, "%s_%s", TPACPI_NAME, ibm->name); | ||
589 | ibm->acpi->driver->ids = ibm->acpi->hid; | ||
590 | |||
591 | ibm->acpi->driver->ops.add = &tpacpi_device_add; | ||
592 | |||
593 | rc = acpi_bus_register_driver(ibm->acpi->driver); | ||
594 | if (rc < 0) { | ||
595 | printk(TPACPI_ERR "acpi_bus_register_driver(%s) failed: %d\n", | ||
596 | ibm->name, rc); | ||
597 | kfree(ibm->acpi->driver); | ||
598 | ibm->acpi->driver = NULL; | ||
599 | } else if (!rc) | ||
600 | ibm->flags.acpi_driver_registered = 1; | ||
601 | |||
602 | return rc; | ||
603 | } | ||
604 | |||
605 | |||
606 | /**************************************************************************** | ||
607 | **************************************************************************** | ||
608 | * | ||
609 | * Procfs Helpers | ||
610 | * | ||
611 | **************************************************************************** | ||
612 | ****************************************************************************/ | ||
613 | |||
614 | static int dispatch_procfs_read(char *page, char **start, off_t off, | ||
615 | int count, int *eof, void *data) | ||
616 | { | ||
617 | struct ibm_struct *ibm = data; | ||
618 | int len; | ||
619 | |||
620 | if (!ibm || !ibm->read) | ||
621 | return -EINVAL; | ||
622 | |||
623 | len = ibm->read(page); | ||
624 | if (len < 0) | ||
625 | return len; | ||
626 | |||
627 | if (len <= off + count) | ||
628 | *eof = 1; | ||
629 | *start = page + off; | ||
630 | len -= off; | ||
631 | if (len > count) | ||
632 | len = count; | ||
633 | if (len < 0) | ||
634 | len = 0; | ||
635 | |||
636 | return len; | ||
637 | } | ||
638 | |||
639 | static int dispatch_procfs_write(struct file *file, | ||
640 | const char __user *userbuf, | ||
641 | unsigned long count, void *data) | ||
642 | { | ||
643 | struct ibm_struct *ibm = data; | ||
644 | char *kernbuf; | ||
645 | int ret; | ||
646 | |||
647 | if (!ibm || !ibm->write) | ||
648 | return -EINVAL; | ||
649 | |||
650 | kernbuf = kmalloc(count + 2, GFP_KERNEL); | ||
651 | if (!kernbuf) | ||
652 | return -ENOMEM; | ||
653 | |||
654 | if (copy_from_user(kernbuf, userbuf, count)) { | ||
655 | kfree(kernbuf); | ||
656 | return -EFAULT; | ||
657 | } | ||
658 | |||
659 | kernbuf[count] = 0; | ||
660 | strcat(kernbuf, ","); | ||
661 | ret = ibm->write(kernbuf); | ||
662 | if (ret == 0) | ||
663 | ret = count; | ||
664 | |||
665 | kfree(kernbuf); | ||
666 | |||
667 | return ret; | ||
668 | } | ||
669 | |||
670 | static char *next_cmd(char **cmds) | ||
671 | { | ||
672 | char *start = *cmds; | ||
673 | char *end; | ||
674 | |||
675 | while ((end = strchr(start, ',')) && end == start) | ||
676 | start = end + 1; | ||
677 | |||
678 | if (!end) | ||
679 | return NULL; | ||
680 | |||
681 | *end = 0; | ||
682 | *cmds = end + 1; | ||
683 | return start; | ||
684 | } | ||
685 | |||
686 | |||
687 | /**************************************************************************** | ||
688 | **************************************************************************** | ||
689 | * | ||
690 | * Device model: input, hwmon and platform | ||
691 | * | ||
692 | **************************************************************************** | ||
693 | ****************************************************************************/ | ||
694 | |||
695 | static struct platform_device *tpacpi_pdev; | ||
696 | static struct platform_device *tpacpi_sensors_pdev; | ||
697 | static struct device *tpacpi_hwmon; | ||
698 | static struct input_dev *tpacpi_inputdev; | ||
699 | static struct mutex tpacpi_inputdev_send_mutex; | ||
700 | static LIST_HEAD(tpacpi_all_drivers); | ||
701 | |||
702 | static int tpacpi_suspend_handler(struct platform_device *pdev, | ||
703 | pm_message_t state) | ||
704 | { | ||
705 | struct ibm_struct *ibm, *itmp; | ||
706 | |||
707 | list_for_each_entry_safe(ibm, itmp, | ||
708 | &tpacpi_all_drivers, | ||
709 | all_drivers) { | ||
710 | if (ibm->suspend) | ||
711 | (ibm->suspend)(state); | ||
712 | } | ||
713 | |||
714 | return 0; | ||
715 | } | ||
716 | |||
717 | static int tpacpi_resume_handler(struct platform_device *pdev) | ||
718 | { | ||
719 | struct ibm_struct *ibm, *itmp; | ||
720 | |||
721 | list_for_each_entry_safe(ibm, itmp, | ||
722 | &tpacpi_all_drivers, | ||
723 | all_drivers) { | ||
724 | if (ibm->resume) | ||
725 | (ibm->resume)(); | ||
726 | } | ||
727 | |||
728 | return 0; | ||
729 | } | ||
730 | |||
731 | static struct platform_driver tpacpi_pdriver = { | ||
732 | .driver = { | ||
733 | .name = TPACPI_DRVR_NAME, | ||
734 | .owner = THIS_MODULE, | ||
735 | }, | ||
736 | .suspend = tpacpi_suspend_handler, | ||
737 | .resume = tpacpi_resume_handler, | ||
738 | }; | ||
739 | |||
740 | static struct platform_driver tpacpi_hwmon_pdriver = { | ||
741 | .driver = { | ||
742 | .name = TPACPI_HWMON_DRVR_NAME, | ||
743 | .owner = THIS_MODULE, | ||
744 | }, | ||
745 | }; | ||
746 | |||
747 | /************************************************************************* | ||
748 | * sysfs support helpers | ||
749 | */ | ||
750 | |||
751 | struct attribute_set { | ||
752 | unsigned int members, max_members; | ||
753 | struct attribute_group group; | ||
754 | }; | ||
755 | |||
756 | struct attribute_set_obj { | ||
757 | struct attribute_set s; | ||
758 | struct attribute *a; | ||
759 | } __attribute__((packed)); | ||
760 | |||
761 | static struct attribute_set *create_attr_set(unsigned int max_members, | ||
762 | const char *name) | ||
763 | { | ||
764 | struct attribute_set_obj *sobj; | ||
765 | |||
766 | if (max_members == 0) | ||
767 | return NULL; | ||
768 | |||
769 | /* Allocates space for implicit NULL at the end too */ | ||
770 | sobj = kzalloc(sizeof(struct attribute_set_obj) + | ||
771 | max_members * sizeof(struct attribute *), | ||
772 | GFP_KERNEL); | ||
773 | if (!sobj) | ||
774 | return NULL; | ||
775 | sobj->s.max_members = max_members; | ||
776 | sobj->s.group.attrs = &sobj->a; | ||
777 | sobj->s.group.name = name; | ||
778 | |||
779 | return &sobj->s; | ||
780 | } | ||
781 | |||
782 | #define destroy_attr_set(_set) \ | ||
783 | kfree(_set); | ||
784 | |||
785 | /* not multi-threaded safe, use it in a single thread per set */ | ||
786 | static int add_to_attr_set(struct attribute_set *s, struct attribute *attr) | ||
787 | { | ||
788 | if (!s || !attr) | ||
789 | return -EINVAL; | ||
790 | |||
791 | if (s->members >= s->max_members) | ||
792 | return -ENOMEM; | ||
793 | |||
794 | s->group.attrs[s->members] = attr; | ||
795 | s->members++; | ||
796 | |||
797 | return 0; | ||
798 | } | ||
799 | |||
800 | static int add_many_to_attr_set(struct attribute_set *s, | ||
801 | struct attribute **attr, | ||
802 | unsigned int count) | ||
803 | { | ||
804 | int i, res; | ||
805 | |||
806 | for (i = 0; i < count; i++) { | ||
807 | res = add_to_attr_set(s, attr[i]); | ||
808 | if (res) | ||
809 | return res; | ||
810 | } | ||
811 | |||
812 | return 0; | ||
813 | } | ||
814 | |||
815 | static void delete_attr_set(struct attribute_set *s, struct kobject *kobj) | ||
816 | { | ||
817 | sysfs_remove_group(kobj, &s->group); | ||
818 | destroy_attr_set(s); | ||
819 | } | ||
820 | |||
821 | #define register_attr_set_with_sysfs(_attr_set, _kobj) \ | ||
822 | sysfs_create_group(_kobj, &_attr_set->group) | ||
823 | |||
824 | static int parse_strtoul(const char *buf, | ||
825 | unsigned long max, unsigned long *value) | ||
826 | { | ||
827 | char *endp; | ||
828 | |||
829 | while (*buf && isspace(*buf)) | ||
830 | buf++; | ||
831 | *value = simple_strtoul(buf, &endp, 0); | ||
832 | while (*endp && isspace(*endp)) | ||
833 | endp++; | ||
834 | if (*endp || *value > max) | ||
835 | return -EINVAL; | ||
836 | |||
837 | return 0; | ||
838 | } | ||
839 | |||
840 | static void tpacpi_disable_brightness_delay(void) | ||
841 | { | ||
842 | if (acpi_evalf(hkey_handle, NULL, "PWMS", "qvd", 0)) | ||
843 | printk(TPACPI_NOTICE | ||
844 | "ACPI backlight control delay disabled\n"); | ||
845 | } | ||
846 | |||
847 | static int __init tpacpi_query_bcl_levels(acpi_handle handle) | ||
848 | { | ||
849 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
850 | union acpi_object *obj; | ||
851 | int rc; | ||
852 | |||
853 | if (ACPI_SUCCESS(acpi_evaluate_object(handle, NULL, NULL, &buffer))) { | ||
854 | obj = (union acpi_object *)buffer.pointer; | ||
855 | if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) { | ||
856 | printk(TPACPI_ERR "Unknown _BCL data, " | ||
857 | "please report this to %s\n", TPACPI_MAIL); | ||
858 | rc = 0; | ||
859 | } else { | ||
860 | rc = obj->package.count; | ||
861 | } | ||
862 | } else { | ||
863 | return 0; | ||
864 | } | ||
865 | |||
866 | kfree(buffer.pointer); | ||
867 | return rc; | ||
868 | } | ||
869 | |||
870 | static acpi_status __init tpacpi_acpi_walk_find_bcl(acpi_handle handle, | ||
871 | u32 lvl, void *context, void **rv) | ||
872 | { | ||
873 | char name[ACPI_PATH_SEGMENT_LENGTH]; | ||
874 | struct acpi_buffer buffer = { sizeof(name), &name }; | ||
875 | |||
876 | if (ACPI_SUCCESS(acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer)) && | ||
877 | !strncmp("_BCL", name, sizeof(name) - 1)) { | ||
878 | BUG_ON(!rv || !*rv); | ||
879 | **(int **)rv = tpacpi_query_bcl_levels(handle); | ||
880 | return AE_CTRL_TERMINATE; | ||
881 | } else { | ||
882 | return AE_OK; | ||
883 | } | ||
884 | } | ||
885 | |||
886 | /* | ||
887 | * Returns 0 (no ACPI _BCL or _BCL invalid), or size of brightness map | ||
888 | */ | ||
889 | static int __init tpacpi_check_std_acpi_brightness_support(void) | ||
890 | { | ||
891 | int status; | ||
892 | int bcl_levels = 0; | ||
893 | void *bcl_ptr = &bcl_levels; | ||
894 | |||
895 | if (!vid_handle) { | ||
896 | TPACPI_ACPIHANDLE_INIT(vid); | ||
897 | } | ||
898 | if (!vid_handle) | ||
899 | return 0; | ||
900 | |||
901 | /* | ||
902 | * Search for a _BCL method, and execute it. This is safe on all | ||
903 | * ThinkPads, and as a side-effect, _BCL will place a Lenovo Vista | ||
904 | * BIOS in ACPI backlight control mode. We do NOT have to care | ||
905 | * about calling the _BCL method in an enabled video device, any | ||
906 | * will do for our purposes. | ||
907 | */ | ||
908 | |||
909 | status = acpi_walk_namespace(ACPI_TYPE_METHOD, vid_handle, 3, | ||
910 | tpacpi_acpi_walk_find_bcl, NULL, | ||
911 | &bcl_ptr); | ||
912 | |||
913 | if (ACPI_SUCCESS(status) && bcl_levels > 2) { | ||
914 | tp_features.bright_acpimode = 1; | ||
915 | return (bcl_levels - 2); | ||
916 | } | ||
917 | |||
918 | return 0; | ||
919 | } | ||
920 | |||
921 | static int __init tpacpi_new_rfkill(const unsigned int id, | ||
922 | struct rfkill **rfk, | ||
923 | const enum rfkill_type rfktype, | ||
924 | const char *name, | ||
925 | int (*toggle_radio)(void *, enum rfkill_state), | ||
926 | int (*get_state)(void *, enum rfkill_state *)) | ||
927 | { | ||
928 | int res; | ||
929 | enum rfkill_state initial_state; | ||
930 | |||
931 | *rfk = rfkill_allocate(&tpacpi_pdev->dev, rfktype); | ||
932 | if (!*rfk) { | ||
933 | printk(TPACPI_ERR | ||
934 | "failed to allocate memory for rfkill class\n"); | ||
935 | return -ENOMEM; | ||
936 | } | ||
937 | |||
938 | (*rfk)->name = name; | ||
939 | (*rfk)->get_state = get_state; | ||
940 | (*rfk)->toggle_radio = toggle_radio; | ||
941 | |||
942 | if (!get_state(NULL, &initial_state)) | ||
943 | (*rfk)->state = initial_state; | ||
944 | |||
945 | res = rfkill_register(*rfk); | ||
946 | if (res < 0) { | ||
947 | printk(TPACPI_ERR | ||
948 | "failed to register %s rfkill switch: %d\n", | ||
949 | name, res); | ||
950 | rfkill_free(*rfk); | ||
951 | *rfk = NULL; | ||
952 | return res; | ||
953 | } | ||
954 | |||
955 | return 0; | ||
956 | } | ||
957 | |||
958 | /************************************************************************* | ||
959 | * thinkpad-acpi driver attributes | ||
960 | */ | ||
961 | |||
962 | /* interface_version --------------------------------------------------- */ | ||
963 | static ssize_t tpacpi_driver_interface_version_show( | ||
964 | struct device_driver *drv, | ||
965 | char *buf) | ||
966 | { | ||
967 | return snprintf(buf, PAGE_SIZE, "0x%08x\n", TPACPI_SYSFS_VERSION); | ||
968 | } | ||
969 | |||
970 | static DRIVER_ATTR(interface_version, S_IRUGO, | ||
971 | tpacpi_driver_interface_version_show, NULL); | ||
972 | |||
973 | /* debug_level --------------------------------------------------------- */ | ||
974 | static ssize_t tpacpi_driver_debug_show(struct device_driver *drv, | ||
975 | char *buf) | ||
976 | { | ||
977 | return snprintf(buf, PAGE_SIZE, "0x%04x\n", dbg_level); | ||
978 | } | ||
979 | |||
980 | static ssize_t tpacpi_driver_debug_store(struct device_driver *drv, | ||
981 | const char *buf, size_t count) | ||
982 | { | ||
983 | unsigned long t; | ||
984 | |||
985 | if (parse_strtoul(buf, 0xffff, &t)) | ||
986 | return -EINVAL; | ||
987 | |||
988 | dbg_level = t; | ||
989 | |||
990 | return count; | ||
991 | } | ||
992 | |||
993 | static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO, | ||
994 | tpacpi_driver_debug_show, tpacpi_driver_debug_store); | ||
995 | |||
996 | /* version ------------------------------------------------------------- */ | ||
997 | static ssize_t tpacpi_driver_version_show(struct device_driver *drv, | ||
998 | char *buf) | ||
999 | { | ||
1000 | return snprintf(buf, PAGE_SIZE, "%s v%s\n", | ||
1001 | TPACPI_DESC, TPACPI_VERSION); | ||
1002 | } | ||
1003 | |||
1004 | static DRIVER_ATTR(version, S_IRUGO, | ||
1005 | tpacpi_driver_version_show, NULL); | ||
1006 | |||
1007 | /* --------------------------------------------------------------------- */ | ||
1008 | |||
1009 | static struct driver_attribute *tpacpi_driver_attributes[] = { | ||
1010 | &driver_attr_debug_level, &driver_attr_version, | ||
1011 | &driver_attr_interface_version, | ||
1012 | }; | ||
1013 | |||
1014 | static int __init tpacpi_create_driver_attributes(struct device_driver *drv) | ||
1015 | { | ||
1016 | int i, res; | ||
1017 | |||
1018 | i = 0; | ||
1019 | res = 0; | ||
1020 | while (!res && i < ARRAY_SIZE(tpacpi_driver_attributes)) { | ||
1021 | res = driver_create_file(drv, tpacpi_driver_attributes[i]); | ||
1022 | i++; | ||
1023 | } | ||
1024 | |||
1025 | return res; | ||
1026 | } | ||
1027 | |||
1028 | static void tpacpi_remove_driver_attributes(struct device_driver *drv) | ||
1029 | { | ||
1030 | int i; | ||
1031 | |||
1032 | for (i = 0; i < ARRAY_SIZE(tpacpi_driver_attributes); i++) | ||
1033 | driver_remove_file(drv, tpacpi_driver_attributes[i]); | ||
1034 | } | ||
1035 | |||
1036 | /**************************************************************************** | ||
1037 | **************************************************************************** | ||
1038 | * | ||
1039 | * Subdrivers | ||
1040 | * | ||
1041 | **************************************************************************** | ||
1042 | ****************************************************************************/ | ||
1043 | |||
1044 | /************************************************************************* | ||
1045 | * thinkpad-acpi init subdriver | ||
1046 | */ | ||
1047 | |||
1048 | static int __init thinkpad_acpi_driver_init(struct ibm_init_struct *iibm) | ||
1049 | { | ||
1050 | printk(TPACPI_INFO "%s v%s\n", TPACPI_DESC, TPACPI_VERSION); | ||
1051 | printk(TPACPI_INFO "%s\n", TPACPI_URL); | ||
1052 | |||
1053 | printk(TPACPI_INFO "ThinkPad BIOS %s, EC %s\n", | ||
1054 | (thinkpad_id.bios_version_str) ? | ||
1055 | thinkpad_id.bios_version_str : "unknown", | ||
1056 | (thinkpad_id.ec_version_str) ? | ||
1057 | thinkpad_id.ec_version_str : "unknown"); | ||
1058 | |||
1059 | if (thinkpad_id.vendor && thinkpad_id.model_str) | ||
1060 | printk(TPACPI_INFO "%s %s, model %s\n", | ||
1061 | (thinkpad_id.vendor == PCI_VENDOR_ID_IBM) ? | ||
1062 | "IBM" : ((thinkpad_id.vendor == | ||
1063 | PCI_VENDOR_ID_LENOVO) ? | ||
1064 | "Lenovo" : "Unknown vendor"), | ||
1065 | thinkpad_id.model_str, | ||
1066 | (thinkpad_id.nummodel_str) ? | ||
1067 | thinkpad_id.nummodel_str : "unknown"); | ||
1068 | |||
1069 | return 0; | ||
1070 | } | ||
1071 | |||
1072 | static int thinkpad_acpi_driver_read(char *p) | ||
1073 | { | ||
1074 | int len = 0; | ||
1075 | |||
1076 | len += sprintf(p + len, "driver:\t\t%s\n", TPACPI_DESC); | ||
1077 | len += sprintf(p + len, "version:\t%s\n", TPACPI_VERSION); | ||
1078 | |||
1079 | return len; | ||
1080 | } | ||
1081 | |||
1082 | static struct ibm_struct thinkpad_acpi_driver_data = { | ||
1083 | .name = "driver", | ||
1084 | .read = thinkpad_acpi_driver_read, | ||
1085 | }; | ||
1086 | |||
1087 | /************************************************************************* | ||
1088 | * Hotkey subdriver | ||
1089 | */ | ||
1090 | |||
1091 | enum { /* hot key scan codes (derived from ACPI DSDT) */ | ||
1092 | TP_ACPI_HOTKEYSCAN_FNF1 = 0, | ||
1093 | TP_ACPI_HOTKEYSCAN_FNF2, | ||
1094 | TP_ACPI_HOTKEYSCAN_FNF3, | ||
1095 | TP_ACPI_HOTKEYSCAN_FNF4, | ||
1096 | TP_ACPI_HOTKEYSCAN_FNF5, | ||
1097 | TP_ACPI_HOTKEYSCAN_FNF6, | ||
1098 | TP_ACPI_HOTKEYSCAN_FNF7, | ||
1099 | TP_ACPI_HOTKEYSCAN_FNF8, | ||
1100 | TP_ACPI_HOTKEYSCAN_FNF9, | ||
1101 | TP_ACPI_HOTKEYSCAN_FNF10, | ||
1102 | TP_ACPI_HOTKEYSCAN_FNF11, | ||
1103 | TP_ACPI_HOTKEYSCAN_FNF12, | ||
1104 | TP_ACPI_HOTKEYSCAN_FNBACKSPACE, | ||
1105 | TP_ACPI_HOTKEYSCAN_FNINSERT, | ||
1106 | TP_ACPI_HOTKEYSCAN_FNDELETE, | ||
1107 | TP_ACPI_HOTKEYSCAN_FNHOME, | ||
1108 | TP_ACPI_HOTKEYSCAN_FNEND, | ||
1109 | TP_ACPI_HOTKEYSCAN_FNPAGEUP, | ||
1110 | TP_ACPI_HOTKEYSCAN_FNPAGEDOWN, | ||
1111 | TP_ACPI_HOTKEYSCAN_FNSPACE, | ||
1112 | TP_ACPI_HOTKEYSCAN_VOLUMEUP, | ||
1113 | TP_ACPI_HOTKEYSCAN_VOLUMEDOWN, | ||
1114 | TP_ACPI_HOTKEYSCAN_MUTE, | ||
1115 | TP_ACPI_HOTKEYSCAN_THINKPAD, | ||
1116 | }; | ||
1117 | |||
1118 | enum { /* Keys available through NVRAM polling */ | ||
1119 | TPACPI_HKEY_NVRAM_KNOWN_MASK = 0x00fb88c0U, | ||
1120 | TPACPI_HKEY_NVRAM_GOOD_MASK = 0x00fb8000U, | ||
1121 | }; | ||
1122 | |||
1123 | enum { /* Positions of some of the keys in hotkey masks */ | ||
1124 | TP_ACPI_HKEY_DISPSWTCH_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNF7, | ||
1125 | TP_ACPI_HKEY_DISPXPAND_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNF8, | ||
1126 | TP_ACPI_HKEY_HIBERNATE_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNF12, | ||
1127 | TP_ACPI_HKEY_BRGHTUP_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNHOME, | ||
1128 | TP_ACPI_HKEY_BRGHTDWN_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNEND, | ||
1129 | TP_ACPI_HKEY_THNKLGHT_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNPAGEUP, | ||
1130 | TP_ACPI_HKEY_ZOOM_MASK = 1 << TP_ACPI_HOTKEYSCAN_FNSPACE, | ||
1131 | TP_ACPI_HKEY_VOLUP_MASK = 1 << TP_ACPI_HOTKEYSCAN_VOLUMEUP, | ||
1132 | TP_ACPI_HKEY_VOLDWN_MASK = 1 << TP_ACPI_HOTKEYSCAN_VOLUMEDOWN, | ||
1133 | TP_ACPI_HKEY_MUTE_MASK = 1 << TP_ACPI_HOTKEYSCAN_MUTE, | ||
1134 | TP_ACPI_HKEY_THINKPAD_MASK = 1 << TP_ACPI_HOTKEYSCAN_THINKPAD, | ||
1135 | }; | ||
1136 | |||
1137 | enum { /* NVRAM to ACPI HKEY group map */ | ||
1138 | TP_NVRAM_HKEY_GROUP_HK2 = TP_ACPI_HKEY_THINKPAD_MASK | | ||
1139 | TP_ACPI_HKEY_ZOOM_MASK | | ||
1140 | TP_ACPI_HKEY_DISPSWTCH_MASK | | ||
1141 | TP_ACPI_HKEY_HIBERNATE_MASK, | ||
1142 | TP_NVRAM_HKEY_GROUP_BRIGHTNESS = TP_ACPI_HKEY_BRGHTUP_MASK | | ||
1143 | TP_ACPI_HKEY_BRGHTDWN_MASK, | ||
1144 | TP_NVRAM_HKEY_GROUP_VOLUME = TP_ACPI_HKEY_VOLUP_MASK | | ||
1145 | TP_ACPI_HKEY_VOLDWN_MASK | | ||
1146 | TP_ACPI_HKEY_MUTE_MASK, | ||
1147 | }; | ||
1148 | |||
1149 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1150 | struct tp_nvram_state { | ||
1151 | u16 thinkpad_toggle:1; | ||
1152 | u16 zoom_toggle:1; | ||
1153 | u16 display_toggle:1; | ||
1154 | u16 thinklight_toggle:1; | ||
1155 | u16 hibernate_toggle:1; | ||
1156 | u16 displayexp_toggle:1; | ||
1157 | u16 display_state:1; | ||
1158 | u16 brightness_toggle:1; | ||
1159 | u16 volume_toggle:1; | ||
1160 | u16 mute:1; | ||
1161 | |||
1162 | u8 brightness_level; | ||
1163 | u8 volume_level; | ||
1164 | }; | ||
1165 | |||
1166 | static struct task_struct *tpacpi_hotkey_task; | ||
1167 | static u32 hotkey_source_mask; /* bit mask 0=ACPI,1=NVRAM */ | ||
1168 | static int hotkey_poll_freq = 10; /* Hz */ | ||
1169 | static struct mutex hotkey_thread_mutex; | ||
1170 | static struct mutex hotkey_thread_data_mutex; | ||
1171 | static unsigned int hotkey_config_change; | ||
1172 | |||
1173 | #else /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1174 | |||
1175 | #define hotkey_source_mask 0U | ||
1176 | |||
1177 | #endif /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1178 | |||
1179 | static struct mutex hotkey_mutex; | ||
1180 | |||
1181 | static enum { /* Reasons for waking up */ | ||
1182 | TP_ACPI_WAKEUP_NONE = 0, /* None or unknown */ | ||
1183 | TP_ACPI_WAKEUP_BAYEJ, /* Bay ejection request */ | ||
1184 | TP_ACPI_WAKEUP_UNDOCK, /* Undock request */ | ||
1185 | } hotkey_wakeup_reason; | ||
1186 | |||
1187 | static int hotkey_autosleep_ack; | ||
1188 | |||
1189 | static int hotkey_orig_status; | ||
1190 | static u32 hotkey_orig_mask; | ||
1191 | static u32 hotkey_all_mask; | ||
1192 | static u32 hotkey_reserved_mask; | ||
1193 | static u32 hotkey_mask; | ||
1194 | |||
1195 | static unsigned int hotkey_report_mode; | ||
1196 | |||
1197 | static u16 *hotkey_keycode_map; | ||
1198 | |||
1199 | static struct attribute_set *hotkey_dev_attributes; | ||
1200 | |||
1201 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1202 | #define HOTKEY_CONFIG_CRITICAL_START \ | ||
1203 | do { \ | ||
1204 | mutex_lock(&hotkey_thread_data_mutex); \ | ||
1205 | hotkey_config_change++; \ | ||
1206 | } while (0); | ||
1207 | #define HOTKEY_CONFIG_CRITICAL_END \ | ||
1208 | mutex_unlock(&hotkey_thread_data_mutex); | ||
1209 | #else | ||
1210 | #define HOTKEY_CONFIG_CRITICAL_START | ||
1211 | #define HOTKEY_CONFIG_CRITICAL_END | ||
1212 | #endif /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1213 | |||
1214 | /* HKEY.MHKG() return bits */ | ||
1215 | #define TP_HOTKEY_TABLET_MASK (1 << 3) | ||
1216 | |||
1217 | static int hotkey_get_wlsw(int *status) | ||
1218 | { | ||
1219 | if (!acpi_evalf(hkey_handle, status, "WLSW", "d")) | ||
1220 | return -EIO; | ||
1221 | return 0; | ||
1222 | } | ||
1223 | |||
1224 | static int hotkey_get_tablet_mode(int *status) | ||
1225 | { | ||
1226 | int s; | ||
1227 | |||
1228 | if (!acpi_evalf(hkey_handle, &s, "MHKG", "d")) | ||
1229 | return -EIO; | ||
1230 | |||
1231 | *status = ((s & TP_HOTKEY_TABLET_MASK) != 0); | ||
1232 | return 0; | ||
1233 | } | ||
1234 | |||
1235 | /* | ||
1236 | * Call with hotkey_mutex held | ||
1237 | */ | ||
1238 | static int hotkey_mask_get(void) | ||
1239 | { | ||
1240 | u32 m = 0; | ||
1241 | |||
1242 | if (tp_features.hotkey_mask) { | ||
1243 | if (!acpi_evalf(hkey_handle, &m, "DHKN", "d")) | ||
1244 | return -EIO; | ||
1245 | } | ||
1246 | hotkey_mask = m | (hotkey_source_mask & hotkey_mask); | ||
1247 | |||
1248 | return 0; | ||
1249 | } | ||
1250 | |||
1251 | /* | ||
1252 | * Call with hotkey_mutex held | ||
1253 | */ | ||
1254 | static int hotkey_mask_set(u32 mask) | ||
1255 | { | ||
1256 | int i; | ||
1257 | int rc = 0; | ||
1258 | |||
1259 | if (tp_features.hotkey_mask) { | ||
1260 | if (!tp_warned.hotkey_mask_ff && | ||
1261 | (mask == 0xffff || mask == 0xffffff || | ||
1262 | mask == 0xffffffff)) { | ||
1263 | tp_warned.hotkey_mask_ff = 1; | ||
1264 | printk(TPACPI_NOTICE | ||
1265 | "setting the hotkey mask to 0x%08x is likely " | ||
1266 | "not the best way to go about it\n", mask); | ||
1267 | printk(TPACPI_NOTICE | ||
1268 | "please consider using the driver defaults, " | ||
1269 | "and refer to up-to-date thinkpad-acpi " | ||
1270 | "documentation\n"); | ||
1271 | } | ||
1272 | |||
1273 | HOTKEY_CONFIG_CRITICAL_START | ||
1274 | for (i = 0; i < 32; i++) { | ||
1275 | u32 m = 1 << i; | ||
1276 | /* enable in firmware mask only keys not in NVRAM | ||
1277 | * mode, but enable the key in the cached hotkey_mask | ||
1278 | * regardless of mode, or the key will end up | ||
1279 | * disabled by hotkey_mask_get() */ | ||
1280 | if (!acpi_evalf(hkey_handle, | ||
1281 | NULL, "MHKM", "vdd", i + 1, | ||
1282 | !!((mask & ~hotkey_source_mask) & m))) { | ||
1283 | rc = -EIO; | ||
1284 | break; | ||
1285 | } else { | ||
1286 | hotkey_mask = (hotkey_mask & ~m) | (mask & m); | ||
1287 | } | ||
1288 | } | ||
1289 | HOTKEY_CONFIG_CRITICAL_END | ||
1290 | |||
1291 | /* hotkey_mask_get must be called unconditionally below */ | ||
1292 | if (!hotkey_mask_get() && !rc && | ||
1293 | (hotkey_mask & ~hotkey_source_mask) != | ||
1294 | (mask & ~hotkey_source_mask)) { | ||
1295 | printk(TPACPI_NOTICE | ||
1296 | "requested hot key mask 0x%08x, but " | ||
1297 | "firmware forced it to 0x%08x\n", | ||
1298 | mask, hotkey_mask); | ||
1299 | } | ||
1300 | } else { | ||
1301 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1302 | HOTKEY_CONFIG_CRITICAL_START | ||
1303 | hotkey_mask = mask & hotkey_source_mask; | ||
1304 | HOTKEY_CONFIG_CRITICAL_END | ||
1305 | hotkey_mask_get(); | ||
1306 | if (hotkey_mask != mask) { | ||
1307 | printk(TPACPI_NOTICE | ||
1308 | "requested hot key mask 0x%08x, " | ||
1309 | "forced to 0x%08x (NVRAM poll mask is " | ||
1310 | "0x%08x): no firmware mask support\n", | ||
1311 | mask, hotkey_mask, hotkey_source_mask); | ||
1312 | } | ||
1313 | #else | ||
1314 | hotkey_mask_get(); | ||
1315 | rc = -ENXIO; | ||
1316 | #endif /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1317 | } | ||
1318 | |||
1319 | return rc; | ||
1320 | } | ||
1321 | |||
1322 | static int hotkey_status_get(int *status) | ||
1323 | { | ||
1324 | if (!acpi_evalf(hkey_handle, status, "DHKC", "d")) | ||
1325 | return -EIO; | ||
1326 | |||
1327 | return 0; | ||
1328 | } | ||
1329 | |||
1330 | static int hotkey_status_set(int status) | ||
1331 | { | ||
1332 | if (!acpi_evalf(hkey_handle, NULL, "MHKC", "vd", status)) | ||
1333 | return -EIO; | ||
1334 | |||
1335 | return 0; | ||
1336 | } | ||
1337 | |||
1338 | static void tpacpi_input_send_tabletsw(void) | ||
1339 | { | ||
1340 | int state; | ||
1341 | |||
1342 | if (tp_features.hotkey_tablet && | ||
1343 | !hotkey_get_tablet_mode(&state)) { | ||
1344 | mutex_lock(&tpacpi_inputdev_send_mutex); | ||
1345 | |||
1346 | input_report_switch(tpacpi_inputdev, | ||
1347 | SW_TABLET_MODE, !!state); | ||
1348 | input_sync(tpacpi_inputdev); | ||
1349 | |||
1350 | mutex_unlock(&tpacpi_inputdev_send_mutex); | ||
1351 | } | ||
1352 | } | ||
1353 | |||
1354 | static void tpacpi_input_send_key(unsigned int scancode) | ||
1355 | { | ||
1356 | unsigned int keycode; | ||
1357 | |||
1358 | keycode = hotkey_keycode_map[scancode]; | ||
1359 | |||
1360 | if (keycode != KEY_RESERVED) { | ||
1361 | mutex_lock(&tpacpi_inputdev_send_mutex); | ||
1362 | |||
1363 | input_report_key(tpacpi_inputdev, keycode, 1); | ||
1364 | if (keycode == KEY_UNKNOWN) | ||
1365 | input_event(tpacpi_inputdev, EV_MSC, MSC_SCAN, | ||
1366 | scancode); | ||
1367 | input_sync(tpacpi_inputdev); | ||
1368 | |||
1369 | input_report_key(tpacpi_inputdev, keycode, 0); | ||
1370 | if (keycode == KEY_UNKNOWN) | ||
1371 | input_event(tpacpi_inputdev, EV_MSC, MSC_SCAN, | ||
1372 | scancode); | ||
1373 | input_sync(tpacpi_inputdev); | ||
1374 | |||
1375 | mutex_unlock(&tpacpi_inputdev_send_mutex); | ||
1376 | } | ||
1377 | } | ||
1378 | |||
1379 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1380 | static struct tp_acpi_drv_struct ibm_hotkey_acpidriver; | ||
1381 | |||
1382 | static void tpacpi_hotkey_send_key(unsigned int scancode) | ||
1383 | { | ||
1384 | tpacpi_input_send_key(scancode); | ||
1385 | if (hotkey_report_mode < 2) { | ||
1386 | acpi_bus_generate_proc_event(ibm_hotkey_acpidriver.device, | ||
1387 | 0x80, 0x1001 + scancode); | ||
1388 | } | ||
1389 | } | ||
1390 | |||
1391 | static void hotkey_read_nvram(struct tp_nvram_state *n, u32 m) | ||
1392 | { | ||
1393 | u8 d; | ||
1394 | |||
1395 | if (m & TP_NVRAM_HKEY_GROUP_HK2) { | ||
1396 | d = nvram_read_byte(TP_NVRAM_ADDR_HK2); | ||
1397 | n->thinkpad_toggle = !!(d & TP_NVRAM_MASK_HKT_THINKPAD); | ||
1398 | n->zoom_toggle = !!(d & TP_NVRAM_MASK_HKT_ZOOM); | ||
1399 | n->display_toggle = !!(d & TP_NVRAM_MASK_HKT_DISPLAY); | ||
1400 | n->hibernate_toggle = !!(d & TP_NVRAM_MASK_HKT_HIBERNATE); | ||
1401 | } | ||
1402 | if (m & TP_ACPI_HKEY_THNKLGHT_MASK) { | ||
1403 | d = nvram_read_byte(TP_NVRAM_ADDR_THINKLIGHT); | ||
1404 | n->thinklight_toggle = !!(d & TP_NVRAM_MASK_THINKLIGHT); | ||
1405 | } | ||
1406 | if (m & TP_ACPI_HKEY_DISPXPAND_MASK) { | ||
1407 | d = nvram_read_byte(TP_NVRAM_ADDR_VIDEO); | ||
1408 | n->displayexp_toggle = | ||
1409 | !!(d & TP_NVRAM_MASK_HKT_DISPEXPND); | ||
1410 | } | ||
1411 | if (m & TP_NVRAM_HKEY_GROUP_BRIGHTNESS) { | ||
1412 | d = nvram_read_byte(TP_NVRAM_ADDR_BRIGHTNESS); | ||
1413 | n->brightness_level = (d & TP_NVRAM_MASK_LEVEL_BRIGHTNESS) | ||
1414 | >> TP_NVRAM_POS_LEVEL_BRIGHTNESS; | ||
1415 | n->brightness_toggle = | ||
1416 | !!(d & TP_NVRAM_MASK_HKT_BRIGHTNESS); | ||
1417 | } | ||
1418 | if (m & TP_NVRAM_HKEY_GROUP_VOLUME) { | ||
1419 | d = nvram_read_byte(TP_NVRAM_ADDR_MIXER); | ||
1420 | n->volume_level = (d & TP_NVRAM_MASK_LEVEL_VOLUME) | ||
1421 | >> TP_NVRAM_POS_LEVEL_VOLUME; | ||
1422 | n->mute = !!(d & TP_NVRAM_MASK_MUTE); | ||
1423 | n->volume_toggle = !!(d & TP_NVRAM_MASK_HKT_VOLUME); | ||
1424 | } | ||
1425 | } | ||
1426 | |||
1427 | #define TPACPI_COMPARE_KEY(__scancode, __member) \ | ||
1428 | do { \ | ||
1429 | if ((mask & (1 << __scancode)) && \ | ||
1430 | oldn->__member != newn->__member) \ | ||
1431 | tpacpi_hotkey_send_key(__scancode); \ | ||
1432 | } while (0) | ||
1433 | |||
1434 | #define TPACPI_MAY_SEND_KEY(__scancode) \ | ||
1435 | do { if (mask & (1 << __scancode)) \ | ||
1436 | tpacpi_hotkey_send_key(__scancode); } while (0) | ||
1437 | |||
1438 | static void hotkey_compare_and_issue_event(struct tp_nvram_state *oldn, | ||
1439 | struct tp_nvram_state *newn, | ||
1440 | u32 mask) | ||
1441 | { | ||
1442 | TPACPI_COMPARE_KEY(TP_ACPI_HOTKEYSCAN_THINKPAD, thinkpad_toggle); | ||
1443 | TPACPI_COMPARE_KEY(TP_ACPI_HOTKEYSCAN_FNSPACE, zoom_toggle); | ||
1444 | TPACPI_COMPARE_KEY(TP_ACPI_HOTKEYSCAN_FNF7, display_toggle); | ||
1445 | TPACPI_COMPARE_KEY(TP_ACPI_HOTKEYSCAN_FNF12, hibernate_toggle); | ||
1446 | |||
1447 | TPACPI_COMPARE_KEY(TP_ACPI_HOTKEYSCAN_FNPAGEUP, thinklight_toggle); | ||
1448 | |||
1449 | TPACPI_COMPARE_KEY(TP_ACPI_HOTKEYSCAN_FNF8, displayexp_toggle); | ||
1450 | |||
1451 | /* handle volume */ | ||
1452 | if (oldn->volume_toggle != newn->volume_toggle) { | ||
1453 | if (oldn->mute != newn->mute) { | ||
1454 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_MUTE); | ||
1455 | } | ||
1456 | if (oldn->volume_level > newn->volume_level) { | ||
1457 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_VOLUMEDOWN); | ||
1458 | } else if (oldn->volume_level < newn->volume_level) { | ||
1459 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_VOLUMEUP); | ||
1460 | } else if (oldn->mute == newn->mute) { | ||
1461 | /* repeated key presses that didn't change state */ | ||
1462 | if (newn->mute) { | ||
1463 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_MUTE); | ||
1464 | } else if (newn->volume_level != 0) { | ||
1465 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_VOLUMEUP); | ||
1466 | } else { | ||
1467 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_VOLUMEDOWN); | ||
1468 | } | ||
1469 | } | ||
1470 | } | ||
1471 | |||
1472 | /* handle brightness */ | ||
1473 | if (oldn->brightness_toggle != newn->brightness_toggle) { | ||
1474 | if (oldn->brightness_level < newn->brightness_level) { | ||
1475 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_FNHOME); | ||
1476 | } else if (oldn->brightness_level > newn->brightness_level) { | ||
1477 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_FNEND); | ||
1478 | } else { | ||
1479 | /* repeated key presses that didn't change state */ | ||
1480 | if (newn->brightness_level != 0) { | ||
1481 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_FNHOME); | ||
1482 | } else { | ||
1483 | TPACPI_MAY_SEND_KEY(TP_ACPI_HOTKEYSCAN_FNEND); | ||
1484 | } | ||
1485 | } | ||
1486 | } | ||
1487 | } | ||
1488 | |||
1489 | #undef TPACPI_COMPARE_KEY | ||
1490 | #undef TPACPI_MAY_SEND_KEY | ||
1491 | |||
1492 | static int hotkey_kthread(void *data) | ||
1493 | { | ||
1494 | struct tp_nvram_state s[2]; | ||
1495 | u32 mask; | ||
1496 | unsigned int si, so; | ||
1497 | unsigned long t; | ||
1498 | unsigned int change_detector, must_reset; | ||
1499 | |||
1500 | mutex_lock(&hotkey_thread_mutex); | ||
1501 | |||
1502 | if (tpacpi_lifecycle == TPACPI_LIFE_EXITING) | ||
1503 | goto exit; | ||
1504 | |||
1505 | set_freezable(); | ||
1506 | |||
1507 | so = 0; | ||
1508 | si = 1; | ||
1509 | t = 0; | ||
1510 | |||
1511 | /* Initial state for compares */ | ||
1512 | mutex_lock(&hotkey_thread_data_mutex); | ||
1513 | change_detector = hotkey_config_change; | ||
1514 | mask = hotkey_source_mask & hotkey_mask; | ||
1515 | mutex_unlock(&hotkey_thread_data_mutex); | ||
1516 | hotkey_read_nvram(&s[so], mask); | ||
1517 | |||
1518 | while (!kthread_should_stop() && hotkey_poll_freq) { | ||
1519 | if (t == 0) | ||
1520 | t = 1000/hotkey_poll_freq; | ||
1521 | t = msleep_interruptible(t); | ||
1522 | if (unlikely(kthread_should_stop())) | ||
1523 | break; | ||
1524 | must_reset = try_to_freeze(); | ||
1525 | if (t > 0 && !must_reset) | ||
1526 | continue; | ||
1527 | |||
1528 | mutex_lock(&hotkey_thread_data_mutex); | ||
1529 | if (must_reset || hotkey_config_change != change_detector) { | ||
1530 | /* forget old state on thaw or config change */ | ||
1531 | si = so; | ||
1532 | t = 0; | ||
1533 | change_detector = hotkey_config_change; | ||
1534 | } | ||
1535 | mask = hotkey_source_mask & hotkey_mask; | ||
1536 | mutex_unlock(&hotkey_thread_data_mutex); | ||
1537 | |||
1538 | if (likely(mask)) { | ||
1539 | hotkey_read_nvram(&s[si], mask); | ||
1540 | if (likely(si != so)) { | ||
1541 | hotkey_compare_and_issue_event(&s[so], &s[si], | ||
1542 | mask); | ||
1543 | } | ||
1544 | } | ||
1545 | |||
1546 | so = si; | ||
1547 | si ^= 1; | ||
1548 | } | ||
1549 | |||
1550 | exit: | ||
1551 | mutex_unlock(&hotkey_thread_mutex); | ||
1552 | return 0; | ||
1553 | } | ||
1554 | |||
1555 | static void hotkey_poll_stop_sync(void) | ||
1556 | { | ||
1557 | if (tpacpi_hotkey_task) { | ||
1558 | if (frozen(tpacpi_hotkey_task) || | ||
1559 | freezing(tpacpi_hotkey_task)) | ||
1560 | thaw_process(tpacpi_hotkey_task); | ||
1561 | |||
1562 | kthread_stop(tpacpi_hotkey_task); | ||
1563 | tpacpi_hotkey_task = NULL; | ||
1564 | mutex_lock(&hotkey_thread_mutex); | ||
1565 | /* at this point, the thread did exit */ | ||
1566 | mutex_unlock(&hotkey_thread_mutex); | ||
1567 | } | ||
1568 | } | ||
1569 | |||
1570 | /* call with hotkey_mutex held */ | ||
1571 | static void hotkey_poll_setup(int may_warn) | ||
1572 | { | ||
1573 | if ((hotkey_source_mask & hotkey_mask) != 0 && | ||
1574 | hotkey_poll_freq > 0 && | ||
1575 | (tpacpi_inputdev->users > 0 || hotkey_report_mode < 2)) { | ||
1576 | if (!tpacpi_hotkey_task) { | ||
1577 | tpacpi_hotkey_task = kthread_run(hotkey_kthread, | ||
1578 | NULL, TPACPI_NVRAM_KTHREAD_NAME); | ||
1579 | if (IS_ERR(tpacpi_hotkey_task)) { | ||
1580 | tpacpi_hotkey_task = NULL; | ||
1581 | printk(TPACPI_ERR | ||
1582 | "could not create kernel thread " | ||
1583 | "for hotkey polling\n"); | ||
1584 | } | ||
1585 | } | ||
1586 | } else { | ||
1587 | hotkey_poll_stop_sync(); | ||
1588 | if (may_warn && | ||
1589 | hotkey_source_mask != 0 && hotkey_poll_freq == 0) { | ||
1590 | printk(TPACPI_NOTICE | ||
1591 | "hot keys 0x%08x require polling, " | ||
1592 | "which is currently disabled\n", | ||
1593 | hotkey_source_mask); | ||
1594 | } | ||
1595 | } | ||
1596 | } | ||
1597 | |||
1598 | static void hotkey_poll_setup_safe(int may_warn) | ||
1599 | { | ||
1600 | mutex_lock(&hotkey_mutex); | ||
1601 | hotkey_poll_setup(may_warn); | ||
1602 | mutex_unlock(&hotkey_mutex); | ||
1603 | } | ||
1604 | |||
1605 | #else /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1606 | |||
1607 | static void hotkey_poll_setup_safe(int __unused) | ||
1608 | { | ||
1609 | } | ||
1610 | |||
1611 | #endif /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1612 | |||
1613 | static int hotkey_inputdev_open(struct input_dev *dev) | ||
1614 | { | ||
1615 | switch (tpacpi_lifecycle) { | ||
1616 | case TPACPI_LIFE_INIT: | ||
1617 | /* | ||
1618 | * hotkey_init will call hotkey_poll_setup_safe | ||
1619 | * at the appropriate moment | ||
1620 | */ | ||
1621 | return 0; | ||
1622 | case TPACPI_LIFE_EXITING: | ||
1623 | return -EBUSY; | ||
1624 | case TPACPI_LIFE_RUNNING: | ||
1625 | hotkey_poll_setup_safe(0); | ||
1626 | return 0; | ||
1627 | } | ||
1628 | |||
1629 | /* Should only happen if tpacpi_lifecycle is corrupt */ | ||
1630 | BUG(); | ||
1631 | return -EBUSY; | ||
1632 | } | ||
1633 | |||
1634 | static void hotkey_inputdev_close(struct input_dev *dev) | ||
1635 | { | ||
1636 | /* disable hotkey polling when possible */ | ||
1637 | if (tpacpi_lifecycle == TPACPI_LIFE_RUNNING) | ||
1638 | hotkey_poll_setup_safe(0); | ||
1639 | } | ||
1640 | |||
1641 | /* sysfs hotkey enable ------------------------------------------------- */ | ||
1642 | static ssize_t hotkey_enable_show(struct device *dev, | ||
1643 | struct device_attribute *attr, | ||
1644 | char *buf) | ||
1645 | { | ||
1646 | int res, status; | ||
1647 | |||
1648 | res = hotkey_status_get(&status); | ||
1649 | if (res) | ||
1650 | return res; | ||
1651 | |||
1652 | return snprintf(buf, PAGE_SIZE, "%d\n", status); | ||
1653 | } | ||
1654 | |||
1655 | static ssize_t hotkey_enable_store(struct device *dev, | ||
1656 | struct device_attribute *attr, | ||
1657 | const char *buf, size_t count) | ||
1658 | { | ||
1659 | unsigned long t; | ||
1660 | int res; | ||
1661 | |||
1662 | if (parse_strtoul(buf, 1, &t)) | ||
1663 | return -EINVAL; | ||
1664 | |||
1665 | res = hotkey_status_set(t); | ||
1666 | |||
1667 | return (res) ? res : count; | ||
1668 | } | ||
1669 | |||
1670 | static struct device_attribute dev_attr_hotkey_enable = | ||
1671 | __ATTR(hotkey_enable, S_IWUSR | S_IRUGO, | ||
1672 | hotkey_enable_show, hotkey_enable_store); | ||
1673 | |||
1674 | /* sysfs hotkey mask --------------------------------------------------- */ | ||
1675 | static ssize_t hotkey_mask_show(struct device *dev, | ||
1676 | struct device_attribute *attr, | ||
1677 | char *buf) | ||
1678 | { | ||
1679 | int res; | ||
1680 | |||
1681 | if (mutex_lock_interruptible(&hotkey_mutex)) | ||
1682 | return -ERESTARTSYS; | ||
1683 | res = hotkey_mask_get(); | ||
1684 | mutex_unlock(&hotkey_mutex); | ||
1685 | |||
1686 | return (res)? | ||
1687 | res : snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_mask); | ||
1688 | } | ||
1689 | |||
1690 | static ssize_t hotkey_mask_store(struct device *dev, | ||
1691 | struct device_attribute *attr, | ||
1692 | const char *buf, size_t count) | ||
1693 | { | ||
1694 | unsigned long t; | ||
1695 | int res; | ||
1696 | |||
1697 | if (parse_strtoul(buf, 0xffffffffUL, &t)) | ||
1698 | return -EINVAL; | ||
1699 | |||
1700 | if (mutex_lock_interruptible(&hotkey_mutex)) | ||
1701 | return -ERESTARTSYS; | ||
1702 | |||
1703 | res = hotkey_mask_set(t); | ||
1704 | |||
1705 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1706 | hotkey_poll_setup(1); | ||
1707 | #endif | ||
1708 | |||
1709 | mutex_unlock(&hotkey_mutex); | ||
1710 | |||
1711 | return (res) ? res : count; | ||
1712 | } | ||
1713 | |||
1714 | static struct device_attribute dev_attr_hotkey_mask = | ||
1715 | __ATTR(hotkey_mask, S_IWUSR | S_IRUGO, | ||
1716 | hotkey_mask_show, hotkey_mask_store); | ||
1717 | |||
1718 | /* sysfs hotkey bios_enabled ------------------------------------------- */ | ||
1719 | static ssize_t hotkey_bios_enabled_show(struct device *dev, | ||
1720 | struct device_attribute *attr, | ||
1721 | char *buf) | ||
1722 | { | ||
1723 | return snprintf(buf, PAGE_SIZE, "%d\n", hotkey_orig_status); | ||
1724 | } | ||
1725 | |||
1726 | static struct device_attribute dev_attr_hotkey_bios_enabled = | ||
1727 | __ATTR(hotkey_bios_enabled, S_IRUGO, hotkey_bios_enabled_show, NULL); | ||
1728 | |||
1729 | /* sysfs hotkey bios_mask ---------------------------------------------- */ | ||
1730 | static ssize_t hotkey_bios_mask_show(struct device *dev, | ||
1731 | struct device_attribute *attr, | ||
1732 | char *buf) | ||
1733 | { | ||
1734 | return snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_orig_mask); | ||
1735 | } | ||
1736 | |||
1737 | static struct device_attribute dev_attr_hotkey_bios_mask = | ||
1738 | __ATTR(hotkey_bios_mask, S_IRUGO, hotkey_bios_mask_show, NULL); | ||
1739 | |||
1740 | /* sysfs hotkey all_mask ----------------------------------------------- */ | ||
1741 | static ssize_t hotkey_all_mask_show(struct device *dev, | ||
1742 | struct device_attribute *attr, | ||
1743 | char *buf) | ||
1744 | { | ||
1745 | return snprintf(buf, PAGE_SIZE, "0x%08x\n", | ||
1746 | hotkey_all_mask | hotkey_source_mask); | ||
1747 | } | ||
1748 | |||
1749 | static struct device_attribute dev_attr_hotkey_all_mask = | ||
1750 | __ATTR(hotkey_all_mask, S_IRUGO, hotkey_all_mask_show, NULL); | ||
1751 | |||
1752 | /* sysfs hotkey recommended_mask --------------------------------------- */ | ||
1753 | static ssize_t hotkey_recommended_mask_show(struct device *dev, | ||
1754 | struct device_attribute *attr, | ||
1755 | char *buf) | ||
1756 | { | ||
1757 | return snprintf(buf, PAGE_SIZE, "0x%08x\n", | ||
1758 | (hotkey_all_mask | hotkey_source_mask) | ||
1759 | & ~hotkey_reserved_mask); | ||
1760 | } | ||
1761 | |||
1762 | static struct device_attribute dev_attr_hotkey_recommended_mask = | ||
1763 | __ATTR(hotkey_recommended_mask, S_IRUGO, | ||
1764 | hotkey_recommended_mask_show, NULL); | ||
1765 | |||
1766 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1767 | |||
1768 | /* sysfs hotkey hotkey_source_mask ------------------------------------- */ | ||
1769 | static ssize_t hotkey_source_mask_show(struct device *dev, | ||
1770 | struct device_attribute *attr, | ||
1771 | char *buf) | ||
1772 | { | ||
1773 | return snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_source_mask); | ||
1774 | } | ||
1775 | |||
1776 | static ssize_t hotkey_source_mask_store(struct device *dev, | ||
1777 | struct device_attribute *attr, | ||
1778 | const char *buf, size_t count) | ||
1779 | { | ||
1780 | unsigned long t; | ||
1781 | |||
1782 | if (parse_strtoul(buf, 0xffffffffUL, &t) || | ||
1783 | ((t & ~TPACPI_HKEY_NVRAM_KNOWN_MASK) != 0)) | ||
1784 | return -EINVAL; | ||
1785 | |||
1786 | if (mutex_lock_interruptible(&hotkey_mutex)) | ||
1787 | return -ERESTARTSYS; | ||
1788 | |||
1789 | HOTKEY_CONFIG_CRITICAL_START | ||
1790 | hotkey_source_mask = t; | ||
1791 | HOTKEY_CONFIG_CRITICAL_END | ||
1792 | |||
1793 | hotkey_poll_setup(1); | ||
1794 | |||
1795 | mutex_unlock(&hotkey_mutex); | ||
1796 | |||
1797 | return count; | ||
1798 | } | ||
1799 | |||
1800 | static struct device_attribute dev_attr_hotkey_source_mask = | ||
1801 | __ATTR(hotkey_source_mask, S_IWUSR | S_IRUGO, | ||
1802 | hotkey_source_mask_show, hotkey_source_mask_store); | ||
1803 | |||
1804 | /* sysfs hotkey hotkey_poll_freq --------------------------------------- */ | ||
1805 | static ssize_t hotkey_poll_freq_show(struct device *dev, | ||
1806 | struct device_attribute *attr, | ||
1807 | char *buf) | ||
1808 | { | ||
1809 | return snprintf(buf, PAGE_SIZE, "%d\n", hotkey_poll_freq); | ||
1810 | } | ||
1811 | |||
1812 | static ssize_t hotkey_poll_freq_store(struct device *dev, | ||
1813 | struct device_attribute *attr, | ||
1814 | const char *buf, size_t count) | ||
1815 | { | ||
1816 | unsigned long t; | ||
1817 | |||
1818 | if (parse_strtoul(buf, 25, &t)) | ||
1819 | return -EINVAL; | ||
1820 | |||
1821 | if (mutex_lock_interruptible(&hotkey_mutex)) | ||
1822 | return -ERESTARTSYS; | ||
1823 | |||
1824 | hotkey_poll_freq = t; | ||
1825 | |||
1826 | hotkey_poll_setup(1); | ||
1827 | mutex_unlock(&hotkey_mutex); | ||
1828 | |||
1829 | return count; | ||
1830 | } | ||
1831 | |||
1832 | static struct device_attribute dev_attr_hotkey_poll_freq = | ||
1833 | __ATTR(hotkey_poll_freq, S_IWUSR | S_IRUGO, | ||
1834 | hotkey_poll_freq_show, hotkey_poll_freq_store); | ||
1835 | |||
1836 | #endif /* CONFIG_THINKPAD_ACPI_HOTKEY_POLL */ | ||
1837 | |||
1838 | /* sysfs hotkey radio_sw (pollable) ------------------------------------ */ | ||
1839 | static ssize_t hotkey_radio_sw_show(struct device *dev, | ||
1840 | struct device_attribute *attr, | ||
1841 | char *buf) | ||
1842 | { | ||
1843 | int res, s; | ||
1844 | res = hotkey_get_wlsw(&s); | ||
1845 | if (res < 0) | ||
1846 | return res; | ||
1847 | |||
1848 | return snprintf(buf, PAGE_SIZE, "%d\n", !!s); | ||
1849 | } | ||
1850 | |||
1851 | static struct device_attribute dev_attr_hotkey_radio_sw = | ||
1852 | __ATTR(hotkey_radio_sw, S_IRUGO, hotkey_radio_sw_show, NULL); | ||
1853 | |||
1854 | static void hotkey_radio_sw_notify_change(void) | ||
1855 | { | ||
1856 | if (tp_features.hotkey_wlsw) | ||
1857 | sysfs_notify(&tpacpi_pdev->dev.kobj, NULL, | ||
1858 | "hotkey_radio_sw"); | ||
1859 | } | ||
1860 | |||
1861 | /* sysfs hotkey tablet mode (pollable) --------------------------------- */ | ||
1862 | static ssize_t hotkey_tablet_mode_show(struct device *dev, | ||
1863 | struct device_attribute *attr, | ||
1864 | char *buf) | ||
1865 | { | ||
1866 | int res, s; | ||
1867 | res = hotkey_get_tablet_mode(&s); | ||
1868 | if (res < 0) | ||
1869 | return res; | ||
1870 | |||
1871 | return snprintf(buf, PAGE_SIZE, "%d\n", !!s); | ||
1872 | } | ||
1873 | |||
1874 | static struct device_attribute dev_attr_hotkey_tablet_mode = | ||
1875 | __ATTR(hotkey_tablet_mode, S_IRUGO, hotkey_tablet_mode_show, NULL); | ||
1876 | |||
1877 | static void hotkey_tablet_mode_notify_change(void) | ||
1878 | { | ||
1879 | if (tp_features.hotkey_tablet) | ||
1880 | sysfs_notify(&tpacpi_pdev->dev.kobj, NULL, | ||
1881 | "hotkey_tablet_mode"); | ||
1882 | } | ||
1883 | |||
1884 | /* sysfs hotkey report_mode -------------------------------------------- */ | ||
1885 | static ssize_t hotkey_report_mode_show(struct device *dev, | ||
1886 | struct device_attribute *attr, | ||
1887 | char *buf) | ||
1888 | { | ||
1889 | return snprintf(buf, PAGE_SIZE, "%d\n", | ||
1890 | (hotkey_report_mode != 0) ? hotkey_report_mode : 1); | ||
1891 | } | ||
1892 | |||
1893 | static struct device_attribute dev_attr_hotkey_report_mode = | ||
1894 | __ATTR(hotkey_report_mode, S_IRUGO, hotkey_report_mode_show, NULL); | ||
1895 | |||
1896 | /* sysfs wakeup reason (pollable) -------------------------------------- */ | ||
1897 | static ssize_t hotkey_wakeup_reason_show(struct device *dev, | ||
1898 | struct device_attribute *attr, | ||
1899 | char *buf) | ||
1900 | { | ||
1901 | return snprintf(buf, PAGE_SIZE, "%d\n", hotkey_wakeup_reason); | ||
1902 | } | ||
1903 | |||
1904 | static struct device_attribute dev_attr_hotkey_wakeup_reason = | ||
1905 | __ATTR(wakeup_reason, S_IRUGO, hotkey_wakeup_reason_show, NULL); | ||
1906 | |||
1907 | static void hotkey_wakeup_reason_notify_change(void) | ||
1908 | { | ||
1909 | if (tp_features.hotkey_mask) | ||
1910 | sysfs_notify(&tpacpi_pdev->dev.kobj, NULL, | ||
1911 | "wakeup_reason"); | ||
1912 | } | ||
1913 | |||
1914 | /* sysfs wakeup hotunplug_complete (pollable) -------------------------- */ | ||
1915 | static ssize_t hotkey_wakeup_hotunplug_complete_show(struct device *dev, | ||
1916 | struct device_attribute *attr, | ||
1917 | char *buf) | ||
1918 | { | ||
1919 | return snprintf(buf, PAGE_SIZE, "%d\n", hotkey_autosleep_ack); | ||
1920 | } | ||
1921 | |||
1922 | static struct device_attribute dev_attr_hotkey_wakeup_hotunplug_complete = | ||
1923 | __ATTR(wakeup_hotunplug_complete, S_IRUGO, | ||
1924 | hotkey_wakeup_hotunplug_complete_show, NULL); | ||
1925 | |||
1926 | static void hotkey_wakeup_hotunplug_complete_notify_change(void) | ||
1927 | { | ||
1928 | if (tp_features.hotkey_mask) | ||
1929 | sysfs_notify(&tpacpi_pdev->dev.kobj, NULL, | ||
1930 | "wakeup_hotunplug_complete"); | ||
1931 | } | ||
1932 | |||
1933 | /* --------------------------------------------------------------------- */ | ||
1934 | |||
1935 | static struct attribute *hotkey_attributes[] __initdata = { | ||
1936 | &dev_attr_hotkey_enable.attr, | ||
1937 | &dev_attr_hotkey_bios_enabled.attr, | ||
1938 | &dev_attr_hotkey_report_mode.attr, | ||
1939 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1940 | &dev_attr_hotkey_mask.attr, | ||
1941 | &dev_attr_hotkey_all_mask.attr, | ||
1942 | &dev_attr_hotkey_recommended_mask.attr, | ||
1943 | &dev_attr_hotkey_source_mask.attr, | ||
1944 | &dev_attr_hotkey_poll_freq.attr, | ||
1945 | #endif | ||
1946 | }; | ||
1947 | |||
1948 | static struct attribute *hotkey_mask_attributes[] __initdata = { | ||
1949 | &dev_attr_hotkey_bios_mask.attr, | ||
1950 | #ifndef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1951 | &dev_attr_hotkey_mask.attr, | ||
1952 | &dev_attr_hotkey_all_mask.attr, | ||
1953 | &dev_attr_hotkey_recommended_mask.attr, | ||
1954 | #endif | ||
1955 | &dev_attr_hotkey_wakeup_reason.attr, | ||
1956 | &dev_attr_hotkey_wakeup_hotunplug_complete.attr, | ||
1957 | }; | ||
1958 | |||
1959 | static void bluetooth_update_rfk(void); | ||
1960 | static void wan_update_rfk(void); | ||
1961 | static void tpacpi_send_radiosw_update(void) | ||
1962 | { | ||
1963 | int wlsw; | ||
1964 | |||
1965 | /* Sync these BEFORE sending any rfkill events */ | ||
1966 | if (tp_features.bluetooth) | ||
1967 | bluetooth_update_rfk(); | ||
1968 | if (tp_features.wan) | ||
1969 | wan_update_rfk(); | ||
1970 | |||
1971 | if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&wlsw)) { | ||
1972 | mutex_lock(&tpacpi_inputdev_send_mutex); | ||
1973 | |||
1974 | input_report_switch(tpacpi_inputdev, | ||
1975 | SW_RFKILL_ALL, !!wlsw); | ||
1976 | input_sync(tpacpi_inputdev); | ||
1977 | |||
1978 | mutex_unlock(&tpacpi_inputdev_send_mutex); | ||
1979 | } | ||
1980 | hotkey_radio_sw_notify_change(); | ||
1981 | } | ||
1982 | |||
1983 | static void hotkey_exit(void) | ||
1984 | { | ||
1985 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
1986 | hotkey_poll_stop_sync(); | ||
1987 | #endif | ||
1988 | |||
1989 | if (hotkey_dev_attributes) | ||
1990 | delete_attr_set(hotkey_dev_attributes, &tpacpi_pdev->dev.kobj); | ||
1991 | |||
1992 | kfree(hotkey_keycode_map); | ||
1993 | |||
1994 | if (tp_features.hotkey) { | ||
1995 | dbg_printk(TPACPI_DBG_EXIT, | ||
1996 | "restoring original hot key mask\n"); | ||
1997 | /* no short-circuit boolean operator below! */ | ||
1998 | if ((hotkey_mask_set(hotkey_orig_mask) | | ||
1999 | hotkey_status_set(hotkey_orig_status)) != 0) | ||
2000 | printk(TPACPI_ERR | ||
2001 | "failed to restore hot key mask " | ||
2002 | "to BIOS defaults\n"); | ||
2003 | } | ||
2004 | } | ||
2005 | |||
2006 | static int __init hotkey_init(struct ibm_init_struct *iibm) | ||
2007 | { | ||
2008 | /* Requirements for changing the default keymaps: | ||
2009 | * | ||
2010 | * 1. Many of the keys are mapped to KEY_RESERVED for very | ||
2011 | * good reasons. Do not change them unless you have deep | ||
2012 | * knowledge on the IBM and Lenovo ThinkPad firmware for | ||
2013 | * the various ThinkPad models. The driver behaves | ||
2014 | * differently for KEY_RESERVED: such keys have their | ||
2015 | * hot key mask *unset* in mask_recommended, and also | ||
2016 | * in the initial hot key mask programmed into the | ||
2017 | * firmware at driver load time, which means the firm- | ||
2018 | * ware may react very differently if you change them to | ||
2019 | * something else; | ||
2020 | * | ||
2021 | * 2. You must be subscribed to the linux-thinkpad and | ||
2022 | * ibm-acpi-devel mailing lists, and you should read the | ||
2023 | * list archives since 2007 if you want to change the | ||
2024 | * keymaps. This requirement exists so that you will | ||
2025 | * know the past history of problems with the thinkpad- | ||
2026 | * acpi driver keymaps, and also that you will be | ||
2027 | * listening to any bug reports; | ||
2028 | * | ||
2029 | * 3. Do not send thinkpad-acpi specific patches directly to | ||
2030 | * for merging, *ever*. Send them to the linux-acpi | ||
2031 | * mailinglist for comments. Merging is to be done only | ||
2032 | * through acpi-test and the ACPI maintainer. | ||
2033 | * | ||
2034 | * If the above is too much to ask, don't change the keymap. | ||
2035 | * Ask the thinkpad-acpi maintainer to do it, instead. | ||
2036 | */ | ||
2037 | static u16 ibm_keycode_map[] __initdata = { | ||
2038 | /* Scan Codes 0x00 to 0x0B: ACPI HKEY FN+F1..F12 */ | ||
2039 | KEY_FN_F1, KEY_FN_F2, KEY_COFFEE, KEY_SLEEP, | ||
2040 | KEY_WLAN, KEY_FN_F6, KEY_SWITCHVIDEOMODE, KEY_FN_F8, | ||
2041 | KEY_FN_F9, KEY_FN_F10, KEY_FN_F11, KEY_SUSPEND, | ||
2042 | |||
2043 | /* Scan codes 0x0C to 0x1F: Other ACPI HKEY hot keys */ | ||
2044 | KEY_UNKNOWN, /* 0x0C: FN+BACKSPACE */ | ||
2045 | KEY_UNKNOWN, /* 0x0D: FN+INSERT */ | ||
2046 | KEY_UNKNOWN, /* 0x0E: FN+DELETE */ | ||
2047 | |||
2048 | /* brightness: firmware always reacts to them, unless | ||
2049 | * X.org did some tricks in the radeon BIOS scratch | ||
2050 | * registers of *some* models */ | ||
2051 | KEY_RESERVED, /* 0x0F: FN+HOME (brightness up) */ | ||
2052 | KEY_RESERVED, /* 0x10: FN+END (brightness down) */ | ||
2053 | |||
2054 | /* Thinklight: firmware always react to it */ | ||
2055 | KEY_RESERVED, /* 0x11: FN+PGUP (thinklight toggle) */ | ||
2056 | |||
2057 | KEY_UNKNOWN, /* 0x12: FN+PGDOWN */ | ||
2058 | KEY_ZOOM, /* 0x13: FN+SPACE (zoom) */ | ||
2059 | |||
2060 | /* Volume: firmware always react to it and reprograms | ||
2061 | * the built-in *extra* mixer. Never map it to control | ||
2062 | * another mixer by default. */ | ||
2063 | KEY_RESERVED, /* 0x14: VOLUME UP */ | ||
2064 | KEY_RESERVED, /* 0x15: VOLUME DOWN */ | ||
2065 | KEY_RESERVED, /* 0x16: MUTE */ | ||
2066 | |||
2067 | KEY_VENDOR, /* 0x17: Thinkpad/AccessIBM/Lenovo */ | ||
2068 | |||
2069 | /* (assignments unknown, please report if found) */ | ||
2070 | KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, | ||
2071 | KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, | ||
2072 | }; | ||
2073 | static u16 lenovo_keycode_map[] __initdata = { | ||
2074 | /* Scan Codes 0x00 to 0x0B: ACPI HKEY FN+F1..F12 */ | ||
2075 | KEY_FN_F1, KEY_COFFEE, KEY_BATTERY, KEY_SLEEP, | ||
2076 | KEY_WLAN, KEY_FN_F6, KEY_SWITCHVIDEOMODE, KEY_FN_F8, | ||
2077 | KEY_FN_F9, KEY_FN_F10, KEY_FN_F11, KEY_SUSPEND, | ||
2078 | |||
2079 | /* Scan codes 0x0C to 0x1F: Other ACPI HKEY hot keys */ | ||
2080 | KEY_UNKNOWN, /* 0x0C: FN+BACKSPACE */ | ||
2081 | KEY_UNKNOWN, /* 0x0D: FN+INSERT */ | ||
2082 | KEY_UNKNOWN, /* 0x0E: FN+DELETE */ | ||
2083 | |||
2084 | /* These either have to go through ACPI video, or | ||
2085 | * act like in the IBM ThinkPads, so don't ever | ||
2086 | * enable them by default */ | ||
2087 | KEY_RESERVED, /* 0x0F: FN+HOME (brightness up) */ | ||
2088 | KEY_RESERVED, /* 0x10: FN+END (brightness down) */ | ||
2089 | |||
2090 | KEY_RESERVED, /* 0x11: FN+PGUP (thinklight toggle) */ | ||
2091 | |||
2092 | KEY_UNKNOWN, /* 0x12: FN+PGDOWN */ | ||
2093 | KEY_ZOOM, /* 0x13: FN+SPACE (zoom) */ | ||
2094 | |||
2095 | /* Volume: z60/z61, T60 (BIOS version?): firmware always | ||
2096 | * react to it and reprograms the built-in *extra* mixer. | ||
2097 | * Never map it to control another mixer by default. | ||
2098 | * | ||
2099 | * T60?, T61, R60?, R61: firmware and EC tries to send | ||
2100 | * these over the regular keyboard, so these are no-ops, | ||
2101 | * but there are still weird bugs re. MUTE, so do not | ||
2102 | * change unless you get test reports from all Lenovo | ||
2103 | * models. May cause the BIOS to interfere with the | ||
2104 | * HDA mixer. | ||
2105 | */ | ||
2106 | KEY_RESERVED, /* 0x14: VOLUME UP */ | ||
2107 | KEY_RESERVED, /* 0x15: VOLUME DOWN */ | ||
2108 | KEY_RESERVED, /* 0x16: MUTE */ | ||
2109 | |||
2110 | KEY_VENDOR, /* 0x17: Thinkpad/AccessIBM/Lenovo */ | ||
2111 | |||
2112 | /* (assignments unknown, please report if found) */ | ||
2113 | KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, | ||
2114 | KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, | ||
2115 | }; | ||
2116 | |||
2117 | #define TPACPI_HOTKEY_MAP_LEN ARRAY_SIZE(ibm_keycode_map) | ||
2118 | #define TPACPI_HOTKEY_MAP_SIZE sizeof(ibm_keycode_map) | ||
2119 | #define TPACPI_HOTKEY_MAP_TYPESIZE sizeof(ibm_keycode_map[0]) | ||
2120 | |||
2121 | int res, i; | ||
2122 | int status; | ||
2123 | int hkeyv; | ||
2124 | |||
2125 | vdbg_printk(TPACPI_DBG_INIT, "initializing hotkey subdriver\n"); | ||
2126 | |||
2127 | BUG_ON(!tpacpi_inputdev); | ||
2128 | BUG_ON(tpacpi_inputdev->open != NULL || | ||
2129 | tpacpi_inputdev->close != NULL); | ||
2130 | |||
2131 | TPACPI_ACPIHANDLE_INIT(hkey); | ||
2132 | mutex_init(&hotkey_mutex); | ||
2133 | |||
2134 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
2135 | mutex_init(&hotkey_thread_mutex); | ||
2136 | mutex_init(&hotkey_thread_data_mutex); | ||
2137 | #endif | ||
2138 | |||
2139 | /* hotkey not supported on 570 */ | ||
2140 | tp_features.hotkey = hkey_handle != NULL; | ||
2141 | |||
2142 | vdbg_printk(TPACPI_DBG_INIT, "hotkeys are %s\n", | ||
2143 | str_supported(tp_features.hotkey)); | ||
2144 | |||
2145 | if (!tp_features.hotkey) | ||
2146 | return 1; | ||
2147 | |||
2148 | tpacpi_disable_brightness_delay(); | ||
2149 | |||
2150 | hotkey_dev_attributes = create_attr_set(13, NULL); | ||
2151 | if (!hotkey_dev_attributes) | ||
2152 | return -ENOMEM; | ||
2153 | res = add_many_to_attr_set(hotkey_dev_attributes, | ||
2154 | hotkey_attributes, | ||
2155 | ARRAY_SIZE(hotkey_attributes)); | ||
2156 | if (res) | ||
2157 | goto err_exit; | ||
2158 | |||
2159 | /* mask not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p, | ||
2160 | A30, R30, R31, T20-22, X20-21, X22-24. Detected by checking | ||
2161 | for HKEY interface version 0x100 */ | ||
2162 | if (acpi_evalf(hkey_handle, &hkeyv, "MHKV", "qd")) { | ||
2163 | if ((hkeyv >> 8) != 1) { | ||
2164 | printk(TPACPI_ERR "unknown version of the " | ||
2165 | "HKEY interface: 0x%x\n", hkeyv); | ||
2166 | printk(TPACPI_ERR "please report this to %s\n", | ||
2167 | TPACPI_MAIL); | ||
2168 | } else { | ||
2169 | /* | ||
2170 | * MHKV 0x100 in A31, R40, R40e, | ||
2171 | * T4x, X31, and later | ||
2172 | */ | ||
2173 | tp_features.hotkey_mask = 1; | ||
2174 | } | ||
2175 | } | ||
2176 | |||
2177 | vdbg_printk(TPACPI_DBG_INIT, "hotkey masks are %s\n", | ||
2178 | str_supported(tp_features.hotkey_mask)); | ||
2179 | |||
2180 | if (tp_features.hotkey_mask) { | ||
2181 | if (!acpi_evalf(hkey_handle, &hotkey_all_mask, | ||
2182 | "MHKA", "qd")) { | ||
2183 | printk(TPACPI_ERR | ||
2184 | "missing MHKA handler, " | ||
2185 | "please report this to %s\n", | ||
2186 | TPACPI_MAIL); | ||
2187 | /* FN+F12, FN+F4, FN+F3 */ | ||
2188 | hotkey_all_mask = 0x080cU; | ||
2189 | } | ||
2190 | } | ||
2191 | |||
2192 | /* hotkey_source_mask *must* be zero for | ||
2193 | * the first hotkey_mask_get */ | ||
2194 | res = hotkey_status_get(&hotkey_orig_status); | ||
2195 | if (res) | ||
2196 | goto err_exit; | ||
2197 | |||
2198 | if (tp_features.hotkey_mask) { | ||
2199 | res = hotkey_mask_get(); | ||
2200 | if (res) | ||
2201 | goto err_exit; | ||
2202 | |||
2203 | hotkey_orig_mask = hotkey_mask; | ||
2204 | res = add_many_to_attr_set( | ||
2205 | hotkey_dev_attributes, | ||
2206 | hotkey_mask_attributes, | ||
2207 | ARRAY_SIZE(hotkey_mask_attributes)); | ||
2208 | if (res) | ||
2209 | goto err_exit; | ||
2210 | } | ||
2211 | |||
2212 | #ifdef CONFIG_THINKPAD_ACPI_HOTKEY_POLL | ||
2213 | if (tp_features.hotkey_mask) { | ||
2214 | hotkey_source_mask = TPACPI_HKEY_NVRAM_GOOD_MASK | ||
2215 | & ~hotkey_all_mask; | ||
2216 | } else { | ||
2217 | hotkey_source_mask = TPACPI_HKEY_NVRAM_GOOD_MASK; | ||
2218 | } | ||
2219 | |||
2220 | vdbg_printk(TPACPI_DBG_INIT, | ||
2221 | "hotkey source mask 0x%08x, polling freq %d\n", | ||
2222 | hotkey_source_mask, hotkey_poll_freq); | ||
2223 | #endif | ||
2224 | |||
2225 | /* Not all thinkpads have a hardware radio switch */ | ||
2226 | if (acpi_evalf(hkey_handle, &status, "WLSW", "qd")) { | ||
2227 | tp_features.hotkey_wlsw = 1; | ||
2228 | printk(TPACPI_INFO | ||
2229 | "radio switch found; radios are %s\n", | ||
2230 | enabled(status, 0)); | ||
2231 | } | ||
2232 | if (tp_features.hotkey_wlsw) | ||
2233 | res = add_to_attr_set(hotkey_dev_attributes, | ||
2234 | &dev_attr_hotkey_radio_sw.attr); | ||
2235 | |||
2236 | /* For X41t, X60t, X61t Tablets... */ | ||
2237 | if (!res && acpi_evalf(hkey_handle, &status, "MHKG", "qd")) { | ||
2238 | tp_features.hotkey_tablet = 1; | ||
2239 | printk(TPACPI_INFO | ||
2240 | "possible tablet mode switch found; " | ||
2241 | "ThinkPad in %s mode\n", | ||
2242 | (status & TP_HOTKEY_TABLET_MASK)? | ||
2243 | "tablet" : "laptop"); | ||
2244 | res = add_to_attr_set(hotkey_dev_attributes, | ||
2245 | &dev_attr_hotkey_tablet_mode.attr); | ||
2246 | } | ||
2247 | |||
2248 | if (!res) | ||
2249 | res = register_attr_set_with_sysfs( | ||
2250 | hotkey_dev_attributes, | ||
2251 | &tpacpi_pdev->dev.kobj); | ||
2252 | if (res) | ||
2253 | goto err_exit; | ||
2254 | |||
2255 | /* Set up key map */ | ||
2256 | |||
2257 | hotkey_keycode_map = kmalloc(TPACPI_HOTKEY_MAP_SIZE, | ||
2258 | GFP_KERNEL); | ||
2259 | if (!hotkey_keycode_map) { | ||
2260 | printk(TPACPI_ERR | ||
2261 | "failed to allocate memory for key map\n"); | ||
2262 | res = -ENOMEM; | ||
2263 | goto err_exit; | ||
2264 | } | ||
2265 | |||
2266 | if (thinkpad_id.vendor == PCI_VENDOR_ID_LENOVO) { | ||
2267 | dbg_printk(TPACPI_DBG_INIT, | ||
2268 | "using Lenovo default hot key map\n"); | ||
2269 | memcpy(hotkey_keycode_map, &lenovo_keycode_map, | ||
2270 | TPACPI_HOTKEY_MAP_SIZE); | ||
2271 | } else { | ||
2272 | dbg_printk(TPACPI_DBG_INIT, | ||
2273 | "using IBM default hot key map\n"); | ||
2274 | memcpy(hotkey_keycode_map, &ibm_keycode_map, | ||
2275 | TPACPI_HOTKEY_MAP_SIZE); | ||
2276 | } | ||
2277 | |||
2278 | set_bit(EV_KEY, tpacpi_inputdev->evbit); | ||
2279 | set_bit(EV_MSC, tpacpi_inputdev->evbit); | ||
2280 | set_bit(MSC_SCAN, tpacpi_inputdev->mscbit); | ||
2281 | tpacpi_inputdev->keycodesize = TPACPI_HOTKEY_MAP_TYPESIZE; | ||
2282 | tpacpi_inputdev->keycodemax = TPACPI_HOTKEY_MAP_LEN; | ||
2283 | tpacpi_inputdev->keycode = hotkey_keycode_map; | ||
2284 | for (i = 0; i < TPACPI_HOTKEY_MAP_LEN; i++) { | ||
2285 | if (hotkey_keycode_map[i] != KEY_RESERVED) { | ||
2286 | set_bit(hotkey_keycode_map[i], | ||
2287 | tpacpi_inputdev->keybit); | ||
2288 | } else { | ||
2289 | if (i < sizeof(hotkey_reserved_mask)*8) | ||
2290 | hotkey_reserved_mask |= 1 << i; | ||
2291 | } | ||
2292 | } | ||
2293 | |||
2294 | if (tp_features.hotkey_wlsw) { | ||
2295 | set_bit(EV_SW, tpacpi_inputdev->evbit); | ||
2296 | set_bit(SW_RFKILL_ALL, tpacpi_inputdev->swbit); | ||
2297 | } | ||
2298 | if (tp_features.hotkey_tablet) { | ||
2299 | set_bit(EV_SW, tpacpi_inputdev->evbit); | ||
2300 | set_bit(SW_TABLET_MODE, tpacpi_inputdev->swbit); | ||
2301 | } | ||
2302 | |||
2303 | /* Do not issue duplicate brightness change events to | ||
2304 | * userspace */ | ||
2305 | if (!tp_features.bright_acpimode) | ||
2306 | /* update bright_acpimode... */ | ||
2307 | tpacpi_check_std_acpi_brightness_support(); | ||
2308 | |||
2309 | if (tp_features.bright_acpimode) { | ||
2310 | printk(TPACPI_INFO | ||
2311 | "This ThinkPad has standard ACPI backlight " | ||
2312 | "brightness control, supported by the ACPI " | ||
2313 | "video driver\n"); | ||
2314 | printk(TPACPI_NOTICE | ||
2315 | "Disabling thinkpad-acpi brightness events " | ||
2316 | "by default...\n"); | ||
2317 | |||
2318 | /* The hotkey_reserved_mask change below is not | ||
2319 | * necessary while the keys are at KEY_RESERVED in the | ||
2320 | * default map, but better safe than sorry, leave it | ||
2321 | * here as a marker of what we have to do, especially | ||
2322 | * when we finally become able to set this at runtime | ||
2323 | * on response to X.org requests */ | ||
2324 | hotkey_reserved_mask |= | ||
2325 | (1 << TP_ACPI_HOTKEYSCAN_FNHOME) | ||
2326 | | (1 << TP_ACPI_HOTKEYSCAN_FNEND); | ||
2327 | } | ||
2328 | |||
2329 | dbg_printk(TPACPI_DBG_INIT, "enabling hot key handling\n"); | ||
2330 | res = hotkey_status_set(1); | ||
2331 | if (res) { | ||
2332 | hotkey_exit(); | ||
2333 | return res; | ||
2334 | } | ||
2335 | res = hotkey_mask_set(((hotkey_all_mask | hotkey_source_mask) | ||
2336 | & ~hotkey_reserved_mask) | ||
2337 | | hotkey_orig_mask); | ||
2338 | if (res < 0 && res != -ENXIO) { | ||
2339 | hotkey_exit(); | ||
2340 | return res; | ||
2341 | } | ||
2342 | |||
2343 | dbg_printk(TPACPI_DBG_INIT, | ||
2344 | "legacy hot key reporting over procfs %s\n", | ||
2345 | (hotkey_report_mode < 2) ? | ||
2346 | "enabled" : "disabled"); | ||
2347 | |||
2348 | tpacpi_inputdev->open = &hotkey_inputdev_open; | ||
2349 | tpacpi_inputdev->close = &hotkey_inputdev_close; | ||
2350 | |||
2351 | hotkey_poll_setup_safe(1); | ||
2352 | tpacpi_send_radiosw_update(); | ||
2353 | tpacpi_input_send_tabletsw(); | ||
2354 | |||
2355 | return 0; | ||
2356 | |||
2357 | err_exit: | ||
2358 | delete_attr_set(hotkey_dev_attributes, &tpacpi_pdev->dev.kobj); | ||
2359 | hotkey_dev_attributes = NULL; | ||
2360 | |||
2361 | return (res < 0)? res : 1; | ||
2362 | } | ||
2363 | |||
2364 | static void hotkey_notify(struct ibm_struct *ibm, u32 event) | ||
2365 | { | ||
2366 | u32 hkey; | ||
2367 | unsigned int scancode; | ||
2368 | int send_acpi_ev; | ||
2369 | int ignore_acpi_ev; | ||
2370 | int unk_ev; | ||
2371 | |||
2372 | if (event != 0x80) { | ||
2373 | printk(TPACPI_ERR | ||
2374 | "unknown HKEY notification event %d\n", event); | ||
2375 | /* forward it to userspace, maybe it knows how to handle it */ | ||
2376 | acpi_bus_generate_netlink_event( | ||
2377 | ibm->acpi->device->pnp.device_class, | ||
2378 | ibm->acpi->device->dev.bus_id, | ||
2379 | event, 0); | ||
2380 | return; | ||
2381 | } | ||
2382 | |||
2383 | while (1) { | ||
2384 | if (!acpi_evalf(hkey_handle, &hkey, "MHKP", "d")) { | ||
2385 | printk(TPACPI_ERR "failed to retrieve HKEY event\n"); | ||
2386 | return; | ||
2387 | } | ||
2388 | |||
2389 | if (hkey == 0) { | ||
2390 | /* queue empty */ | ||
2391 | return; | ||
2392 | } | ||
2393 | |||
2394 | send_acpi_ev = 1; | ||
2395 | ignore_acpi_ev = 0; | ||
2396 | unk_ev = 0; | ||
2397 | |||
2398 | switch (hkey >> 12) { | ||
2399 | case 1: | ||
2400 | /* 0x1000-0x1FFF: key presses */ | ||
2401 | scancode = hkey & 0xfff; | ||
2402 | if (scancode > 0 && scancode < 0x21) { | ||
2403 | scancode--; | ||
2404 | if (!(hotkey_source_mask & (1 << scancode))) { | ||
2405 | tpacpi_input_send_key(scancode); | ||
2406 | send_acpi_ev = 0; | ||
2407 | } else { | ||
2408 | ignore_acpi_ev = 1; | ||
2409 | } | ||
2410 | } else { | ||
2411 | unk_ev = 1; | ||
2412 | } | ||
2413 | break; | ||
2414 | case 2: | ||
2415 | /* Wakeup reason */ | ||
2416 | switch (hkey) { | ||
2417 | case 0x2304: /* suspend, undock */ | ||
2418 | case 0x2404: /* hibernation, undock */ | ||
2419 | hotkey_wakeup_reason = TP_ACPI_WAKEUP_UNDOCK; | ||
2420 | ignore_acpi_ev = 1; | ||
2421 | break; | ||
2422 | case 0x2305: /* suspend, bay eject */ | ||
2423 | case 0x2405: /* hibernation, bay eject */ | ||
2424 | hotkey_wakeup_reason = TP_ACPI_WAKEUP_BAYEJ; | ||
2425 | ignore_acpi_ev = 1; | ||
2426 | break; | ||
2427 | default: | ||
2428 | unk_ev = 1; | ||
2429 | } | ||
2430 | if (hotkey_wakeup_reason != TP_ACPI_WAKEUP_NONE) { | ||
2431 | printk(TPACPI_INFO | ||
2432 | "woke up due to a hot-unplug " | ||
2433 | "request...\n"); | ||
2434 | hotkey_wakeup_reason_notify_change(); | ||
2435 | } | ||
2436 | break; | ||
2437 | case 3: | ||
2438 | /* bay-related wakeups */ | ||
2439 | if (hkey == 0x3003) { | ||
2440 | hotkey_autosleep_ack = 1; | ||
2441 | printk(TPACPI_INFO | ||
2442 | "bay ejected\n"); | ||
2443 | hotkey_wakeup_hotunplug_complete_notify_change(); | ||
2444 | } else { | ||
2445 | unk_ev = 1; | ||
2446 | } | ||
2447 | break; | ||
2448 | case 4: | ||
2449 | /* dock-related wakeups */ | ||
2450 | if (hkey == 0x4003) { | ||
2451 | hotkey_autosleep_ack = 1; | ||
2452 | printk(TPACPI_INFO | ||
2453 | "undocked\n"); | ||
2454 | hotkey_wakeup_hotunplug_complete_notify_change(); | ||
2455 | } else { | ||
2456 | unk_ev = 1; | ||
2457 | } | ||
2458 | break; | ||
2459 | case 5: | ||
2460 | /* 0x5000-0x5FFF: human interface helpers */ | ||
2461 | switch (hkey) { | ||
2462 | case 0x5010: /* Lenovo new BIOS: brightness changed */ | ||
2463 | case 0x500b: /* X61t: tablet pen inserted into bay */ | ||
2464 | case 0x500c: /* X61t: tablet pen removed from bay */ | ||
2465 | break; | ||
2466 | case 0x5009: /* X41t-X61t: swivel up (tablet mode) */ | ||
2467 | case 0x500a: /* X41t-X61t: swivel down (normal mode) */ | ||
2468 | tpacpi_input_send_tabletsw(); | ||
2469 | hotkey_tablet_mode_notify_change(); | ||
2470 | send_acpi_ev = 0; | ||
2471 | break; | ||
2472 | case 0x5001: | ||
2473 | case 0x5002: | ||
2474 | /* LID switch events. Do not propagate */ | ||
2475 | ignore_acpi_ev = 1; | ||
2476 | break; | ||
2477 | default: | ||
2478 | unk_ev = 1; | ||
2479 | } | ||
2480 | break; | ||
2481 | case 7: | ||
2482 | /* 0x7000-0x7FFF: misc */ | ||
2483 | if (tp_features.hotkey_wlsw && hkey == 0x7000) { | ||
2484 | tpacpi_send_radiosw_update(); | ||
2485 | send_acpi_ev = 0; | ||
2486 | break; | ||
2487 | } | ||
2488 | /* fallthrough to default */ | ||
2489 | default: | ||
2490 | unk_ev = 1; | ||
2491 | } | ||
2492 | if (unk_ev) { | ||
2493 | printk(TPACPI_NOTICE | ||
2494 | "unhandled HKEY event 0x%04x\n", hkey); | ||
2495 | } | ||
2496 | |||
2497 | /* Legacy events */ | ||
2498 | if (!ignore_acpi_ev && | ||
2499 | (send_acpi_ev || hotkey_report_mode < 2)) { | ||
2500 | acpi_bus_generate_proc_event(ibm->acpi->device, | ||
2501 | event, hkey); | ||
2502 | } | ||
2503 | |||
2504 | /* netlink events */ | ||
2505 | if (!ignore_acpi_ev && send_acpi_ev) { | ||
2506 | acpi_bus_generate_netlink_event( | ||
2507 | ibm->acpi->device->pnp.device_class, | ||
2508 | ibm->acpi->device->dev.bus_id, | ||
2509 | event, hkey); | ||
2510 | } | ||
2511 | } | ||
2512 | } | ||
2513 | |||
2514 | static void hotkey_suspend(pm_message_t state) | ||
2515 | { | ||
2516 | /* Do these on suspend, we get the events on early resume! */ | ||
2517 | hotkey_wakeup_reason = TP_ACPI_WAKEUP_NONE; | ||
2518 | hotkey_autosleep_ack = 0; | ||
2519 | } | ||
2520 | |||
2521 | static void hotkey_resume(void) | ||
2522 | { | ||
2523 | tpacpi_disable_brightness_delay(); | ||
2524 | |||
2525 | if (hotkey_mask_get()) | ||
2526 | printk(TPACPI_ERR | ||
2527 | "error while trying to read hot key mask " | ||
2528 | "from firmware\n"); | ||
2529 | tpacpi_send_radiosw_update(); | ||
2530 | hotkey_tablet_mode_notify_change(); | ||
2531 | hotkey_wakeup_reason_notify_change(); | ||
2532 | hotkey_wakeup_hotunplug_complete_notify_change(); | ||
2533 | hotkey_poll_setup_safe(0); | ||
2534 | } | ||
2535 | |||
2536 | /* procfs -------------------------------------------------------------- */ | ||
2537 | static int hotkey_read(char *p) | ||
2538 | { | ||
2539 | int res, status; | ||
2540 | int len = 0; | ||
2541 | |||
2542 | if (!tp_features.hotkey) { | ||
2543 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
2544 | return len; | ||
2545 | } | ||
2546 | |||
2547 | if (mutex_lock_interruptible(&hotkey_mutex)) | ||
2548 | return -ERESTARTSYS; | ||
2549 | res = hotkey_status_get(&status); | ||
2550 | if (!res) | ||
2551 | res = hotkey_mask_get(); | ||
2552 | mutex_unlock(&hotkey_mutex); | ||
2553 | if (res) | ||
2554 | return res; | ||
2555 | |||
2556 | len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 0)); | ||
2557 | if (tp_features.hotkey_mask) { | ||
2558 | len += sprintf(p + len, "mask:\t\t0x%08x\n", hotkey_mask); | ||
2559 | len += sprintf(p + len, | ||
2560 | "commands:\tenable, disable, reset, <mask>\n"); | ||
2561 | } else { | ||
2562 | len += sprintf(p + len, "mask:\t\tnot supported\n"); | ||
2563 | len += sprintf(p + len, "commands:\tenable, disable, reset\n"); | ||
2564 | } | ||
2565 | |||
2566 | return len; | ||
2567 | } | ||
2568 | |||
2569 | static int hotkey_write(char *buf) | ||
2570 | { | ||
2571 | int res, status; | ||
2572 | u32 mask; | ||
2573 | char *cmd; | ||
2574 | |||
2575 | if (!tp_features.hotkey) | ||
2576 | return -ENODEV; | ||
2577 | |||
2578 | if (mutex_lock_interruptible(&hotkey_mutex)) | ||
2579 | return -ERESTARTSYS; | ||
2580 | |||
2581 | status = -1; | ||
2582 | mask = hotkey_mask; | ||
2583 | |||
2584 | res = 0; | ||
2585 | while ((cmd = next_cmd(&buf))) { | ||
2586 | if (strlencmp(cmd, "enable") == 0) { | ||
2587 | status = 1; | ||
2588 | } else if (strlencmp(cmd, "disable") == 0) { | ||
2589 | status = 0; | ||
2590 | } else if (strlencmp(cmd, "reset") == 0) { | ||
2591 | status = hotkey_orig_status; | ||
2592 | mask = hotkey_orig_mask; | ||
2593 | } else if (sscanf(cmd, "0x%x", &mask) == 1) { | ||
2594 | /* mask set */ | ||
2595 | } else if (sscanf(cmd, "%x", &mask) == 1) { | ||
2596 | /* mask set */ | ||
2597 | } else { | ||
2598 | res = -EINVAL; | ||
2599 | goto errexit; | ||
2600 | } | ||
2601 | } | ||
2602 | if (status != -1) | ||
2603 | res = hotkey_status_set(status); | ||
2604 | |||
2605 | if (!res && mask != hotkey_mask) | ||
2606 | res = hotkey_mask_set(mask); | ||
2607 | |||
2608 | errexit: | ||
2609 | mutex_unlock(&hotkey_mutex); | ||
2610 | return res; | ||
2611 | } | ||
2612 | |||
2613 | static const struct acpi_device_id ibm_htk_device_ids[] = { | ||
2614 | {TPACPI_ACPI_HKEY_HID, 0}, | ||
2615 | {"", 0}, | ||
2616 | }; | ||
2617 | |||
2618 | static struct tp_acpi_drv_struct ibm_hotkey_acpidriver = { | ||
2619 | .hid = ibm_htk_device_ids, | ||
2620 | .notify = hotkey_notify, | ||
2621 | .handle = &hkey_handle, | ||
2622 | .type = ACPI_DEVICE_NOTIFY, | ||
2623 | }; | ||
2624 | |||
2625 | static struct ibm_struct hotkey_driver_data = { | ||
2626 | .name = "hotkey", | ||
2627 | .read = hotkey_read, | ||
2628 | .write = hotkey_write, | ||
2629 | .exit = hotkey_exit, | ||
2630 | .resume = hotkey_resume, | ||
2631 | .suspend = hotkey_suspend, | ||
2632 | .acpi = &ibm_hotkey_acpidriver, | ||
2633 | }; | ||
2634 | |||
2635 | /************************************************************************* | ||
2636 | * Bluetooth subdriver | ||
2637 | */ | ||
2638 | |||
2639 | enum { | ||
2640 | /* ACPI GBDC/SBDC bits */ | ||
2641 | TP_ACPI_BLUETOOTH_HWPRESENT = 0x01, /* Bluetooth hw available */ | ||
2642 | TP_ACPI_BLUETOOTH_RADIOSSW = 0x02, /* Bluetooth radio enabled */ | ||
2643 | TP_ACPI_BLUETOOTH_UNK = 0x04, /* unknown function */ | ||
2644 | }; | ||
2645 | |||
2646 | static struct rfkill *tpacpi_bluetooth_rfkill; | ||
2647 | |||
2648 | static int bluetooth_get_radiosw(void) | ||
2649 | { | ||
2650 | int status; | ||
2651 | |||
2652 | if (!tp_features.bluetooth) | ||
2653 | return -ENODEV; | ||
2654 | |||
2655 | /* WLSW overrides bluetooth in firmware/hardware, reflect that */ | ||
2656 | if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&status) && !status) | ||
2657 | return RFKILL_STATE_HARD_BLOCKED; | ||
2658 | |||
2659 | if (!acpi_evalf(hkey_handle, &status, "GBDC", "d")) | ||
2660 | return -EIO; | ||
2661 | |||
2662 | return ((status & TP_ACPI_BLUETOOTH_RADIOSSW) != 0) ? | ||
2663 | RFKILL_STATE_UNBLOCKED : RFKILL_STATE_SOFT_BLOCKED; | ||
2664 | } | ||
2665 | |||
2666 | static void bluetooth_update_rfk(void) | ||
2667 | { | ||
2668 | int status; | ||
2669 | |||
2670 | if (!tpacpi_bluetooth_rfkill) | ||
2671 | return; | ||
2672 | |||
2673 | status = bluetooth_get_radiosw(); | ||
2674 | if (status < 0) | ||
2675 | return; | ||
2676 | rfkill_force_state(tpacpi_bluetooth_rfkill, status); | ||
2677 | } | ||
2678 | |||
2679 | static int bluetooth_set_radiosw(int radio_on, int update_rfk) | ||
2680 | { | ||
2681 | int status; | ||
2682 | |||
2683 | if (!tp_features.bluetooth) | ||
2684 | return -ENODEV; | ||
2685 | |||
2686 | /* WLSW overrides bluetooth in firmware/hardware, but there is no | ||
2687 | * reason to risk weird behaviour. */ | ||
2688 | if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&status) && !status | ||
2689 | && radio_on) | ||
2690 | return -EPERM; | ||
2691 | |||
2692 | if (!acpi_evalf(hkey_handle, &status, "GBDC", "d")) | ||
2693 | return -EIO; | ||
2694 | if (radio_on) | ||
2695 | status |= TP_ACPI_BLUETOOTH_RADIOSSW; | ||
2696 | else | ||
2697 | status &= ~TP_ACPI_BLUETOOTH_RADIOSSW; | ||
2698 | if (!acpi_evalf(hkey_handle, NULL, "SBDC", "vd", status)) | ||
2699 | return -EIO; | ||
2700 | |||
2701 | if (update_rfk) | ||
2702 | bluetooth_update_rfk(); | ||
2703 | |||
2704 | return 0; | ||
2705 | } | ||
2706 | |||
2707 | /* sysfs bluetooth enable ---------------------------------------------- */ | ||
2708 | static ssize_t bluetooth_enable_show(struct device *dev, | ||
2709 | struct device_attribute *attr, | ||
2710 | char *buf) | ||
2711 | { | ||
2712 | int status; | ||
2713 | |||
2714 | status = bluetooth_get_radiosw(); | ||
2715 | if (status < 0) | ||
2716 | return status; | ||
2717 | |||
2718 | return snprintf(buf, PAGE_SIZE, "%d\n", | ||
2719 | (status == RFKILL_STATE_UNBLOCKED) ? 1 : 0); | ||
2720 | } | ||
2721 | |||
2722 | static ssize_t bluetooth_enable_store(struct device *dev, | ||
2723 | struct device_attribute *attr, | ||
2724 | const char *buf, size_t count) | ||
2725 | { | ||
2726 | unsigned long t; | ||
2727 | int res; | ||
2728 | |||
2729 | if (parse_strtoul(buf, 1, &t)) | ||
2730 | return -EINVAL; | ||
2731 | |||
2732 | res = bluetooth_set_radiosw(t, 1); | ||
2733 | |||
2734 | return (res) ? res : count; | ||
2735 | } | ||
2736 | |||
2737 | static struct device_attribute dev_attr_bluetooth_enable = | ||
2738 | __ATTR(bluetooth_enable, S_IWUSR | S_IRUGO, | ||
2739 | bluetooth_enable_show, bluetooth_enable_store); | ||
2740 | |||
2741 | /* --------------------------------------------------------------------- */ | ||
2742 | |||
2743 | static struct attribute *bluetooth_attributes[] = { | ||
2744 | &dev_attr_bluetooth_enable.attr, | ||
2745 | NULL | ||
2746 | }; | ||
2747 | |||
2748 | static const struct attribute_group bluetooth_attr_group = { | ||
2749 | .attrs = bluetooth_attributes, | ||
2750 | }; | ||
2751 | |||
2752 | static int tpacpi_bluetooth_rfk_get(void *data, enum rfkill_state *state) | ||
2753 | { | ||
2754 | int bts = bluetooth_get_radiosw(); | ||
2755 | |||
2756 | if (bts < 0) | ||
2757 | return bts; | ||
2758 | |||
2759 | *state = bts; | ||
2760 | return 0; | ||
2761 | } | ||
2762 | |||
2763 | static int tpacpi_bluetooth_rfk_set(void *data, enum rfkill_state state) | ||
2764 | { | ||
2765 | return bluetooth_set_radiosw((state == RFKILL_STATE_UNBLOCKED), 0); | ||
2766 | } | ||
2767 | |||
2768 | static void bluetooth_exit(void) | ||
2769 | { | ||
2770 | if (tpacpi_bluetooth_rfkill) | ||
2771 | rfkill_unregister(tpacpi_bluetooth_rfkill); | ||
2772 | |||
2773 | sysfs_remove_group(&tpacpi_pdev->dev.kobj, | ||
2774 | &bluetooth_attr_group); | ||
2775 | } | ||
2776 | |||
2777 | static int __init bluetooth_init(struct ibm_init_struct *iibm) | ||
2778 | { | ||
2779 | int res; | ||
2780 | int status = 0; | ||
2781 | |||
2782 | vdbg_printk(TPACPI_DBG_INIT, "initializing bluetooth subdriver\n"); | ||
2783 | |||
2784 | TPACPI_ACPIHANDLE_INIT(hkey); | ||
2785 | |||
2786 | /* bluetooth not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p, | ||
2787 | G4x, R30, R31, R40e, R50e, T20-22, X20-21 */ | ||
2788 | tp_features.bluetooth = hkey_handle && | ||
2789 | acpi_evalf(hkey_handle, &status, "GBDC", "qd"); | ||
2790 | |||
2791 | vdbg_printk(TPACPI_DBG_INIT, "bluetooth is %s, status 0x%02x\n", | ||
2792 | str_supported(tp_features.bluetooth), | ||
2793 | status); | ||
2794 | |||
2795 | if (tp_features.bluetooth && | ||
2796 | !(status & TP_ACPI_BLUETOOTH_HWPRESENT)) { | ||
2797 | /* no bluetooth hardware present in system */ | ||
2798 | tp_features.bluetooth = 0; | ||
2799 | dbg_printk(TPACPI_DBG_INIT, | ||
2800 | "bluetooth hardware not installed\n"); | ||
2801 | } | ||
2802 | |||
2803 | if (!tp_features.bluetooth) | ||
2804 | return 1; | ||
2805 | |||
2806 | res = sysfs_create_group(&tpacpi_pdev->dev.kobj, | ||
2807 | &bluetooth_attr_group); | ||
2808 | if (res) | ||
2809 | return res; | ||
2810 | |||
2811 | res = tpacpi_new_rfkill(TPACPI_RFK_BLUETOOTH_SW_ID, | ||
2812 | &tpacpi_bluetooth_rfkill, | ||
2813 | RFKILL_TYPE_BLUETOOTH, | ||
2814 | "tpacpi_bluetooth_sw", | ||
2815 | tpacpi_bluetooth_rfk_set, | ||
2816 | tpacpi_bluetooth_rfk_get); | ||
2817 | if (res) { | ||
2818 | bluetooth_exit(); | ||
2819 | return res; | ||
2820 | } | ||
2821 | |||
2822 | return 0; | ||
2823 | } | ||
2824 | |||
2825 | /* procfs -------------------------------------------------------------- */ | ||
2826 | static int bluetooth_read(char *p) | ||
2827 | { | ||
2828 | int len = 0; | ||
2829 | int status = bluetooth_get_radiosw(); | ||
2830 | |||
2831 | if (!tp_features.bluetooth) | ||
2832 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
2833 | else { | ||
2834 | len += sprintf(p + len, "status:\t\t%s\n", | ||
2835 | (status == RFKILL_STATE_UNBLOCKED) ? | ||
2836 | "enabled" : "disabled"); | ||
2837 | len += sprintf(p + len, "commands:\tenable, disable\n"); | ||
2838 | } | ||
2839 | |||
2840 | return len; | ||
2841 | } | ||
2842 | |||
2843 | static int bluetooth_write(char *buf) | ||
2844 | { | ||
2845 | char *cmd; | ||
2846 | |||
2847 | if (!tp_features.bluetooth) | ||
2848 | return -ENODEV; | ||
2849 | |||
2850 | while ((cmd = next_cmd(&buf))) { | ||
2851 | if (strlencmp(cmd, "enable") == 0) { | ||
2852 | bluetooth_set_radiosw(1, 1); | ||
2853 | } else if (strlencmp(cmd, "disable") == 0) { | ||
2854 | bluetooth_set_radiosw(0, 1); | ||
2855 | } else | ||
2856 | return -EINVAL; | ||
2857 | } | ||
2858 | |||
2859 | return 0; | ||
2860 | } | ||
2861 | |||
2862 | static struct ibm_struct bluetooth_driver_data = { | ||
2863 | .name = "bluetooth", | ||
2864 | .read = bluetooth_read, | ||
2865 | .write = bluetooth_write, | ||
2866 | .exit = bluetooth_exit, | ||
2867 | }; | ||
2868 | |||
2869 | /************************************************************************* | ||
2870 | * Wan subdriver | ||
2871 | */ | ||
2872 | |||
2873 | enum { | ||
2874 | /* ACPI GWAN/SWAN bits */ | ||
2875 | TP_ACPI_WANCARD_HWPRESENT = 0x01, /* Wan hw available */ | ||
2876 | TP_ACPI_WANCARD_RADIOSSW = 0x02, /* Wan radio enabled */ | ||
2877 | TP_ACPI_WANCARD_UNK = 0x04, /* unknown function */ | ||
2878 | }; | ||
2879 | |||
2880 | static struct rfkill *tpacpi_wan_rfkill; | ||
2881 | |||
2882 | static int wan_get_radiosw(void) | ||
2883 | { | ||
2884 | int status; | ||
2885 | |||
2886 | if (!tp_features.wan) | ||
2887 | return -ENODEV; | ||
2888 | |||
2889 | /* WLSW overrides WWAN in firmware/hardware, reflect that */ | ||
2890 | if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&status) && !status) | ||
2891 | return RFKILL_STATE_HARD_BLOCKED; | ||
2892 | |||
2893 | if (!acpi_evalf(hkey_handle, &status, "GWAN", "d")) | ||
2894 | return -EIO; | ||
2895 | |||
2896 | return ((status & TP_ACPI_WANCARD_RADIOSSW) != 0) ? | ||
2897 | RFKILL_STATE_UNBLOCKED : RFKILL_STATE_SOFT_BLOCKED; | ||
2898 | } | ||
2899 | |||
2900 | static void wan_update_rfk(void) | ||
2901 | { | ||
2902 | int status; | ||
2903 | |||
2904 | if (!tpacpi_wan_rfkill) | ||
2905 | return; | ||
2906 | |||
2907 | status = wan_get_radiosw(); | ||
2908 | if (status < 0) | ||
2909 | return; | ||
2910 | rfkill_force_state(tpacpi_wan_rfkill, status); | ||
2911 | } | ||
2912 | |||
2913 | static int wan_set_radiosw(int radio_on, int update_rfk) | ||
2914 | { | ||
2915 | int status; | ||
2916 | |||
2917 | if (!tp_features.wan) | ||
2918 | return -ENODEV; | ||
2919 | |||
2920 | /* WLSW overrides bluetooth in firmware/hardware, but there is no | ||
2921 | * reason to risk weird behaviour. */ | ||
2922 | if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&status) && !status | ||
2923 | && radio_on) | ||
2924 | return -EPERM; | ||
2925 | |||
2926 | if (!acpi_evalf(hkey_handle, &status, "GWAN", "d")) | ||
2927 | return -EIO; | ||
2928 | if (radio_on) | ||
2929 | status |= TP_ACPI_WANCARD_RADIOSSW; | ||
2930 | else | ||
2931 | status &= ~TP_ACPI_WANCARD_RADIOSSW; | ||
2932 | if (!acpi_evalf(hkey_handle, NULL, "SWAN", "vd", status)) | ||
2933 | return -EIO; | ||
2934 | |||
2935 | if (update_rfk) | ||
2936 | wan_update_rfk(); | ||
2937 | |||
2938 | return 0; | ||
2939 | } | ||
2940 | |||
2941 | /* sysfs wan enable ---------------------------------------------------- */ | ||
2942 | static ssize_t wan_enable_show(struct device *dev, | ||
2943 | struct device_attribute *attr, | ||
2944 | char *buf) | ||
2945 | { | ||
2946 | int status; | ||
2947 | |||
2948 | status = wan_get_radiosw(); | ||
2949 | if (status < 0) | ||
2950 | return status; | ||
2951 | |||
2952 | return snprintf(buf, PAGE_SIZE, "%d\n", | ||
2953 | (status == RFKILL_STATE_UNBLOCKED) ? 1 : 0); | ||
2954 | } | ||
2955 | |||
2956 | static ssize_t wan_enable_store(struct device *dev, | ||
2957 | struct device_attribute *attr, | ||
2958 | const char *buf, size_t count) | ||
2959 | { | ||
2960 | unsigned long t; | ||
2961 | int res; | ||
2962 | |||
2963 | if (parse_strtoul(buf, 1, &t)) | ||
2964 | return -EINVAL; | ||
2965 | |||
2966 | res = wan_set_radiosw(t, 1); | ||
2967 | |||
2968 | return (res) ? res : count; | ||
2969 | } | ||
2970 | |||
2971 | static struct device_attribute dev_attr_wan_enable = | ||
2972 | __ATTR(wwan_enable, S_IWUSR | S_IRUGO, | ||
2973 | wan_enable_show, wan_enable_store); | ||
2974 | |||
2975 | /* --------------------------------------------------------------------- */ | ||
2976 | |||
2977 | static struct attribute *wan_attributes[] = { | ||
2978 | &dev_attr_wan_enable.attr, | ||
2979 | NULL | ||
2980 | }; | ||
2981 | |||
2982 | static const struct attribute_group wan_attr_group = { | ||
2983 | .attrs = wan_attributes, | ||
2984 | }; | ||
2985 | |||
2986 | static int tpacpi_wan_rfk_get(void *data, enum rfkill_state *state) | ||
2987 | { | ||
2988 | int wans = wan_get_radiosw(); | ||
2989 | |||
2990 | if (wans < 0) | ||
2991 | return wans; | ||
2992 | |||
2993 | *state = wans; | ||
2994 | return 0; | ||
2995 | } | ||
2996 | |||
2997 | static int tpacpi_wan_rfk_set(void *data, enum rfkill_state state) | ||
2998 | { | ||
2999 | return wan_set_radiosw((state == RFKILL_STATE_UNBLOCKED), 0); | ||
3000 | } | ||
3001 | |||
3002 | static void wan_exit(void) | ||
3003 | { | ||
3004 | if (tpacpi_wan_rfkill) | ||
3005 | rfkill_unregister(tpacpi_wan_rfkill); | ||
3006 | |||
3007 | sysfs_remove_group(&tpacpi_pdev->dev.kobj, | ||
3008 | &wan_attr_group); | ||
3009 | } | ||
3010 | |||
3011 | static int __init wan_init(struct ibm_init_struct *iibm) | ||
3012 | { | ||
3013 | int res; | ||
3014 | int status = 0; | ||
3015 | |||
3016 | vdbg_printk(TPACPI_DBG_INIT, "initializing wan subdriver\n"); | ||
3017 | |||
3018 | TPACPI_ACPIHANDLE_INIT(hkey); | ||
3019 | |||
3020 | tp_features.wan = hkey_handle && | ||
3021 | acpi_evalf(hkey_handle, &status, "GWAN", "qd"); | ||
3022 | |||
3023 | vdbg_printk(TPACPI_DBG_INIT, "wan is %s, status 0x%02x\n", | ||
3024 | str_supported(tp_features.wan), | ||
3025 | status); | ||
3026 | |||
3027 | if (tp_features.wan && | ||
3028 | !(status & TP_ACPI_WANCARD_HWPRESENT)) { | ||
3029 | /* no wan hardware present in system */ | ||
3030 | tp_features.wan = 0; | ||
3031 | dbg_printk(TPACPI_DBG_INIT, | ||
3032 | "wan hardware not installed\n"); | ||
3033 | } | ||
3034 | |||
3035 | if (!tp_features.wan) | ||
3036 | return 1; | ||
3037 | |||
3038 | res = sysfs_create_group(&tpacpi_pdev->dev.kobj, | ||
3039 | &wan_attr_group); | ||
3040 | if (res) | ||
3041 | return res; | ||
3042 | |||
3043 | res = tpacpi_new_rfkill(TPACPI_RFK_WWAN_SW_ID, | ||
3044 | &tpacpi_wan_rfkill, | ||
3045 | RFKILL_TYPE_WWAN, | ||
3046 | "tpacpi_wwan_sw", | ||
3047 | tpacpi_wan_rfk_set, | ||
3048 | tpacpi_wan_rfk_get); | ||
3049 | if (res) { | ||
3050 | wan_exit(); | ||
3051 | return res; | ||
3052 | } | ||
3053 | |||
3054 | return 0; | ||
3055 | } | ||
3056 | |||
3057 | /* procfs -------------------------------------------------------------- */ | ||
3058 | static int wan_read(char *p) | ||
3059 | { | ||
3060 | int len = 0; | ||
3061 | int status = wan_get_radiosw(); | ||
3062 | |||
3063 | if (!tp_features.wan) | ||
3064 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
3065 | else { | ||
3066 | len += sprintf(p + len, "status:\t\t%s\n", | ||
3067 | (status == RFKILL_STATE_UNBLOCKED) ? | ||
3068 | "enabled" : "disabled"); | ||
3069 | len += sprintf(p + len, "commands:\tenable, disable\n"); | ||
3070 | } | ||
3071 | |||
3072 | return len; | ||
3073 | } | ||
3074 | |||
3075 | static int wan_write(char *buf) | ||
3076 | { | ||
3077 | char *cmd; | ||
3078 | |||
3079 | if (!tp_features.wan) | ||
3080 | return -ENODEV; | ||
3081 | |||
3082 | while ((cmd = next_cmd(&buf))) { | ||
3083 | if (strlencmp(cmd, "enable") == 0) { | ||
3084 | wan_set_radiosw(1, 1); | ||
3085 | } else if (strlencmp(cmd, "disable") == 0) { | ||
3086 | wan_set_radiosw(0, 1); | ||
3087 | } else | ||
3088 | return -EINVAL; | ||
3089 | } | ||
3090 | |||
3091 | return 0; | ||
3092 | } | ||
3093 | |||
3094 | static struct ibm_struct wan_driver_data = { | ||
3095 | .name = "wan", | ||
3096 | .read = wan_read, | ||
3097 | .write = wan_write, | ||
3098 | .exit = wan_exit, | ||
3099 | }; | ||
3100 | |||
3101 | /************************************************************************* | ||
3102 | * Video subdriver | ||
3103 | */ | ||
3104 | |||
3105 | #ifdef CONFIG_THINKPAD_ACPI_VIDEO | ||
3106 | |||
3107 | enum video_access_mode { | ||
3108 | TPACPI_VIDEO_NONE = 0, | ||
3109 | TPACPI_VIDEO_570, /* 570 */ | ||
3110 | TPACPI_VIDEO_770, /* 600e/x, 770e, 770x */ | ||
3111 | TPACPI_VIDEO_NEW, /* all others */ | ||
3112 | }; | ||
3113 | |||
3114 | enum { /* video status flags, based on VIDEO_570 */ | ||
3115 | TP_ACPI_VIDEO_S_LCD = 0x01, /* LCD output enabled */ | ||
3116 | TP_ACPI_VIDEO_S_CRT = 0x02, /* CRT output enabled */ | ||
3117 | TP_ACPI_VIDEO_S_DVI = 0x08, /* DVI output enabled */ | ||
3118 | }; | ||
3119 | |||
3120 | enum { /* TPACPI_VIDEO_570 constants */ | ||
3121 | TP_ACPI_VIDEO_570_PHSCMD = 0x87, /* unknown magic constant :( */ | ||
3122 | TP_ACPI_VIDEO_570_PHSMASK = 0x03, /* PHS bits that map to | ||
3123 | * video_status_flags */ | ||
3124 | TP_ACPI_VIDEO_570_PHS2CMD = 0x8b, /* unknown magic constant :( */ | ||
3125 | TP_ACPI_VIDEO_570_PHS2SET = 0x80, /* unknown magic constant :( */ | ||
3126 | }; | ||
3127 | |||
3128 | static enum video_access_mode video_supported; | ||
3129 | static int video_orig_autosw; | ||
3130 | |||
3131 | static int video_autosw_get(void); | ||
3132 | static int video_autosw_set(int enable); | ||
3133 | |||
3134 | TPACPI_HANDLE(vid2, root, "\\_SB.PCI0.AGPB.VID"); /* G41 */ | ||
3135 | |||
3136 | static int __init video_init(struct ibm_init_struct *iibm) | ||
3137 | { | ||
3138 | int ivga; | ||
3139 | |||
3140 | vdbg_printk(TPACPI_DBG_INIT, "initializing video subdriver\n"); | ||
3141 | |||
3142 | TPACPI_ACPIHANDLE_INIT(vid); | ||
3143 | TPACPI_ACPIHANDLE_INIT(vid2); | ||
3144 | |||
3145 | if (vid2_handle && acpi_evalf(NULL, &ivga, "\\IVGA", "d") && ivga) | ||
3146 | /* G41, assume IVGA doesn't change */ | ||
3147 | vid_handle = vid2_handle; | ||
3148 | |||
3149 | if (!vid_handle) | ||
3150 | /* video switching not supported on R30, R31 */ | ||
3151 | video_supported = TPACPI_VIDEO_NONE; | ||
3152 | else if (acpi_evalf(vid_handle, &video_orig_autosw, "SWIT", "qd")) | ||
3153 | /* 570 */ | ||
3154 | video_supported = TPACPI_VIDEO_570; | ||
3155 | else if (acpi_evalf(vid_handle, &video_orig_autosw, "^VADL", "qd")) | ||
3156 | /* 600e/x, 770e, 770x */ | ||
3157 | video_supported = TPACPI_VIDEO_770; | ||
3158 | else | ||
3159 | /* all others */ | ||
3160 | video_supported = TPACPI_VIDEO_NEW; | ||
3161 | |||
3162 | vdbg_printk(TPACPI_DBG_INIT, "video is %s, mode %d\n", | ||
3163 | str_supported(video_supported != TPACPI_VIDEO_NONE), | ||
3164 | video_supported); | ||
3165 | |||
3166 | return (video_supported != TPACPI_VIDEO_NONE)? 0 : 1; | ||
3167 | } | ||
3168 | |||
3169 | static void video_exit(void) | ||
3170 | { | ||
3171 | dbg_printk(TPACPI_DBG_EXIT, | ||
3172 | "restoring original video autoswitch mode\n"); | ||
3173 | if (video_autosw_set(video_orig_autosw)) | ||
3174 | printk(TPACPI_ERR "error while trying to restore original " | ||
3175 | "video autoswitch mode\n"); | ||
3176 | } | ||
3177 | |||
3178 | static int video_outputsw_get(void) | ||
3179 | { | ||
3180 | int status = 0; | ||
3181 | int i; | ||
3182 | |||
3183 | switch (video_supported) { | ||
3184 | case TPACPI_VIDEO_570: | ||
3185 | if (!acpi_evalf(NULL, &i, "\\_SB.PHS", "dd", | ||
3186 | TP_ACPI_VIDEO_570_PHSCMD)) | ||
3187 | return -EIO; | ||
3188 | status = i & TP_ACPI_VIDEO_570_PHSMASK; | ||
3189 | break; | ||
3190 | case TPACPI_VIDEO_770: | ||
3191 | if (!acpi_evalf(NULL, &i, "\\VCDL", "d")) | ||
3192 | return -EIO; | ||
3193 | if (i) | ||
3194 | status |= TP_ACPI_VIDEO_S_LCD; | ||
3195 | if (!acpi_evalf(NULL, &i, "\\VCDC", "d")) | ||
3196 | return -EIO; | ||
3197 | if (i) | ||
3198 | status |= TP_ACPI_VIDEO_S_CRT; | ||
3199 | break; | ||
3200 | case TPACPI_VIDEO_NEW: | ||
3201 | if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 1) || | ||
3202 | !acpi_evalf(NULL, &i, "\\VCDC", "d")) | ||
3203 | return -EIO; | ||
3204 | if (i) | ||
3205 | status |= TP_ACPI_VIDEO_S_CRT; | ||
3206 | |||
3207 | if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0) || | ||
3208 | !acpi_evalf(NULL, &i, "\\VCDL", "d")) | ||
3209 | return -EIO; | ||
3210 | if (i) | ||
3211 | status |= TP_ACPI_VIDEO_S_LCD; | ||
3212 | if (!acpi_evalf(NULL, &i, "\\VCDD", "d")) | ||
3213 | return -EIO; | ||
3214 | if (i) | ||
3215 | status |= TP_ACPI_VIDEO_S_DVI; | ||
3216 | break; | ||
3217 | default: | ||
3218 | return -ENOSYS; | ||
3219 | } | ||
3220 | |||
3221 | return status; | ||
3222 | } | ||
3223 | |||
3224 | static int video_outputsw_set(int status) | ||
3225 | { | ||
3226 | int autosw; | ||
3227 | int res = 0; | ||
3228 | |||
3229 | switch (video_supported) { | ||
3230 | case TPACPI_VIDEO_570: | ||
3231 | res = acpi_evalf(NULL, NULL, | ||
3232 | "\\_SB.PHS2", "vdd", | ||
3233 | TP_ACPI_VIDEO_570_PHS2CMD, | ||
3234 | status | TP_ACPI_VIDEO_570_PHS2SET); | ||
3235 | break; | ||
3236 | case TPACPI_VIDEO_770: | ||
3237 | autosw = video_autosw_get(); | ||
3238 | if (autosw < 0) | ||
3239 | return autosw; | ||
3240 | |||
3241 | res = video_autosw_set(1); | ||
3242 | if (res) | ||
3243 | return res; | ||
3244 | res = acpi_evalf(vid_handle, NULL, | ||
3245 | "ASWT", "vdd", status * 0x100, 0); | ||
3246 | if (!autosw && video_autosw_set(autosw)) { | ||
3247 | printk(TPACPI_ERR | ||
3248 | "video auto-switch left enabled due to error\n"); | ||
3249 | return -EIO; | ||
3250 | } | ||
3251 | break; | ||
3252 | case TPACPI_VIDEO_NEW: | ||
3253 | res = acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0x80) && | ||
3254 | acpi_evalf(NULL, NULL, "\\VSDS", "vdd", status, 1); | ||
3255 | break; | ||
3256 | default: | ||
3257 | return -ENOSYS; | ||
3258 | } | ||
3259 | |||
3260 | return (res)? 0 : -EIO; | ||
3261 | } | ||
3262 | |||
3263 | static int video_autosw_get(void) | ||
3264 | { | ||
3265 | int autosw = 0; | ||
3266 | |||
3267 | switch (video_supported) { | ||
3268 | case TPACPI_VIDEO_570: | ||
3269 | if (!acpi_evalf(vid_handle, &autosw, "SWIT", "d")) | ||
3270 | return -EIO; | ||
3271 | break; | ||
3272 | case TPACPI_VIDEO_770: | ||
3273 | case TPACPI_VIDEO_NEW: | ||
3274 | if (!acpi_evalf(vid_handle, &autosw, "^VDEE", "d")) | ||
3275 | return -EIO; | ||
3276 | break; | ||
3277 | default: | ||
3278 | return -ENOSYS; | ||
3279 | } | ||
3280 | |||
3281 | return autosw & 1; | ||
3282 | } | ||
3283 | |||
3284 | static int video_autosw_set(int enable) | ||
3285 | { | ||
3286 | if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", (enable)? 1 : 0)) | ||
3287 | return -EIO; | ||
3288 | return 0; | ||
3289 | } | ||
3290 | |||
3291 | static int video_outputsw_cycle(void) | ||
3292 | { | ||
3293 | int autosw = video_autosw_get(); | ||
3294 | int res; | ||
3295 | |||
3296 | if (autosw < 0) | ||
3297 | return autosw; | ||
3298 | |||
3299 | switch (video_supported) { | ||
3300 | case TPACPI_VIDEO_570: | ||
3301 | res = video_autosw_set(1); | ||
3302 | if (res) | ||
3303 | return res; | ||
3304 | res = acpi_evalf(ec_handle, NULL, "_Q16", "v"); | ||
3305 | break; | ||
3306 | case TPACPI_VIDEO_770: | ||
3307 | case TPACPI_VIDEO_NEW: | ||
3308 | res = video_autosw_set(1); | ||
3309 | if (res) | ||
3310 | return res; | ||
3311 | res = acpi_evalf(vid_handle, NULL, "VSWT", "v"); | ||
3312 | break; | ||
3313 | default: | ||
3314 | return -ENOSYS; | ||
3315 | } | ||
3316 | if (!autosw && video_autosw_set(autosw)) { | ||
3317 | printk(TPACPI_ERR | ||
3318 | "video auto-switch left enabled due to error\n"); | ||
3319 | return -EIO; | ||
3320 | } | ||
3321 | |||
3322 | return (res)? 0 : -EIO; | ||
3323 | } | ||
3324 | |||
3325 | static int video_expand_toggle(void) | ||
3326 | { | ||
3327 | switch (video_supported) { | ||
3328 | case TPACPI_VIDEO_570: | ||
3329 | return acpi_evalf(ec_handle, NULL, "_Q17", "v")? | ||
3330 | 0 : -EIO; | ||
3331 | case TPACPI_VIDEO_770: | ||
3332 | return acpi_evalf(vid_handle, NULL, "VEXP", "v")? | ||
3333 | 0 : -EIO; | ||
3334 | case TPACPI_VIDEO_NEW: | ||
3335 | return acpi_evalf(NULL, NULL, "\\VEXP", "v")? | ||
3336 | 0 : -EIO; | ||
3337 | default: | ||
3338 | return -ENOSYS; | ||
3339 | } | ||
3340 | /* not reached */ | ||
3341 | } | ||
3342 | |||
3343 | static int video_read(char *p) | ||
3344 | { | ||
3345 | int status, autosw; | ||
3346 | int len = 0; | ||
3347 | |||
3348 | if (video_supported == TPACPI_VIDEO_NONE) { | ||
3349 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
3350 | return len; | ||
3351 | } | ||
3352 | |||
3353 | status = video_outputsw_get(); | ||
3354 | if (status < 0) | ||
3355 | return status; | ||
3356 | |||
3357 | autosw = video_autosw_get(); | ||
3358 | if (autosw < 0) | ||
3359 | return autosw; | ||
3360 | |||
3361 | len += sprintf(p + len, "status:\t\tsupported\n"); | ||
3362 | len += sprintf(p + len, "lcd:\t\t%s\n", enabled(status, 0)); | ||
3363 | len += sprintf(p + len, "crt:\t\t%s\n", enabled(status, 1)); | ||
3364 | if (video_supported == TPACPI_VIDEO_NEW) | ||
3365 | len += sprintf(p + len, "dvi:\t\t%s\n", enabled(status, 3)); | ||
3366 | len += sprintf(p + len, "auto:\t\t%s\n", enabled(autosw, 0)); | ||
3367 | len += sprintf(p + len, "commands:\tlcd_enable, lcd_disable\n"); | ||
3368 | len += sprintf(p + len, "commands:\tcrt_enable, crt_disable\n"); | ||
3369 | if (video_supported == TPACPI_VIDEO_NEW) | ||
3370 | len += sprintf(p + len, "commands:\tdvi_enable, dvi_disable\n"); | ||
3371 | len += sprintf(p + len, "commands:\tauto_enable, auto_disable\n"); | ||
3372 | len += sprintf(p + len, "commands:\tvideo_switch, expand_toggle\n"); | ||
3373 | |||
3374 | return len; | ||
3375 | } | ||
3376 | |||
3377 | static int video_write(char *buf) | ||
3378 | { | ||
3379 | char *cmd; | ||
3380 | int enable, disable, status; | ||
3381 | int res; | ||
3382 | |||
3383 | if (video_supported == TPACPI_VIDEO_NONE) | ||
3384 | return -ENODEV; | ||
3385 | |||
3386 | enable = 0; | ||
3387 | disable = 0; | ||
3388 | |||
3389 | while ((cmd = next_cmd(&buf))) { | ||
3390 | if (strlencmp(cmd, "lcd_enable") == 0) { | ||
3391 | enable |= TP_ACPI_VIDEO_S_LCD; | ||
3392 | } else if (strlencmp(cmd, "lcd_disable") == 0) { | ||
3393 | disable |= TP_ACPI_VIDEO_S_LCD; | ||
3394 | } else if (strlencmp(cmd, "crt_enable") == 0) { | ||
3395 | enable |= TP_ACPI_VIDEO_S_CRT; | ||
3396 | } else if (strlencmp(cmd, "crt_disable") == 0) { | ||
3397 | disable |= TP_ACPI_VIDEO_S_CRT; | ||
3398 | } else if (video_supported == TPACPI_VIDEO_NEW && | ||
3399 | strlencmp(cmd, "dvi_enable") == 0) { | ||
3400 | enable |= TP_ACPI_VIDEO_S_DVI; | ||
3401 | } else if (video_supported == TPACPI_VIDEO_NEW && | ||
3402 | strlencmp(cmd, "dvi_disable") == 0) { | ||
3403 | disable |= TP_ACPI_VIDEO_S_DVI; | ||
3404 | } else if (strlencmp(cmd, "auto_enable") == 0) { | ||
3405 | res = video_autosw_set(1); | ||
3406 | if (res) | ||
3407 | return res; | ||
3408 | } else if (strlencmp(cmd, "auto_disable") == 0) { | ||
3409 | res = video_autosw_set(0); | ||
3410 | if (res) | ||
3411 | return res; | ||
3412 | } else if (strlencmp(cmd, "video_switch") == 0) { | ||
3413 | res = video_outputsw_cycle(); | ||
3414 | if (res) | ||
3415 | return res; | ||
3416 | } else if (strlencmp(cmd, "expand_toggle") == 0) { | ||
3417 | res = video_expand_toggle(); | ||
3418 | if (res) | ||
3419 | return res; | ||
3420 | } else | ||
3421 | return -EINVAL; | ||
3422 | } | ||
3423 | |||
3424 | if (enable || disable) { | ||
3425 | status = video_outputsw_get(); | ||
3426 | if (status < 0) | ||
3427 | return status; | ||
3428 | res = video_outputsw_set((status & ~disable) | enable); | ||
3429 | if (res) | ||
3430 | return res; | ||
3431 | } | ||
3432 | |||
3433 | return 0; | ||
3434 | } | ||
3435 | |||
3436 | static struct ibm_struct video_driver_data = { | ||
3437 | .name = "video", | ||
3438 | .read = video_read, | ||
3439 | .write = video_write, | ||
3440 | .exit = video_exit, | ||
3441 | }; | ||
3442 | |||
3443 | #endif /* CONFIG_THINKPAD_ACPI_VIDEO */ | ||
3444 | |||
3445 | /************************************************************************* | ||
3446 | * Light (thinklight) subdriver | ||
3447 | */ | ||
3448 | |||
3449 | TPACPI_HANDLE(lght, root, "\\LGHT"); /* A21e, A2xm/p, T20-22, X20-21 */ | ||
3450 | TPACPI_HANDLE(ledb, ec, "LEDB"); /* G4x */ | ||
3451 | |||
3452 | static int light_get_status(void) | ||
3453 | { | ||
3454 | int status = 0; | ||
3455 | |||
3456 | if (tp_features.light_status) { | ||
3457 | if (!acpi_evalf(ec_handle, &status, "KBLT", "d")) | ||
3458 | return -EIO; | ||
3459 | return (!!status); | ||
3460 | } | ||
3461 | |||
3462 | return -ENXIO; | ||
3463 | } | ||
3464 | |||
3465 | static int light_set_status(int status) | ||
3466 | { | ||
3467 | int rc; | ||
3468 | |||
3469 | if (tp_features.light) { | ||
3470 | if (cmos_handle) { | ||
3471 | rc = acpi_evalf(cmos_handle, NULL, NULL, "vd", | ||
3472 | (status)? | ||
3473 | TP_CMOS_THINKLIGHT_ON : | ||
3474 | TP_CMOS_THINKLIGHT_OFF); | ||
3475 | } else { | ||
3476 | rc = acpi_evalf(lght_handle, NULL, NULL, "vd", | ||
3477 | (status)? 1 : 0); | ||
3478 | } | ||
3479 | return (rc)? 0 : -EIO; | ||
3480 | } | ||
3481 | |||
3482 | return -ENXIO; | ||
3483 | } | ||
3484 | |||
3485 | static void light_set_status_worker(struct work_struct *work) | ||
3486 | { | ||
3487 | struct tpacpi_led_classdev *data = | ||
3488 | container_of(work, struct tpacpi_led_classdev, work); | ||
3489 | |||
3490 | if (likely(tpacpi_lifecycle == TPACPI_LIFE_RUNNING)) | ||
3491 | light_set_status((data->new_brightness != LED_OFF)); | ||
3492 | } | ||
3493 | |||
3494 | static void light_sysfs_set(struct led_classdev *led_cdev, | ||
3495 | enum led_brightness brightness) | ||
3496 | { | ||
3497 | struct tpacpi_led_classdev *data = | ||
3498 | container_of(led_cdev, | ||
3499 | struct tpacpi_led_classdev, | ||
3500 | led_classdev); | ||
3501 | data->new_brightness = brightness; | ||
3502 | queue_work(tpacpi_wq, &data->work); | ||
3503 | } | ||
3504 | |||
3505 | static enum led_brightness light_sysfs_get(struct led_classdev *led_cdev) | ||
3506 | { | ||
3507 | return (light_get_status() == 1)? LED_FULL : LED_OFF; | ||
3508 | } | ||
3509 | |||
3510 | static struct tpacpi_led_classdev tpacpi_led_thinklight = { | ||
3511 | .led_classdev = { | ||
3512 | .name = "tpacpi::thinklight", | ||
3513 | .brightness_set = &light_sysfs_set, | ||
3514 | .brightness_get = &light_sysfs_get, | ||
3515 | } | ||
3516 | }; | ||
3517 | |||
3518 | static int __init light_init(struct ibm_init_struct *iibm) | ||
3519 | { | ||
3520 | int rc; | ||
3521 | |||
3522 | vdbg_printk(TPACPI_DBG_INIT, "initializing light subdriver\n"); | ||
3523 | |||
3524 | TPACPI_ACPIHANDLE_INIT(ledb); | ||
3525 | TPACPI_ACPIHANDLE_INIT(lght); | ||
3526 | TPACPI_ACPIHANDLE_INIT(cmos); | ||
3527 | INIT_WORK(&tpacpi_led_thinklight.work, light_set_status_worker); | ||
3528 | |||
3529 | /* light not supported on 570, 600e/x, 770e, 770x, G4x, R30, R31 */ | ||
3530 | tp_features.light = (cmos_handle || lght_handle) && !ledb_handle; | ||
3531 | |||
3532 | if (tp_features.light) | ||
3533 | /* light status not supported on | ||
3534 | 570, 600e/x, 770e, 770x, G4x, R30, R31, R32, X20 */ | ||
3535 | tp_features.light_status = | ||
3536 | acpi_evalf(ec_handle, NULL, "KBLT", "qv"); | ||
3537 | |||
3538 | vdbg_printk(TPACPI_DBG_INIT, "light is %s, light status is %s\n", | ||
3539 | str_supported(tp_features.light), | ||
3540 | str_supported(tp_features.light_status)); | ||
3541 | |||
3542 | if (!tp_features.light) | ||
3543 | return 1; | ||
3544 | |||
3545 | rc = led_classdev_register(&tpacpi_pdev->dev, | ||
3546 | &tpacpi_led_thinklight.led_classdev); | ||
3547 | |||
3548 | if (rc < 0) { | ||
3549 | tp_features.light = 0; | ||
3550 | tp_features.light_status = 0; | ||
3551 | } else { | ||
3552 | rc = 0; | ||
3553 | } | ||
3554 | |||
3555 | return rc; | ||
3556 | } | ||
3557 | |||
3558 | static void light_exit(void) | ||
3559 | { | ||
3560 | led_classdev_unregister(&tpacpi_led_thinklight.led_classdev); | ||
3561 | if (work_pending(&tpacpi_led_thinklight.work)) | ||
3562 | flush_workqueue(tpacpi_wq); | ||
3563 | } | ||
3564 | |||
3565 | static int light_read(char *p) | ||
3566 | { | ||
3567 | int len = 0; | ||
3568 | int status; | ||
3569 | |||
3570 | if (!tp_features.light) { | ||
3571 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
3572 | } else if (!tp_features.light_status) { | ||
3573 | len += sprintf(p + len, "status:\t\tunknown\n"); | ||
3574 | len += sprintf(p + len, "commands:\ton, off\n"); | ||
3575 | } else { | ||
3576 | status = light_get_status(); | ||
3577 | if (status < 0) | ||
3578 | return status; | ||
3579 | len += sprintf(p + len, "status:\t\t%s\n", onoff(status, 0)); | ||
3580 | len += sprintf(p + len, "commands:\ton, off\n"); | ||
3581 | } | ||
3582 | |||
3583 | return len; | ||
3584 | } | ||
3585 | |||
3586 | static int light_write(char *buf) | ||
3587 | { | ||
3588 | char *cmd; | ||
3589 | int newstatus = 0; | ||
3590 | |||
3591 | if (!tp_features.light) | ||
3592 | return -ENODEV; | ||
3593 | |||
3594 | while ((cmd = next_cmd(&buf))) { | ||
3595 | if (strlencmp(cmd, "on") == 0) { | ||
3596 | newstatus = 1; | ||
3597 | } else if (strlencmp(cmd, "off") == 0) { | ||
3598 | newstatus = 0; | ||
3599 | } else | ||
3600 | return -EINVAL; | ||
3601 | } | ||
3602 | |||
3603 | return light_set_status(newstatus); | ||
3604 | } | ||
3605 | |||
3606 | static struct ibm_struct light_driver_data = { | ||
3607 | .name = "light", | ||
3608 | .read = light_read, | ||
3609 | .write = light_write, | ||
3610 | .exit = light_exit, | ||
3611 | }; | ||
3612 | |||
3613 | /************************************************************************* | ||
3614 | * Dock subdriver | ||
3615 | */ | ||
3616 | |||
3617 | #ifdef CONFIG_THINKPAD_ACPI_DOCK | ||
3618 | |||
3619 | static void dock_notify(struct ibm_struct *ibm, u32 event); | ||
3620 | static int dock_read(char *p); | ||
3621 | static int dock_write(char *buf); | ||
3622 | |||
3623 | TPACPI_HANDLE(dock, root, "\\_SB.GDCK", /* X30, X31, X40 */ | ||
3624 | "\\_SB.PCI0.DOCK", /* 600e/x,770e,770x,A2xm/p,T20-22,X20-21 */ | ||
3625 | "\\_SB.PCI0.PCI1.DOCK", /* all others */ | ||
3626 | "\\_SB.PCI.ISA.SLCE", /* 570 */ | ||
3627 | ); /* A21e,G4x,R30,R31,R32,R40,R40e,R50e */ | ||
3628 | |||
3629 | /* don't list other alternatives as we install a notify handler on the 570 */ | ||
3630 | TPACPI_HANDLE(pci, root, "\\_SB.PCI"); /* 570 */ | ||
3631 | |||
3632 | static const struct acpi_device_id ibm_pci_device_ids[] = { | ||
3633 | {PCI_ROOT_HID_STRING, 0}, | ||
3634 | {"", 0}, | ||
3635 | }; | ||
3636 | |||
3637 | static struct tp_acpi_drv_struct ibm_dock_acpidriver[2] = { | ||
3638 | { | ||
3639 | .notify = dock_notify, | ||
3640 | .handle = &dock_handle, | ||
3641 | .type = ACPI_SYSTEM_NOTIFY, | ||
3642 | }, | ||
3643 | { | ||
3644 | /* THIS ONE MUST NEVER BE USED FOR DRIVER AUTOLOADING. | ||
3645 | * We just use it to get notifications of dock hotplug | ||
3646 | * in very old thinkpads */ | ||
3647 | .hid = ibm_pci_device_ids, | ||
3648 | .notify = dock_notify, | ||
3649 | .handle = &pci_handle, | ||
3650 | .type = ACPI_SYSTEM_NOTIFY, | ||
3651 | }, | ||
3652 | }; | ||
3653 | |||
3654 | static struct ibm_struct dock_driver_data[2] = { | ||
3655 | { | ||
3656 | .name = "dock", | ||
3657 | .read = dock_read, | ||
3658 | .write = dock_write, | ||
3659 | .acpi = &ibm_dock_acpidriver[0], | ||
3660 | }, | ||
3661 | { | ||
3662 | .name = "dock", | ||
3663 | .acpi = &ibm_dock_acpidriver[1], | ||
3664 | }, | ||
3665 | }; | ||
3666 | |||
3667 | #define dock_docked() (_sta(dock_handle) & 1) | ||
3668 | |||
3669 | static int __init dock_init(struct ibm_init_struct *iibm) | ||
3670 | { | ||
3671 | vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver\n"); | ||
3672 | |||
3673 | TPACPI_ACPIHANDLE_INIT(dock); | ||
3674 | |||
3675 | vdbg_printk(TPACPI_DBG_INIT, "dock is %s\n", | ||
3676 | str_supported(dock_handle != NULL)); | ||
3677 | |||
3678 | return (dock_handle)? 0 : 1; | ||
3679 | } | ||
3680 | |||
3681 | static int __init dock_init2(struct ibm_init_struct *iibm) | ||
3682 | { | ||
3683 | int dock2_needed; | ||
3684 | |||
3685 | vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver part 2\n"); | ||
3686 | |||
3687 | if (dock_driver_data[0].flags.acpi_driver_registered && | ||
3688 | dock_driver_data[0].flags.acpi_notify_installed) { | ||
3689 | TPACPI_ACPIHANDLE_INIT(pci); | ||
3690 | dock2_needed = (pci_handle != NULL); | ||
3691 | vdbg_printk(TPACPI_DBG_INIT, | ||
3692 | "dock PCI handler for the TP 570 is %s\n", | ||
3693 | str_supported(dock2_needed)); | ||
3694 | } else { | ||
3695 | vdbg_printk(TPACPI_DBG_INIT, | ||
3696 | "dock subdriver part 2 not required\n"); | ||
3697 | dock2_needed = 0; | ||
3698 | } | ||
3699 | |||
3700 | return (dock2_needed)? 0 : 1; | ||
3701 | } | ||
3702 | |||
3703 | static void dock_notify(struct ibm_struct *ibm, u32 event) | ||
3704 | { | ||
3705 | int docked = dock_docked(); | ||
3706 | int pci = ibm->acpi->hid && ibm->acpi->device && | ||
3707 | acpi_match_device_ids(ibm->acpi->device, ibm_pci_device_ids); | ||
3708 | int data; | ||
3709 | |||
3710 | if (event == 1 && !pci) /* 570 */ | ||
3711 | data = 1; /* button */ | ||
3712 | else if (event == 1 && pci) /* 570 */ | ||
3713 | data = 3; /* dock */ | ||
3714 | else if (event == 3 && docked) | ||
3715 | data = 1; /* button */ | ||
3716 | else if (event == 3 && !docked) | ||
3717 | data = 2; /* undock */ | ||
3718 | else if (event == 0 && docked) | ||
3719 | data = 3; /* dock */ | ||
3720 | else { | ||
3721 | printk(TPACPI_ERR "unknown dock event %d, status %d\n", | ||
3722 | event, _sta(dock_handle)); | ||
3723 | data = 0; /* unknown */ | ||
3724 | } | ||
3725 | acpi_bus_generate_proc_event(ibm->acpi->device, event, data); | ||
3726 | acpi_bus_generate_netlink_event(ibm->acpi->device->pnp.device_class, | ||
3727 | ibm->acpi->device->dev.bus_id, | ||
3728 | event, data); | ||
3729 | } | ||
3730 | |||
3731 | static int dock_read(char *p) | ||
3732 | { | ||
3733 | int len = 0; | ||
3734 | int docked = dock_docked(); | ||
3735 | |||
3736 | if (!dock_handle) | ||
3737 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
3738 | else if (!docked) | ||
3739 | len += sprintf(p + len, "status:\t\tundocked\n"); | ||
3740 | else { | ||
3741 | len += sprintf(p + len, "status:\t\tdocked\n"); | ||
3742 | len += sprintf(p + len, "commands:\tdock, undock\n"); | ||
3743 | } | ||
3744 | |||
3745 | return len; | ||
3746 | } | ||
3747 | |||
3748 | static int dock_write(char *buf) | ||
3749 | { | ||
3750 | char *cmd; | ||
3751 | |||
3752 | if (!dock_docked()) | ||
3753 | return -ENODEV; | ||
3754 | |||
3755 | while ((cmd = next_cmd(&buf))) { | ||
3756 | if (strlencmp(cmd, "undock") == 0) { | ||
3757 | if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 0) || | ||
3758 | !acpi_evalf(dock_handle, NULL, "_EJ0", "vd", 1)) | ||
3759 | return -EIO; | ||
3760 | } else if (strlencmp(cmd, "dock") == 0) { | ||
3761 | if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 1)) | ||
3762 | return -EIO; | ||
3763 | } else | ||
3764 | return -EINVAL; | ||
3765 | } | ||
3766 | |||
3767 | return 0; | ||
3768 | } | ||
3769 | |||
3770 | #endif /* CONFIG_THINKPAD_ACPI_DOCK */ | ||
3771 | |||
3772 | /************************************************************************* | ||
3773 | * Bay subdriver | ||
3774 | */ | ||
3775 | |||
3776 | #ifdef CONFIG_THINKPAD_ACPI_BAY | ||
3777 | |||
3778 | TPACPI_HANDLE(bay, root, "\\_SB.PCI.IDE.SECN.MAST", /* 570 */ | ||
3779 | "\\_SB.PCI0.IDE0.IDES.IDSM", /* 600e/x, 770e, 770x */ | ||
3780 | "\\_SB.PCI0.SATA.SCND.MSTR", /* T60, X60, Z60 */ | ||
3781 | "\\_SB.PCI0.IDE0.SCND.MSTR", /* all others */ | ||
3782 | ); /* A21e, R30, R31 */ | ||
3783 | TPACPI_HANDLE(bay_ej, bay, "_EJ3", /* 600e/x, A2xm/p, A3x */ | ||
3784 | "_EJ0", /* all others */ | ||
3785 | ); /* 570,A21e,G4x,R30,R31,R32,R40e,R50e */ | ||
3786 | TPACPI_HANDLE(bay2, root, "\\_SB.PCI0.IDE0.PRIM.SLAV", /* A3x, R32 */ | ||
3787 | "\\_SB.PCI0.IDE0.IDEP.IDPS", /* 600e/x, 770e, 770x */ | ||
3788 | ); /* all others */ | ||
3789 | TPACPI_HANDLE(bay2_ej, bay2, "_EJ3", /* 600e/x, 770e, A3x */ | ||
3790 | "_EJ0", /* 770x */ | ||
3791 | ); /* all others */ | ||
3792 | |||
3793 | static int __init bay_init(struct ibm_init_struct *iibm) | ||
3794 | { | ||
3795 | vdbg_printk(TPACPI_DBG_INIT, "initializing bay subdriver\n"); | ||
3796 | |||
3797 | TPACPI_ACPIHANDLE_INIT(bay); | ||
3798 | if (bay_handle) | ||
3799 | TPACPI_ACPIHANDLE_INIT(bay_ej); | ||
3800 | TPACPI_ACPIHANDLE_INIT(bay2); | ||
3801 | if (bay2_handle) | ||
3802 | TPACPI_ACPIHANDLE_INIT(bay2_ej); | ||
3803 | |||
3804 | tp_features.bay_status = bay_handle && | ||
3805 | acpi_evalf(bay_handle, NULL, "_STA", "qv"); | ||
3806 | tp_features.bay_status2 = bay2_handle && | ||
3807 | acpi_evalf(bay2_handle, NULL, "_STA", "qv"); | ||
3808 | |||
3809 | tp_features.bay_eject = bay_handle && bay_ej_handle && | ||
3810 | (strlencmp(bay_ej_path, "_EJ0") == 0 || experimental); | ||
3811 | tp_features.bay_eject2 = bay2_handle && bay2_ej_handle && | ||
3812 | (strlencmp(bay2_ej_path, "_EJ0") == 0 || experimental); | ||
3813 | |||
3814 | vdbg_printk(TPACPI_DBG_INIT, | ||
3815 | "bay 1: status %s, eject %s; bay 2: status %s, eject %s\n", | ||
3816 | str_supported(tp_features.bay_status), | ||
3817 | str_supported(tp_features.bay_eject), | ||
3818 | str_supported(tp_features.bay_status2), | ||
3819 | str_supported(tp_features.bay_eject2)); | ||
3820 | |||
3821 | return (tp_features.bay_status || tp_features.bay_eject || | ||
3822 | tp_features.bay_status2 || tp_features.bay_eject2)? 0 : 1; | ||
3823 | } | ||
3824 | |||
3825 | static void bay_notify(struct ibm_struct *ibm, u32 event) | ||
3826 | { | ||
3827 | acpi_bus_generate_proc_event(ibm->acpi->device, event, 0); | ||
3828 | acpi_bus_generate_netlink_event(ibm->acpi->device->pnp.device_class, | ||
3829 | ibm->acpi->device->dev.bus_id, | ||
3830 | event, 0); | ||
3831 | } | ||
3832 | |||
3833 | #define bay_occupied(b) (_sta(b##_handle) & 1) | ||
3834 | |||
3835 | static int bay_read(char *p) | ||
3836 | { | ||
3837 | int len = 0; | ||
3838 | int occupied = bay_occupied(bay); | ||
3839 | int occupied2 = bay_occupied(bay2); | ||
3840 | int eject, eject2; | ||
3841 | |||
3842 | len += sprintf(p + len, "status:\t\t%s\n", | ||
3843 | tp_features.bay_status ? | ||
3844 | (occupied ? "occupied" : "unoccupied") : | ||
3845 | "not supported"); | ||
3846 | if (tp_features.bay_status2) | ||
3847 | len += sprintf(p + len, "status2:\t%s\n", occupied2 ? | ||
3848 | "occupied" : "unoccupied"); | ||
3849 | |||
3850 | eject = tp_features.bay_eject && occupied; | ||
3851 | eject2 = tp_features.bay_eject2 && occupied2; | ||
3852 | |||
3853 | if (eject && eject2) | ||
3854 | len += sprintf(p + len, "commands:\teject, eject2\n"); | ||
3855 | else if (eject) | ||
3856 | len += sprintf(p + len, "commands:\teject\n"); | ||
3857 | else if (eject2) | ||
3858 | len += sprintf(p + len, "commands:\teject2\n"); | ||
3859 | |||
3860 | return len; | ||
3861 | } | ||
3862 | |||
3863 | static int bay_write(char *buf) | ||
3864 | { | ||
3865 | char *cmd; | ||
3866 | |||
3867 | if (!tp_features.bay_eject && !tp_features.bay_eject2) | ||
3868 | return -ENODEV; | ||
3869 | |||
3870 | while ((cmd = next_cmd(&buf))) { | ||
3871 | if (tp_features.bay_eject && strlencmp(cmd, "eject") == 0) { | ||
3872 | if (!acpi_evalf(bay_ej_handle, NULL, NULL, "vd", 1)) | ||
3873 | return -EIO; | ||
3874 | } else if (tp_features.bay_eject2 && | ||
3875 | strlencmp(cmd, "eject2") == 0) { | ||
3876 | if (!acpi_evalf(bay2_ej_handle, NULL, NULL, "vd", 1)) | ||
3877 | return -EIO; | ||
3878 | } else | ||
3879 | return -EINVAL; | ||
3880 | } | ||
3881 | |||
3882 | return 0; | ||
3883 | } | ||
3884 | |||
3885 | static struct tp_acpi_drv_struct ibm_bay_acpidriver = { | ||
3886 | .notify = bay_notify, | ||
3887 | .handle = &bay_handle, | ||
3888 | .type = ACPI_SYSTEM_NOTIFY, | ||
3889 | }; | ||
3890 | |||
3891 | static struct ibm_struct bay_driver_data = { | ||
3892 | .name = "bay", | ||
3893 | .read = bay_read, | ||
3894 | .write = bay_write, | ||
3895 | .acpi = &ibm_bay_acpidriver, | ||
3896 | }; | ||
3897 | |||
3898 | #endif /* CONFIG_THINKPAD_ACPI_BAY */ | ||
3899 | |||
3900 | /************************************************************************* | ||
3901 | * CMOS subdriver | ||
3902 | */ | ||
3903 | |||
3904 | /* sysfs cmos_command -------------------------------------------------- */ | ||
3905 | static ssize_t cmos_command_store(struct device *dev, | ||
3906 | struct device_attribute *attr, | ||
3907 | const char *buf, size_t count) | ||
3908 | { | ||
3909 | unsigned long cmos_cmd; | ||
3910 | int res; | ||
3911 | |||
3912 | if (parse_strtoul(buf, 21, &cmos_cmd)) | ||
3913 | return -EINVAL; | ||
3914 | |||
3915 | res = issue_thinkpad_cmos_command(cmos_cmd); | ||
3916 | return (res)? res : count; | ||
3917 | } | ||
3918 | |||
3919 | static struct device_attribute dev_attr_cmos_command = | ||
3920 | __ATTR(cmos_command, S_IWUSR, NULL, cmos_command_store); | ||
3921 | |||
3922 | /* --------------------------------------------------------------------- */ | ||
3923 | |||
3924 | static int __init cmos_init(struct ibm_init_struct *iibm) | ||
3925 | { | ||
3926 | int res; | ||
3927 | |||
3928 | vdbg_printk(TPACPI_DBG_INIT, | ||
3929 | "initializing cmos commands subdriver\n"); | ||
3930 | |||
3931 | TPACPI_ACPIHANDLE_INIT(cmos); | ||
3932 | |||
3933 | vdbg_printk(TPACPI_DBG_INIT, "cmos commands are %s\n", | ||
3934 | str_supported(cmos_handle != NULL)); | ||
3935 | |||
3936 | res = device_create_file(&tpacpi_pdev->dev, &dev_attr_cmos_command); | ||
3937 | if (res) | ||
3938 | return res; | ||
3939 | |||
3940 | return (cmos_handle)? 0 : 1; | ||
3941 | } | ||
3942 | |||
3943 | static void cmos_exit(void) | ||
3944 | { | ||
3945 | device_remove_file(&tpacpi_pdev->dev, &dev_attr_cmos_command); | ||
3946 | } | ||
3947 | |||
3948 | static int cmos_read(char *p) | ||
3949 | { | ||
3950 | int len = 0; | ||
3951 | |||
3952 | /* cmos not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p, | ||
3953 | R30, R31, T20-22, X20-21 */ | ||
3954 | if (!cmos_handle) | ||
3955 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
3956 | else { | ||
3957 | len += sprintf(p + len, "status:\t\tsupported\n"); | ||
3958 | len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-21)\n"); | ||
3959 | } | ||
3960 | |||
3961 | return len; | ||
3962 | } | ||
3963 | |||
3964 | static int cmos_write(char *buf) | ||
3965 | { | ||
3966 | char *cmd; | ||
3967 | int cmos_cmd, res; | ||
3968 | |||
3969 | while ((cmd = next_cmd(&buf))) { | ||
3970 | if (sscanf(cmd, "%u", &cmos_cmd) == 1 && | ||
3971 | cmos_cmd >= 0 && cmos_cmd <= 21) { | ||
3972 | /* cmos_cmd set */ | ||
3973 | } else | ||
3974 | return -EINVAL; | ||
3975 | |||
3976 | res = issue_thinkpad_cmos_command(cmos_cmd); | ||
3977 | if (res) | ||
3978 | return res; | ||
3979 | } | ||
3980 | |||
3981 | return 0; | ||
3982 | } | ||
3983 | |||
3984 | static struct ibm_struct cmos_driver_data = { | ||
3985 | .name = "cmos", | ||
3986 | .read = cmos_read, | ||
3987 | .write = cmos_write, | ||
3988 | .exit = cmos_exit, | ||
3989 | }; | ||
3990 | |||
3991 | /************************************************************************* | ||
3992 | * LED subdriver | ||
3993 | */ | ||
3994 | |||
3995 | enum led_access_mode { | ||
3996 | TPACPI_LED_NONE = 0, | ||
3997 | TPACPI_LED_570, /* 570 */ | ||
3998 | TPACPI_LED_OLD, /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */ | ||
3999 | TPACPI_LED_NEW, /* all others */ | ||
4000 | }; | ||
4001 | |||
4002 | enum { /* For TPACPI_LED_OLD */ | ||
4003 | TPACPI_LED_EC_HLCL = 0x0c, /* EC reg to get led to power on */ | ||
4004 | TPACPI_LED_EC_HLBL = 0x0d, /* EC reg to blink a lit led */ | ||
4005 | TPACPI_LED_EC_HLMS = 0x0e, /* EC reg to select led to command */ | ||
4006 | }; | ||
4007 | |||
4008 | enum led_status_t { | ||
4009 | TPACPI_LED_OFF = 0, | ||
4010 | TPACPI_LED_ON, | ||
4011 | TPACPI_LED_BLINK, | ||
4012 | }; | ||
4013 | |||
4014 | static enum led_access_mode led_supported; | ||
4015 | |||
4016 | TPACPI_HANDLE(led, ec, "SLED", /* 570 */ | ||
4017 | "SYSL", /* 600e/x, 770e, 770x, A21e, A2xm/p, */ | ||
4018 | /* T20-22, X20-21 */ | ||
4019 | "LED", /* all others */ | ||
4020 | ); /* R30, R31 */ | ||
4021 | |||
4022 | #define TPACPI_LED_NUMLEDS 8 | ||
4023 | static struct tpacpi_led_classdev *tpacpi_leds; | ||
4024 | static enum led_status_t tpacpi_led_state_cache[TPACPI_LED_NUMLEDS]; | ||
4025 | static const char * const tpacpi_led_names[TPACPI_LED_NUMLEDS] = { | ||
4026 | /* there's a limit of 19 chars + NULL before 2.6.26 */ | ||
4027 | "tpacpi::power", | ||
4028 | "tpacpi:orange:batt", | ||
4029 | "tpacpi:green:batt", | ||
4030 | "tpacpi::dock_active", | ||
4031 | "tpacpi::bay_active", | ||
4032 | "tpacpi::dock_batt", | ||
4033 | "tpacpi::unknown_led", | ||
4034 | "tpacpi::standby", | ||
4035 | }; | ||
4036 | |||
4037 | static int led_get_status(const unsigned int led) | ||
4038 | { | ||
4039 | int status; | ||
4040 | enum led_status_t led_s; | ||
4041 | |||
4042 | switch (led_supported) { | ||
4043 | case TPACPI_LED_570: | ||
4044 | if (!acpi_evalf(ec_handle, | ||
4045 | &status, "GLED", "dd", 1 << led)) | ||
4046 | return -EIO; | ||
4047 | led_s = (status == 0)? | ||
4048 | TPACPI_LED_OFF : | ||
4049 | ((status == 1)? | ||
4050 | TPACPI_LED_ON : | ||
4051 | TPACPI_LED_BLINK); | ||
4052 | tpacpi_led_state_cache[led] = led_s; | ||
4053 | return led_s; | ||
4054 | default: | ||
4055 | return -ENXIO; | ||
4056 | } | ||
4057 | |||
4058 | /* not reached */ | ||
4059 | } | ||
4060 | |||
4061 | static int led_set_status(const unsigned int led, | ||
4062 | const enum led_status_t ledstatus) | ||
4063 | { | ||
4064 | /* off, on, blink. Index is led_status_t */ | ||
4065 | static const unsigned int led_sled_arg1[] = { 0, 1, 3 }; | ||
4066 | static const unsigned int led_led_arg1[] = { 0, 0x80, 0xc0 }; | ||
4067 | |||
4068 | int rc = 0; | ||
4069 | |||
4070 | switch (led_supported) { | ||
4071 | case TPACPI_LED_570: | ||
4072 | /* 570 */ | ||
4073 | if (led > 7) | ||
4074 | return -EINVAL; | ||
4075 | if (!acpi_evalf(led_handle, NULL, NULL, "vdd", | ||
4076 | (1 << led), led_sled_arg1[ledstatus])) | ||
4077 | rc = -EIO; | ||
4078 | break; | ||
4079 | case TPACPI_LED_OLD: | ||
4080 | /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20 */ | ||
4081 | if (led > 7) | ||
4082 | return -EINVAL; | ||
4083 | rc = ec_write(TPACPI_LED_EC_HLMS, (1 << led)); | ||
4084 | if (rc >= 0) | ||
4085 | rc = ec_write(TPACPI_LED_EC_HLBL, | ||
4086 | (ledstatus == TPACPI_LED_BLINK) << led); | ||
4087 | if (rc >= 0) | ||
4088 | rc = ec_write(TPACPI_LED_EC_HLCL, | ||
4089 | (ledstatus != TPACPI_LED_OFF) << led); | ||
4090 | break; | ||
4091 | case TPACPI_LED_NEW: | ||
4092 | /* all others */ | ||
4093 | if (!acpi_evalf(led_handle, NULL, NULL, "vdd", | ||
4094 | led, led_led_arg1[ledstatus])) | ||
4095 | rc = -EIO; | ||
4096 | break; | ||
4097 | default: | ||
4098 | rc = -ENXIO; | ||
4099 | } | ||
4100 | |||
4101 | if (!rc) | ||
4102 | tpacpi_led_state_cache[led] = ledstatus; | ||
4103 | |||
4104 | return rc; | ||
4105 | } | ||
4106 | |||
4107 | static void led_sysfs_set_status(unsigned int led, | ||
4108 | enum led_brightness brightness) | ||
4109 | { | ||
4110 | led_set_status(led, | ||
4111 | (brightness == LED_OFF) ? | ||
4112 | TPACPI_LED_OFF : | ||
4113 | (tpacpi_led_state_cache[led] == TPACPI_LED_BLINK) ? | ||
4114 | TPACPI_LED_BLINK : TPACPI_LED_ON); | ||
4115 | } | ||
4116 | |||
4117 | static void led_set_status_worker(struct work_struct *work) | ||
4118 | { | ||
4119 | struct tpacpi_led_classdev *data = | ||
4120 | container_of(work, struct tpacpi_led_classdev, work); | ||
4121 | |||
4122 | if (likely(tpacpi_lifecycle == TPACPI_LIFE_RUNNING)) | ||
4123 | led_sysfs_set_status(data->led, data->new_brightness); | ||
4124 | } | ||
4125 | |||
4126 | static void led_sysfs_set(struct led_classdev *led_cdev, | ||
4127 | enum led_brightness brightness) | ||
4128 | { | ||
4129 | struct tpacpi_led_classdev *data = container_of(led_cdev, | ||
4130 | struct tpacpi_led_classdev, led_classdev); | ||
4131 | |||
4132 | data->new_brightness = brightness; | ||
4133 | queue_work(tpacpi_wq, &data->work); | ||
4134 | } | ||
4135 | |||
4136 | static int led_sysfs_blink_set(struct led_classdev *led_cdev, | ||
4137 | unsigned long *delay_on, unsigned long *delay_off) | ||
4138 | { | ||
4139 | struct tpacpi_led_classdev *data = container_of(led_cdev, | ||
4140 | struct tpacpi_led_classdev, led_classdev); | ||
4141 | |||
4142 | /* Can we choose the flash rate? */ | ||
4143 | if (*delay_on == 0 && *delay_off == 0) { | ||
4144 | /* yes. set them to the hardware blink rate (1 Hz) */ | ||
4145 | *delay_on = 500; /* ms */ | ||
4146 | *delay_off = 500; /* ms */ | ||
4147 | } else if ((*delay_on != 500) || (*delay_off != 500)) | ||
4148 | return -EINVAL; | ||
4149 | |||
4150 | data->new_brightness = TPACPI_LED_BLINK; | ||
4151 | queue_work(tpacpi_wq, &data->work); | ||
4152 | |||
4153 | return 0; | ||
4154 | } | ||
4155 | |||
4156 | static enum led_brightness led_sysfs_get(struct led_classdev *led_cdev) | ||
4157 | { | ||
4158 | int rc; | ||
4159 | |||
4160 | struct tpacpi_led_classdev *data = container_of(led_cdev, | ||
4161 | struct tpacpi_led_classdev, led_classdev); | ||
4162 | |||
4163 | rc = led_get_status(data->led); | ||
4164 | |||
4165 | if (rc == TPACPI_LED_OFF || rc < 0) | ||
4166 | rc = LED_OFF; /* no error handling in led class :( */ | ||
4167 | else | ||
4168 | rc = LED_FULL; | ||
4169 | |||
4170 | return rc; | ||
4171 | } | ||
4172 | |||
4173 | static void led_exit(void) | ||
4174 | { | ||
4175 | unsigned int i; | ||
4176 | |||
4177 | for (i = 0; i < TPACPI_LED_NUMLEDS; i++) { | ||
4178 | if (tpacpi_leds[i].led_classdev.name) | ||
4179 | led_classdev_unregister(&tpacpi_leds[i].led_classdev); | ||
4180 | } | ||
4181 | |||
4182 | kfree(tpacpi_leds); | ||
4183 | } | ||
4184 | |||
4185 | static int __init led_init(struct ibm_init_struct *iibm) | ||
4186 | { | ||
4187 | unsigned int i; | ||
4188 | int rc; | ||
4189 | |||
4190 | vdbg_printk(TPACPI_DBG_INIT, "initializing LED subdriver\n"); | ||
4191 | |||
4192 | TPACPI_ACPIHANDLE_INIT(led); | ||
4193 | |||
4194 | if (!led_handle) | ||
4195 | /* led not supported on R30, R31 */ | ||
4196 | led_supported = TPACPI_LED_NONE; | ||
4197 | else if (strlencmp(led_path, "SLED") == 0) | ||
4198 | /* 570 */ | ||
4199 | led_supported = TPACPI_LED_570; | ||
4200 | else if (strlencmp(led_path, "SYSL") == 0) | ||
4201 | /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */ | ||
4202 | led_supported = TPACPI_LED_OLD; | ||
4203 | else | ||
4204 | /* all others */ | ||
4205 | led_supported = TPACPI_LED_NEW; | ||
4206 | |||
4207 | vdbg_printk(TPACPI_DBG_INIT, "LED commands are %s, mode %d\n", | ||
4208 | str_supported(led_supported), led_supported); | ||
4209 | |||
4210 | tpacpi_leds = kzalloc(sizeof(*tpacpi_leds) * TPACPI_LED_NUMLEDS, | ||
4211 | GFP_KERNEL); | ||
4212 | if (!tpacpi_leds) { | ||
4213 | printk(TPACPI_ERR "Out of memory for LED data\n"); | ||
4214 | return -ENOMEM; | ||
4215 | } | ||
4216 | |||
4217 | for (i = 0; i < TPACPI_LED_NUMLEDS; i++) { | ||
4218 | tpacpi_leds[i].led = i; | ||
4219 | |||
4220 | tpacpi_leds[i].led_classdev.brightness_set = &led_sysfs_set; | ||
4221 | tpacpi_leds[i].led_classdev.blink_set = &led_sysfs_blink_set; | ||
4222 | if (led_supported == TPACPI_LED_570) | ||
4223 | tpacpi_leds[i].led_classdev.brightness_get = | ||
4224 | &led_sysfs_get; | ||
4225 | |||
4226 | tpacpi_leds[i].led_classdev.name = tpacpi_led_names[i]; | ||
4227 | |||
4228 | INIT_WORK(&tpacpi_leds[i].work, led_set_status_worker); | ||
4229 | |||
4230 | rc = led_classdev_register(&tpacpi_pdev->dev, | ||
4231 | &tpacpi_leds[i].led_classdev); | ||
4232 | if (rc < 0) { | ||
4233 | tpacpi_leds[i].led_classdev.name = NULL; | ||
4234 | led_exit(); | ||
4235 | return rc; | ||
4236 | } | ||
4237 | } | ||
4238 | |||
4239 | return (led_supported != TPACPI_LED_NONE)? 0 : 1; | ||
4240 | } | ||
4241 | |||
4242 | #define str_led_status(s) \ | ||
4243 | ((s) == TPACPI_LED_OFF ? "off" : \ | ||
4244 | ((s) == TPACPI_LED_ON ? "on" : "blinking")) | ||
4245 | |||
4246 | static int led_read(char *p) | ||
4247 | { | ||
4248 | int len = 0; | ||
4249 | |||
4250 | if (!led_supported) { | ||
4251 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
4252 | return len; | ||
4253 | } | ||
4254 | len += sprintf(p + len, "status:\t\tsupported\n"); | ||
4255 | |||
4256 | if (led_supported == TPACPI_LED_570) { | ||
4257 | /* 570 */ | ||
4258 | int i, status; | ||
4259 | for (i = 0; i < 8; i++) { | ||
4260 | status = led_get_status(i); | ||
4261 | if (status < 0) | ||
4262 | return -EIO; | ||
4263 | len += sprintf(p + len, "%d:\t\t%s\n", | ||
4264 | i, str_led_status(status)); | ||
4265 | } | ||
4266 | } | ||
4267 | |||
4268 | len += sprintf(p + len, "commands:\t" | ||
4269 | "<led> on, <led> off, <led> blink (<led> is 0-7)\n"); | ||
4270 | |||
4271 | return len; | ||
4272 | } | ||
4273 | |||
4274 | static int led_write(char *buf) | ||
4275 | { | ||
4276 | char *cmd; | ||
4277 | int led, rc; | ||
4278 | enum led_status_t s; | ||
4279 | |||
4280 | if (!led_supported) | ||
4281 | return -ENODEV; | ||
4282 | |||
4283 | while ((cmd = next_cmd(&buf))) { | ||
4284 | if (sscanf(cmd, "%d", &led) != 1 || led < 0 || led > 7) | ||
4285 | return -EINVAL; | ||
4286 | |||
4287 | if (strstr(cmd, "off")) { | ||
4288 | s = TPACPI_LED_OFF; | ||
4289 | } else if (strstr(cmd, "on")) { | ||
4290 | s = TPACPI_LED_ON; | ||
4291 | } else if (strstr(cmd, "blink")) { | ||
4292 | s = TPACPI_LED_BLINK; | ||
4293 | } else { | ||
4294 | return -EINVAL; | ||
4295 | } | ||
4296 | |||
4297 | rc = led_set_status(led, s); | ||
4298 | if (rc < 0) | ||
4299 | return rc; | ||
4300 | } | ||
4301 | |||
4302 | return 0; | ||
4303 | } | ||
4304 | |||
4305 | static struct ibm_struct led_driver_data = { | ||
4306 | .name = "led", | ||
4307 | .read = led_read, | ||
4308 | .write = led_write, | ||
4309 | .exit = led_exit, | ||
4310 | }; | ||
4311 | |||
4312 | /************************************************************************* | ||
4313 | * Beep subdriver | ||
4314 | */ | ||
4315 | |||
4316 | TPACPI_HANDLE(beep, ec, "BEEP"); /* all except R30, R31 */ | ||
4317 | |||
4318 | static int __init beep_init(struct ibm_init_struct *iibm) | ||
4319 | { | ||
4320 | vdbg_printk(TPACPI_DBG_INIT, "initializing beep subdriver\n"); | ||
4321 | |||
4322 | TPACPI_ACPIHANDLE_INIT(beep); | ||
4323 | |||
4324 | vdbg_printk(TPACPI_DBG_INIT, "beep is %s\n", | ||
4325 | str_supported(beep_handle != NULL)); | ||
4326 | |||
4327 | return (beep_handle)? 0 : 1; | ||
4328 | } | ||
4329 | |||
4330 | static int beep_read(char *p) | ||
4331 | { | ||
4332 | int len = 0; | ||
4333 | |||
4334 | if (!beep_handle) | ||
4335 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
4336 | else { | ||
4337 | len += sprintf(p + len, "status:\t\tsupported\n"); | ||
4338 | len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-17)\n"); | ||
4339 | } | ||
4340 | |||
4341 | return len; | ||
4342 | } | ||
4343 | |||
4344 | static int beep_write(char *buf) | ||
4345 | { | ||
4346 | char *cmd; | ||
4347 | int beep_cmd; | ||
4348 | |||
4349 | if (!beep_handle) | ||
4350 | return -ENODEV; | ||
4351 | |||
4352 | while ((cmd = next_cmd(&buf))) { | ||
4353 | if (sscanf(cmd, "%u", &beep_cmd) == 1 && | ||
4354 | beep_cmd >= 0 && beep_cmd <= 17) { | ||
4355 | /* beep_cmd set */ | ||
4356 | } else | ||
4357 | return -EINVAL; | ||
4358 | if (!acpi_evalf(beep_handle, NULL, NULL, "vdd", beep_cmd, 0)) | ||
4359 | return -EIO; | ||
4360 | } | ||
4361 | |||
4362 | return 0; | ||
4363 | } | ||
4364 | |||
4365 | static struct ibm_struct beep_driver_data = { | ||
4366 | .name = "beep", | ||
4367 | .read = beep_read, | ||
4368 | .write = beep_write, | ||
4369 | }; | ||
4370 | |||
4371 | /************************************************************************* | ||
4372 | * Thermal subdriver | ||
4373 | */ | ||
4374 | |||
4375 | enum thermal_access_mode { | ||
4376 | TPACPI_THERMAL_NONE = 0, /* No thermal support */ | ||
4377 | TPACPI_THERMAL_ACPI_TMP07, /* Use ACPI TMP0-7 */ | ||
4378 | TPACPI_THERMAL_ACPI_UPDT, /* Use ACPI TMP0-7 with UPDT */ | ||
4379 | TPACPI_THERMAL_TPEC_8, /* Use ACPI EC regs, 8 sensors */ | ||
4380 | TPACPI_THERMAL_TPEC_16, /* Use ACPI EC regs, 16 sensors */ | ||
4381 | }; | ||
4382 | |||
4383 | enum { /* TPACPI_THERMAL_TPEC_* */ | ||
4384 | TP_EC_THERMAL_TMP0 = 0x78, /* ACPI EC regs TMP 0..7 */ | ||
4385 | TP_EC_THERMAL_TMP8 = 0xC0, /* ACPI EC regs TMP 8..15 */ | ||
4386 | TP_EC_THERMAL_TMP_NA = -128, /* ACPI EC sensor not available */ | ||
4387 | }; | ||
4388 | |||
4389 | #define TPACPI_MAX_THERMAL_SENSORS 16 /* Max thermal sensors supported */ | ||
4390 | struct ibm_thermal_sensors_struct { | ||
4391 | s32 temp[TPACPI_MAX_THERMAL_SENSORS]; | ||
4392 | }; | ||
4393 | |||
4394 | static enum thermal_access_mode thermal_read_mode; | ||
4395 | |||
4396 | /* idx is zero-based */ | ||
4397 | static int thermal_get_sensor(int idx, s32 *value) | ||
4398 | { | ||
4399 | int t; | ||
4400 | s8 tmp; | ||
4401 | char tmpi[5]; | ||
4402 | |||
4403 | t = TP_EC_THERMAL_TMP0; | ||
4404 | |||
4405 | switch (thermal_read_mode) { | ||
4406 | #if TPACPI_MAX_THERMAL_SENSORS >= 16 | ||
4407 | case TPACPI_THERMAL_TPEC_16: | ||
4408 | if (idx >= 8 && idx <= 15) { | ||
4409 | t = TP_EC_THERMAL_TMP8; | ||
4410 | idx -= 8; | ||
4411 | } | ||
4412 | /* fallthrough */ | ||
4413 | #endif | ||
4414 | case TPACPI_THERMAL_TPEC_8: | ||
4415 | if (idx <= 7) { | ||
4416 | if (!acpi_ec_read(t + idx, &tmp)) | ||
4417 | return -EIO; | ||
4418 | *value = tmp * 1000; | ||
4419 | return 0; | ||
4420 | } | ||
4421 | break; | ||
4422 | |||
4423 | case TPACPI_THERMAL_ACPI_UPDT: | ||
4424 | if (idx <= 7) { | ||
4425 | snprintf(tmpi, sizeof(tmpi), "TMP%c", '0' + idx); | ||
4426 | if (!acpi_evalf(ec_handle, NULL, "UPDT", "v")) | ||
4427 | return -EIO; | ||
4428 | if (!acpi_evalf(ec_handle, &t, tmpi, "d")) | ||
4429 | return -EIO; | ||
4430 | *value = (t - 2732) * 100; | ||
4431 | return 0; | ||
4432 | } | ||
4433 | break; | ||
4434 | |||
4435 | case TPACPI_THERMAL_ACPI_TMP07: | ||
4436 | if (idx <= 7) { | ||
4437 | snprintf(tmpi, sizeof(tmpi), "TMP%c", '0' + idx); | ||
4438 | if (!acpi_evalf(ec_handle, &t, tmpi, "d")) | ||
4439 | return -EIO; | ||
4440 | if (t > 127 || t < -127) | ||
4441 | t = TP_EC_THERMAL_TMP_NA; | ||
4442 | *value = t * 1000; | ||
4443 | return 0; | ||
4444 | } | ||
4445 | break; | ||
4446 | |||
4447 | case TPACPI_THERMAL_NONE: | ||
4448 | default: | ||
4449 | return -ENOSYS; | ||
4450 | } | ||
4451 | |||
4452 | return -EINVAL; | ||
4453 | } | ||
4454 | |||
4455 | static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s) | ||
4456 | { | ||
4457 | int res, i; | ||
4458 | int n; | ||
4459 | |||
4460 | n = 8; | ||
4461 | i = 0; | ||
4462 | |||
4463 | if (!s) | ||
4464 | return -EINVAL; | ||
4465 | |||
4466 | if (thermal_read_mode == TPACPI_THERMAL_TPEC_16) | ||
4467 | n = 16; | ||
4468 | |||
4469 | for (i = 0 ; i < n; i++) { | ||
4470 | res = thermal_get_sensor(i, &s->temp[i]); | ||
4471 | if (res) | ||
4472 | return res; | ||
4473 | } | ||
4474 | |||
4475 | return n; | ||
4476 | } | ||
4477 | |||
4478 | /* sysfs temp##_input -------------------------------------------------- */ | ||
4479 | |||
4480 | static ssize_t thermal_temp_input_show(struct device *dev, | ||
4481 | struct device_attribute *attr, | ||
4482 | char *buf) | ||
4483 | { | ||
4484 | struct sensor_device_attribute *sensor_attr = | ||
4485 | to_sensor_dev_attr(attr); | ||
4486 | int idx = sensor_attr->index; | ||
4487 | s32 value; | ||
4488 | int res; | ||
4489 | |||
4490 | res = thermal_get_sensor(idx, &value); | ||
4491 | if (res) | ||
4492 | return res; | ||
4493 | if (value == TP_EC_THERMAL_TMP_NA * 1000) | ||
4494 | return -ENXIO; | ||
4495 | |||
4496 | return snprintf(buf, PAGE_SIZE, "%d\n", value); | ||
4497 | } | ||
4498 | |||
4499 | #define THERMAL_SENSOR_ATTR_TEMP(_idxA, _idxB) \ | ||
4500 | SENSOR_ATTR(temp##_idxA##_input, S_IRUGO, \ | ||
4501 | thermal_temp_input_show, NULL, _idxB) | ||
4502 | |||
4503 | static struct sensor_device_attribute sensor_dev_attr_thermal_temp_input[] = { | ||
4504 | THERMAL_SENSOR_ATTR_TEMP(1, 0), | ||
4505 | THERMAL_SENSOR_ATTR_TEMP(2, 1), | ||
4506 | THERMAL_SENSOR_ATTR_TEMP(3, 2), | ||
4507 | THERMAL_SENSOR_ATTR_TEMP(4, 3), | ||
4508 | THERMAL_SENSOR_ATTR_TEMP(5, 4), | ||
4509 | THERMAL_SENSOR_ATTR_TEMP(6, 5), | ||
4510 | THERMAL_SENSOR_ATTR_TEMP(7, 6), | ||
4511 | THERMAL_SENSOR_ATTR_TEMP(8, 7), | ||
4512 | THERMAL_SENSOR_ATTR_TEMP(9, 8), | ||
4513 | THERMAL_SENSOR_ATTR_TEMP(10, 9), | ||
4514 | THERMAL_SENSOR_ATTR_TEMP(11, 10), | ||
4515 | THERMAL_SENSOR_ATTR_TEMP(12, 11), | ||
4516 | THERMAL_SENSOR_ATTR_TEMP(13, 12), | ||
4517 | THERMAL_SENSOR_ATTR_TEMP(14, 13), | ||
4518 | THERMAL_SENSOR_ATTR_TEMP(15, 14), | ||
4519 | THERMAL_SENSOR_ATTR_TEMP(16, 15), | ||
4520 | }; | ||
4521 | |||
4522 | #define THERMAL_ATTRS(X) \ | ||
4523 | &sensor_dev_attr_thermal_temp_input[X].dev_attr.attr | ||
4524 | |||
4525 | static struct attribute *thermal_temp_input_attr[] = { | ||
4526 | THERMAL_ATTRS(8), | ||
4527 | THERMAL_ATTRS(9), | ||
4528 | THERMAL_ATTRS(10), | ||
4529 | THERMAL_ATTRS(11), | ||
4530 | THERMAL_ATTRS(12), | ||
4531 | THERMAL_ATTRS(13), | ||
4532 | THERMAL_ATTRS(14), | ||
4533 | THERMAL_ATTRS(15), | ||
4534 | THERMAL_ATTRS(0), | ||
4535 | THERMAL_ATTRS(1), | ||
4536 | THERMAL_ATTRS(2), | ||
4537 | THERMAL_ATTRS(3), | ||
4538 | THERMAL_ATTRS(4), | ||
4539 | THERMAL_ATTRS(5), | ||
4540 | THERMAL_ATTRS(6), | ||
4541 | THERMAL_ATTRS(7), | ||
4542 | NULL | ||
4543 | }; | ||
4544 | |||
4545 | static const struct attribute_group thermal_temp_input16_group = { | ||
4546 | .attrs = thermal_temp_input_attr | ||
4547 | }; | ||
4548 | |||
4549 | static const struct attribute_group thermal_temp_input8_group = { | ||
4550 | .attrs = &thermal_temp_input_attr[8] | ||
4551 | }; | ||
4552 | |||
4553 | #undef THERMAL_SENSOR_ATTR_TEMP | ||
4554 | #undef THERMAL_ATTRS | ||
4555 | |||
4556 | /* --------------------------------------------------------------------- */ | ||
4557 | |||
4558 | static int __init thermal_init(struct ibm_init_struct *iibm) | ||
4559 | { | ||
4560 | u8 t, ta1, ta2; | ||
4561 | int i; | ||
4562 | int acpi_tmp7; | ||
4563 | int res; | ||
4564 | |||
4565 | vdbg_printk(TPACPI_DBG_INIT, "initializing thermal subdriver\n"); | ||
4566 | |||
4567 | acpi_tmp7 = acpi_evalf(ec_handle, NULL, "TMP7", "qv"); | ||
4568 | |||
4569 | if (thinkpad_id.ec_model) { | ||
4570 | /* | ||
4571 | * Direct EC access mode: sensors at registers | ||
4572 | * 0x78-0x7F, 0xC0-0xC7. Registers return 0x00 for | ||
4573 | * non-implemented, thermal sensors return 0x80 when | ||
4574 | * not available | ||
4575 | */ | ||
4576 | |||
4577 | ta1 = ta2 = 0; | ||
4578 | for (i = 0; i < 8; i++) { | ||
4579 | if (acpi_ec_read(TP_EC_THERMAL_TMP0 + i, &t)) { | ||
4580 | ta1 |= t; | ||
4581 | } else { | ||
4582 | ta1 = 0; | ||
4583 | break; | ||
4584 | } | ||
4585 | if (acpi_ec_read(TP_EC_THERMAL_TMP8 + i, &t)) { | ||
4586 | ta2 |= t; | ||
4587 | } else { | ||
4588 | ta1 = 0; | ||
4589 | break; | ||
4590 | } | ||
4591 | } | ||
4592 | if (ta1 == 0) { | ||
4593 | /* This is sheer paranoia, but we handle it anyway */ | ||
4594 | if (acpi_tmp7) { | ||
4595 | printk(TPACPI_ERR | ||
4596 | "ThinkPad ACPI EC access misbehaving, " | ||
4597 | "falling back to ACPI TMPx access " | ||
4598 | "mode\n"); | ||
4599 | thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07; | ||
4600 | } else { | ||
4601 | printk(TPACPI_ERR | ||
4602 | "ThinkPad ACPI EC access misbehaving, " | ||
4603 | "disabling thermal sensors access\n"); | ||
4604 | thermal_read_mode = TPACPI_THERMAL_NONE; | ||
4605 | } | ||
4606 | } else { | ||
4607 | thermal_read_mode = | ||
4608 | (ta2 != 0) ? | ||
4609 | TPACPI_THERMAL_TPEC_16 : TPACPI_THERMAL_TPEC_8; | ||
4610 | } | ||
4611 | } else if (acpi_tmp7) { | ||
4612 | if (acpi_evalf(ec_handle, NULL, "UPDT", "qv")) { | ||
4613 | /* 600e/x, 770e, 770x */ | ||
4614 | thermal_read_mode = TPACPI_THERMAL_ACPI_UPDT; | ||
4615 | } else { | ||
4616 | /* Standard ACPI TMPx access, max 8 sensors */ | ||
4617 | thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07; | ||
4618 | } | ||
4619 | } else { | ||
4620 | /* temperatures not supported on 570, G4x, R30, R31, R32 */ | ||
4621 | thermal_read_mode = TPACPI_THERMAL_NONE; | ||
4622 | } | ||
4623 | |||
4624 | vdbg_printk(TPACPI_DBG_INIT, "thermal is %s, mode %d\n", | ||
4625 | str_supported(thermal_read_mode != TPACPI_THERMAL_NONE), | ||
4626 | thermal_read_mode); | ||
4627 | |||
4628 | switch (thermal_read_mode) { | ||
4629 | case TPACPI_THERMAL_TPEC_16: | ||
4630 | res = sysfs_create_group(&tpacpi_sensors_pdev->dev.kobj, | ||
4631 | &thermal_temp_input16_group); | ||
4632 | if (res) | ||
4633 | return res; | ||
4634 | break; | ||
4635 | case TPACPI_THERMAL_TPEC_8: | ||
4636 | case TPACPI_THERMAL_ACPI_TMP07: | ||
4637 | case TPACPI_THERMAL_ACPI_UPDT: | ||
4638 | res = sysfs_create_group(&tpacpi_sensors_pdev->dev.kobj, | ||
4639 | &thermal_temp_input8_group); | ||
4640 | if (res) | ||
4641 | return res; | ||
4642 | break; | ||
4643 | case TPACPI_THERMAL_NONE: | ||
4644 | default: | ||
4645 | return 1; | ||
4646 | } | ||
4647 | |||
4648 | return 0; | ||
4649 | } | ||
4650 | |||
4651 | static void thermal_exit(void) | ||
4652 | { | ||
4653 | switch (thermal_read_mode) { | ||
4654 | case TPACPI_THERMAL_TPEC_16: | ||
4655 | sysfs_remove_group(&tpacpi_sensors_pdev->dev.kobj, | ||
4656 | &thermal_temp_input16_group); | ||
4657 | break; | ||
4658 | case TPACPI_THERMAL_TPEC_8: | ||
4659 | case TPACPI_THERMAL_ACPI_TMP07: | ||
4660 | case TPACPI_THERMAL_ACPI_UPDT: | ||
4661 | sysfs_remove_group(&tpacpi_sensors_pdev->dev.kobj, | ||
4662 | &thermal_temp_input16_group); | ||
4663 | break; | ||
4664 | case TPACPI_THERMAL_NONE: | ||
4665 | default: | ||
4666 | break; | ||
4667 | } | ||
4668 | } | ||
4669 | |||
4670 | static int thermal_read(char *p) | ||
4671 | { | ||
4672 | int len = 0; | ||
4673 | int n, i; | ||
4674 | struct ibm_thermal_sensors_struct t; | ||
4675 | |||
4676 | n = thermal_get_sensors(&t); | ||
4677 | if (unlikely(n < 0)) | ||
4678 | return n; | ||
4679 | |||
4680 | len += sprintf(p + len, "temperatures:\t"); | ||
4681 | |||
4682 | if (n > 0) { | ||
4683 | for (i = 0; i < (n - 1); i++) | ||
4684 | len += sprintf(p + len, "%d ", t.temp[i] / 1000); | ||
4685 | len += sprintf(p + len, "%d\n", t.temp[i] / 1000); | ||
4686 | } else | ||
4687 | len += sprintf(p + len, "not supported\n"); | ||
4688 | |||
4689 | return len; | ||
4690 | } | ||
4691 | |||
4692 | static struct ibm_struct thermal_driver_data = { | ||
4693 | .name = "thermal", | ||
4694 | .read = thermal_read, | ||
4695 | .exit = thermal_exit, | ||
4696 | }; | ||
4697 | |||
4698 | /************************************************************************* | ||
4699 | * EC Dump subdriver | ||
4700 | */ | ||
4701 | |||
4702 | static u8 ecdump_regs[256]; | ||
4703 | |||
4704 | static int ecdump_read(char *p) | ||
4705 | { | ||
4706 | int len = 0; | ||
4707 | int i, j; | ||
4708 | u8 v; | ||
4709 | |||
4710 | len += sprintf(p + len, "EC " | ||
4711 | " +00 +01 +02 +03 +04 +05 +06 +07" | ||
4712 | " +08 +09 +0a +0b +0c +0d +0e +0f\n"); | ||
4713 | for (i = 0; i < 256; i += 16) { | ||
4714 | len += sprintf(p + len, "EC 0x%02x:", i); | ||
4715 | for (j = 0; j < 16; j++) { | ||
4716 | if (!acpi_ec_read(i + j, &v)) | ||
4717 | break; | ||
4718 | if (v != ecdump_regs[i + j]) | ||
4719 | len += sprintf(p + len, " *%02x", v); | ||
4720 | else | ||
4721 | len += sprintf(p + len, " %02x", v); | ||
4722 | ecdump_regs[i + j] = v; | ||
4723 | } | ||
4724 | len += sprintf(p + len, "\n"); | ||
4725 | if (j != 16) | ||
4726 | break; | ||
4727 | } | ||
4728 | |||
4729 | /* These are way too dangerous to advertise openly... */ | ||
4730 | #if 0 | ||
4731 | len += sprintf(p + len, "commands:\t0x<offset> 0x<value>" | ||
4732 | " (<offset> is 00-ff, <value> is 00-ff)\n"); | ||
4733 | len += sprintf(p + len, "commands:\t0x<offset> <value> " | ||
4734 | " (<offset> is 00-ff, <value> is 0-255)\n"); | ||
4735 | #endif | ||
4736 | return len; | ||
4737 | } | ||
4738 | |||
4739 | static int ecdump_write(char *buf) | ||
4740 | { | ||
4741 | char *cmd; | ||
4742 | int i, v; | ||
4743 | |||
4744 | while ((cmd = next_cmd(&buf))) { | ||
4745 | if (sscanf(cmd, "0x%x 0x%x", &i, &v) == 2) { | ||
4746 | /* i and v set */ | ||
4747 | } else if (sscanf(cmd, "0x%x %u", &i, &v) == 2) { | ||
4748 | /* i and v set */ | ||
4749 | } else | ||
4750 | return -EINVAL; | ||
4751 | if (i >= 0 && i < 256 && v >= 0 && v < 256) { | ||
4752 | if (!acpi_ec_write(i, v)) | ||
4753 | return -EIO; | ||
4754 | } else | ||
4755 | return -EINVAL; | ||
4756 | } | ||
4757 | |||
4758 | return 0; | ||
4759 | } | ||
4760 | |||
4761 | static struct ibm_struct ecdump_driver_data = { | ||
4762 | .name = "ecdump", | ||
4763 | .read = ecdump_read, | ||
4764 | .write = ecdump_write, | ||
4765 | .flags.experimental = 1, | ||
4766 | }; | ||
4767 | |||
4768 | /************************************************************************* | ||
4769 | * Backlight/brightness subdriver | ||
4770 | */ | ||
4771 | |||
4772 | #define TPACPI_BACKLIGHT_DEV_NAME "thinkpad_screen" | ||
4773 | |||
4774 | enum { | ||
4775 | TP_EC_BACKLIGHT = 0x31, | ||
4776 | |||
4777 | /* TP_EC_BACKLIGHT bitmasks */ | ||
4778 | TP_EC_BACKLIGHT_LVLMSK = 0x1F, | ||
4779 | TP_EC_BACKLIGHT_CMDMSK = 0xE0, | ||
4780 | TP_EC_BACKLIGHT_MAPSW = 0x20, | ||
4781 | }; | ||
4782 | |||
4783 | static struct backlight_device *ibm_backlight_device; | ||
4784 | static int brightness_mode; | ||
4785 | static unsigned int brightness_enable = 2; /* 2 = auto, 0 = no, 1 = yes */ | ||
4786 | |||
4787 | static struct mutex brightness_mutex; | ||
4788 | |||
4789 | /* | ||
4790 | * ThinkPads can read brightness from two places: EC 0x31, or | ||
4791 | * CMOS NVRAM byte 0x5E, bits 0-3. | ||
4792 | * | ||
4793 | * EC 0x31 has the following layout | ||
4794 | * Bit 7: unknown function | ||
4795 | * Bit 6: unknown function | ||
4796 | * Bit 5: Z: honour scale changes, NZ: ignore scale changes | ||
4797 | * Bit 4: must be set to zero to avoid problems | ||
4798 | * Bit 3-0: backlight brightness level | ||
4799 | * | ||
4800 | * brightness_get_raw returns status data in the EC 0x31 layout | ||
4801 | */ | ||
4802 | static int brightness_get_raw(int *status) | ||
4803 | { | ||
4804 | u8 lec = 0, lcmos = 0, level = 0; | ||
4805 | |||
4806 | if (brightness_mode & 1) { | ||
4807 | if (!acpi_ec_read(TP_EC_BACKLIGHT, &lec)) | ||
4808 | return -EIO; | ||
4809 | level = lec & TP_EC_BACKLIGHT_LVLMSK; | ||
4810 | }; | ||
4811 | if (brightness_mode & 2) { | ||
4812 | lcmos = (nvram_read_byte(TP_NVRAM_ADDR_BRIGHTNESS) | ||
4813 | & TP_NVRAM_MASK_LEVEL_BRIGHTNESS) | ||
4814 | >> TP_NVRAM_POS_LEVEL_BRIGHTNESS; | ||
4815 | lcmos &= (tp_features.bright_16levels)? 0x0f : 0x07; | ||
4816 | level = lcmos; | ||
4817 | } | ||
4818 | |||
4819 | if (brightness_mode == 3) { | ||
4820 | *status = lec; /* Prefer EC, CMOS is just a backing store */ | ||
4821 | lec &= TP_EC_BACKLIGHT_LVLMSK; | ||
4822 | if (lec == lcmos) | ||
4823 | tp_warned.bright_cmos_ec_unsync = 0; | ||
4824 | else { | ||
4825 | if (!tp_warned.bright_cmos_ec_unsync) { | ||
4826 | printk(TPACPI_ERR | ||
4827 | "CMOS NVRAM (%u) and EC (%u) do not " | ||
4828 | "agree on display brightness level\n", | ||
4829 | (unsigned int) lcmos, | ||
4830 | (unsigned int) lec); | ||
4831 | tp_warned.bright_cmos_ec_unsync = 1; | ||
4832 | } | ||
4833 | return -EIO; | ||
4834 | } | ||
4835 | } else { | ||
4836 | *status = level; | ||
4837 | } | ||
4838 | |||
4839 | return 0; | ||
4840 | } | ||
4841 | |||
4842 | /* May return EINTR which can always be mapped to ERESTARTSYS */ | ||
4843 | static int brightness_set(int value) | ||
4844 | { | ||
4845 | int cmos_cmd, inc, i, res; | ||
4846 | int current_value; | ||
4847 | int command_bits; | ||
4848 | |||
4849 | if (value > ((tp_features.bright_16levels)? 15 : 7) || | ||
4850 | value < 0) | ||
4851 | return -EINVAL; | ||
4852 | |||
4853 | res = mutex_lock_interruptible(&brightness_mutex); | ||
4854 | if (res < 0) | ||
4855 | return res; | ||
4856 | |||
4857 | res = brightness_get_raw(¤t_value); | ||
4858 | if (res < 0) | ||
4859 | goto errout; | ||
4860 | |||
4861 | command_bits = current_value & TP_EC_BACKLIGHT_CMDMSK; | ||
4862 | current_value &= TP_EC_BACKLIGHT_LVLMSK; | ||
4863 | |||
4864 | cmos_cmd = value > current_value ? | ||
4865 | TP_CMOS_BRIGHTNESS_UP : | ||
4866 | TP_CMOS_BRIGHTNESS_DOWN; | ||
4867 | inc = (value > current_value)? 1 : -1; | ||
4868 | |||
4869 | res = 0; | ||
4870 | for (i = current_value; i != value; i += inc) { | ||
4871 | if ((brightness_mode & 2) && | ||
4872 | issue_thinkpad_cmos_command(cmos_cmd)) { | ||
4873 | res = -EIO; | ||
4874 | goto errout; | ||
4875 | } | ||
4876 | if ((brightness_mode & 1) && | ||
4877 | !acpi_ec_write(TP_EC_BACKLIGHT, | ||
4878 | (i + inc) | command_bits)) { | ||
4879 | res = -EIO; | ||
4880 | goto errout;; | ||
4881 | } | ||
4882 | } | ||
4883 | |||
4884 | errout: | ||
4885 | mutex_unlock(&brightness_mutex); | ||
4886 | return res; | ||
4887 | } | ||
4888 | |||
4889 | /* sysfs backlight class ----------------------------------------------- */ | ||
4890 | |||
4891 | static int brightness_update_status(struct backlight_device *bd) | ||
4892 | { | ||
4893 | /* it is the backlight class's job (caller) to handle | ||
4894 | * EINTR and other errors properly */ | ||
4895 | return brightness_set( | ||
4896 | (bd->props.fb_blank == FB_BLANK_UNBLANK && | ||
4897 | bd->props.power == FB_BLANK_UNBLANK) ? | ||
4898 | bd->props.brightness : 0); | ||
4899 | } | ||
4900 | |||
4901 | static int brightness_get(struct backlight_device *bd) | ||
4902 | { | ||
4903 | int status, res; | ||
4904 | |||
4905 | res = brightness_get_raw(&status); | ||
4906 | if (res < 0) | ||
4907 | return 0; /* FIXME: teach backlight about error handling */ | ||
4908 | |||
4909 | return status & TP_EC_BACKLIGHT_LVLMSK; | ||
4910 | } | ||
4911 | |||
4912 | static struct backlight_ops ibm_backlight_data = { | ||
4913 | .get_brightness = brightness_get, | ||
4914 | .update_status = brightness_update_status, | ||
4915 | }; | ||
4916 | |||
4917 | /* --------------------------------------------------------------------- */ | ||
4918 | |||
4919 | static int __init brightness_init(struct ibm_init_struct *iibm) | ||
4920 | { | ||
4921 | int b; | ||
4922 | |||
4923 | vdbg_printk(TPACPI_DBG_INIT, "initializing brightness subdriver\n"); | ||
4924 | |||
4925 | mutex_init(&brightness_mutex); | ||
4926 | |||
4927 | /* | ||
4928 | * We always attempt to detect acpi support, so as to switch | ||
4929 | * Lenovo Vista BIOS to ACPI brightness mode even if we are not | ||
4930 | * going to publish a backlight interface | ||
4931 | */ | ||
4932 | b = tpacpi_check_std_acpi_brightness_support(); | ||
4933 | if (b > 0) { | ||
4934 | |||
4935 | if (acpi_video_backlight_support()) { | ||
4936 | if (brightness_enable > 1) { | ||
4937 | printk(TPACPI_NOTICE | ||
4938 | "Standard ACPI backlight interface " | ||
4939 | "available, not loading native one.\n"); | ||
4940 | return 1; | ||
4941 | } else if (brightness_enable == 1) { | ||
4942 | printk(TPACPI_NOTICE | ||
4943 | "Backlight control force enabled, even if standard " | ||
4944 | "ACPI backlight interface is available\n"); | ||
4945 | } | ||
4946 | } else { | ||
4947 | if (brightness_enable > 1) { | ||
4948 | printk(TPACPI_NOTICE | ||
4949 | "Standard ACPI backlight interface not " | ||
4950 | "available, thinkpad_acpi native " | ||
4951 | "brightness control enabled\n"); | ||
4952 | } | ||
4953 | } | ||
4954 | } | ||
4955 | |||
4956 | if (!brightness_enable) { | ||
4957 | dbg_printk(TPACPI_DBG_INIT, | ||
4958 | "brightness support disabled by " | ||
4959 | "module parameter\n"); | ||
4960 | return 1; | ||
4961 | } | ||
4962 | |||
4963 | if (b > 16) { | ||
4964 | printk(TPACPI_ERR | ||
4965 | "Unsupported brightness interface, " | ||
4966 | "please contact %s\n", TPACPI_MAIL); | ||
4967 | return 1; | ||
4968 | } | ||
4969 | if (b == 16) | ||
4970 | tp_features.bright_16levels = 1; | ||
4971 | |||
4972 | if (!brightness_mode) { | ||
4973 | if (thinkpad_id.vendor == PCI_VENDOR_ID_LENOVO) | ||
4974 | brightness_mode = 2; | ||
4975 | else | ||
4976 | brightness_mode = 3; | ||
4977 | |||
4978 | dbg_printk(TPACPI_DBG_INIT, "selected brightness_mode=%d\n", | ||
4979 | brightness_mode); | ||
4980 | } | ||
4981 | |||
4982 | if (brightness_mode > 3) | ||
4983 | return -EINVAL; | ||
4984 | |||
4985 | if (brightness_get_raw(&b) < 0) | ||
4986 | return 1; | ||
4987 | |||
4988 | if (tp_features.bright_16levels) | ||
4989 | printk(TPACPI_INFO | ||
4990 | "detected a 16-level brightness capable ThinkPad\n"); | ||
4991 | |||
4992 | ibm_backlight_device = backlight_device_register( | ||
4993 | TPACPI_BACKLIGHT_DEV_NAME, NULL, NULL, | ||
4994 | &ibm_backlight_data); | ||
4995 | if (IS_ERR(ibm_backlight_device)) { | ||
4996 | printk(TPACPI_ERR "Could not register backlight device\n"); | ||
4997 | return PTR_ERR(ibm_backlight_device); | ||
4998 | } | ||
4999 | vdbg_printk(TPACPI_DBG_INIT, "brightness is supported\n"); | ||
5000 | |||
5001 | ibm_backlight_device->props.max_brightness = | ||
5002 | (tp_features.bright_16levels)? 15 : 7; | ||
5003 | ibm_backlight_device->props.brightness = b & TP_EC_BACKLIGHT_LVLMSK; | ||
5004 | backlight_update_status(ibm_backlight_device); | ||
5005 | |||
5006 | return 0; | ||
5007 | } | ||
5008 | |||
5009 | static void brightness_exit(void) | ||
5010 | { | ||
5011 | if (ibm_backlight_device) { | ||
5012 | vdbg_printk(TPACPI_DBG_EXIT, | ||
5013 | "calling backlight_device_unregister()\n"); | ||
5014 | backlight_device_unregister(ibm_backlight_device); | ||
5015 | } | ||
5016 | } | ||
5017 | |||
5018 | static int brightness_read(char *p) | ||
5019 | { | ||
5020 | int len = 0; | ||
5021 | int level; | ||
5022 | |||
5023 | level = brightness_get(NULL); | ||
5024 | if (level < 0) { | ||
5025 | len += sprintf(p + len, "level:\t\tunreadable\n"); | ||
5026 | } else { | ||
5027 | len += sprintf(p + len, "level:\t\t%d\n", level); | ||
5028 | len += sprintf(p + len, "commands:\tup, down\n"); | ||
5029 | len += sprintf(p + len, "commands:\tlevel <level>" | ||
5030 | " (<level> is 0-%d)\n", | ||
5031 | (tp_features.bright_16levels) ? 15 : 7); | ||
5032 | } | ||
5033 | |||
5034 | return len; | ||
5035 | } | ||
5036 | |||
5037 | static int brightness_write(char *buf) | ||
5038 | { | ||
5039 | int level; | ||
5040 | int rc; | ||
5041 | char *cmd; | ||
5042 | int max_level = (tp_features.bright_16levels) ? 15 : 7; | ||
5043 | |||
5044 | level = brightness_get(NULL); | ||
5045 | if (level < 0) | ||
5046 | return level; | ||
5047 | |||
5048 | while ((cmd = next_cmd(&buf))) { | ||
5049 | if (strlencmp(cmd, "up") == 0) { | ||
5050 | if (level < max_level) | ||
5051 | level++; | ||
5052 | } else if (strlencmp(cmd, "down") == 0) { | ||
5053 | if (level > 0) | ||
5054 | level--; | ||
5055 | } else if (sscanf(cmd, "level %d", &level) == 1 && | ||
5056 | level >= 0 && level <= max_level) { | ||
5057 | /* new level set */ | ||
5058 | } else | ||
5059 | return -EINVAL; | ||
5060 | } | ||
5061 | |||
5062 | /* | ||
5063 | * Now we know what the final level should be, so we try to set it. | ||
5064 | * Doing it this way makes the syscall restartable in case of EINTR | ||
5065 | */ | ||
5066 | rc = brightness_set(level); | ||
5067 | return (rc == -EINTR)? ERESTARTSYS : rc; | ||
5068 | } | ||
5069 | |||
5070 | static struct ibm_struct brightness_driver_data = { | ||
5071 | .name = "brightness", | ||
5072 | .read = brightness_read, | ||
5073 | .write = brightness_write, | ||
5074 | .exit = brightness_exit, | ||
5075 | }; | ||
5076 | |||
5077 | /************************************************************************* | ||
5078 | * Volume subdriver | ||
5079 | */ | ||
5080 | |||
5081 | static int volume_offset = 0x30; | ||
5082 | |||
5083 | static int volume_read(char *p) | ||
5084 | { | ||
5085 | int len = 0; | ||
5086 | u8 level; | ||
5087 | |||
5088 | if (!acpi_ec_read(volume_offset, &level)) { | ||
5089 | len += sprintf(p + len, "level:\t\tunreadable\n"); | ||
5090 | } else { | ||
5091 | len += sprintf(p + len, "level:\t\t%d\n", level & 0xf); | ||
5092 | len += sprintf(p + len, "mute:\t\t%s\n", onoff(level, 6)); | ||
5093 | len += sprintf(p + len, "commands:\tup, down, mute\n"); | ||
5094 | len += sprintf(p + len, "commands:\tlevel <level>" | ||
5095 | " (<level> is 0-15)\n"); | ||
5096 | } | ||
5097 | |||
5098 | return len; | ||
5099 | } | ||
5100 | |||
5101 | static int volume_write(char *buf) | ||
5102 | { | ||
5103 | int cmos_cmd, inc, i; | ||
5104 | u8 level, mute; | ||
5105 | int new_level, new_mute; | ||
5106 | char *cmd; | ||
5107 | |||
5108 | while ((cmd = next_cmd(&buf))) { | ||
5109 | if (!acpi_ec_read(volume_offset, &level)) | ||
5110 | return -EIO; | ||
5111 | new_mute = mute = level & 0x40; | ||
5112 | new_level = level = level & 0xf; | ||
5113 | |||
5114 | if (strlencmp(cmd, "up") == 0) { | ||
5115 | if (mute) | ||
5116 | new_mute = 0; | ||
5117 | else | ||
5118 | new_level = level == 15 ? 15 : level + 1; | ||
5119 | } else if (strlencmp(cmd, "down") == 0) { | ||
5120 | if (mute) | ||
5121 | new_mute = 0; | ||
5122 | else | ||
5123 | new_level = level == 0 ? 0 : level - 1; | ||
5124 | } else if (sscanf(cmd, "level %d", &new_level) == 1 && | ||
5125 | new_level >= 0 && new_level <= 15) { | ||
5126 | /* new_level set */ | ||
5127 | } else if (strlencmp(cmd, "mute") == 0) { | ||
5128 | new_mute = 0x40; | ||
5129 | } else | ||
5130 | return -EINVAL; | ||
5131 | |||
5132 | if (new_level != level) { | ||
5133 | /* mute doesn't change */ | ||
5134 | |||
5135 | cmos_cmd = (new_level > level) ? | ||
5136 | TP_CMOS_VOLUME_UP : TP_CMOS_VOLUME_DOWN; | ||
5137 | inc = new_level > level ? 1 : -1; | ||
5138 | |||
5139 | if (mute && (issue_thinkpad_cmos_command(cmos_cmd) || | ||
5140 | !acpi_ec_write(volume_offset, level))) | ||
5141 | return -EIO; | ||
5142 | |||
5143 | for (i = level; i != new_level; i += inc) | ||
5144 | if (issue_thinkpad_cmos_command(cmos_cmd) || | ||
5145 | !acpi_ec_write(volume_offset, i + inc)) | ||
5146 | return -EIO; | ||
5147 | |||
5148 | if (mute && | ||
5149 | (issue_thinkpad_cmos_command(TP_CMOS_VOLUME_MUTE) || | ||
5150 | !acpi_ec_write(volume_offset, new_level + mute))) { | ||
5151 | return -EIO; | ||
5152 | } | ||
5153 | } | ||
5154 | |||
5155 | if (new_mute != mute) { | ||
5156 | /* level doesn't change */ | ||
5157 | |||
5158 | cmos_cmd = (new_mute) ? | ||
5159 | TP_CMOS_VOLUME_MUTE : TP_CMOS_VOLUME_UP; | ||
5160 | |||
5161 | if (issue_thinkpad_cmos_command(cmos_cmd) || | ||
5162 | !acpi_ec_write(volume_offset, level + new_mute)) | ||
5163 | return -EIO; | ||
5164 | } | ||
5165 | } | ||
5166 | |||
5167 | return 0; | ||
5168 | } | ||
5169 | |||
5170 | static struct ibm_struct volume_driver_data = { | ||
5171 | .name = "volume", | ||
5172 | .read = volume_read, | ||
5173 | .write = volume_write, | ||
5174 | }; | ||
5175 | |||
5176 | /************************************************************************* | ||
5177 | * Fan subdriver | ||
5178 | */ | ||
5179 | |||
5180 | /* | ||
5181 | * FAN ACCESS MODES | ||
5182 | * | ||
5183 | * TPACPI_FAN_RD_ACPI_GFAN: | ||
5184 | * ACPI GFAN method: returns fan level | ||
5185 | * | ||
5186 | * see TPACPI_FAN_WR_ACPI_SFAN | ||
5187 | * EC 0x2f (HFSP) not available if GFAN exists | ||
5188 | * | ||
5189 | * TPACPI_FAN_WR_ACPI_SFAN: | ||
5190 | * ACPI SFAN method: sets fan level, 0 (stop) to 7 (max) | ||
5191 | * | ||
5192 | * EC 0x2f (HFSP) might be available *for reading*, but do not use | ||
5193 | * it for writing. | ||
5194 | * | ||
5195 | * TPACPI_FAN_WR_TPEC: | ||
5196 | * ThinkPad EC register 0x2f (HFSP): fan control loop mode | ||
5197 | * Supported on almost all ThinkPads | ||
5198 | * | ||
5199 | * Fan speed changes of any sort (including those caused by the | ||
5200 | * disengaged mode) are usually done slowly by the firmware as the | ||
5201 | * maximum ammount of fan duty cycle change per second seems to be | ||
5202 | * limited. | ||
5203 | * | ||
5204 | * Reading is not available if GFAN exists. | ||
5205 | * Writing is not available if SFAN exists. | ||
5206 | * | ||
5207 | * Bits | ||
5208 | * 7 automatic mode engaged; | ||
5209 | * (default operation mode of the ThinkPad) | ||
5210 | * fan level is ignored in this mode. | ||
5211 | * 6 full speed mode (takes precedence over bit 7); | ||
5212 | * not available on all thinkpads. May disable | ||
5213 | * the tachometer while the fan controller ramps up | ||
5214 | * the speed (which can take up to a few *minutes*). | ||
5215 | * Speeds up fan to 100% duty-cycle, which is far above | ||
5216 | * the standard RPM levels. It is not impossible that | ||
5217 | * it could cause hardware damage. | ||
5218 | * 5-3 unused in some models. Extra bits for fan level | ||
5219 | * in others, but still useless as all values above | ||
5220 | * 7 map to the same speed as level 7 in these models. | ||
5221 | * 2-0 fan level (0..7 usually) | ||
5222 | * 0x00 = stop | ||
5223 | * 0x07 = max (set when temperatures critical) | ||
5224 | * Some ThinkPads may have other levels, see | ||
5225 | * TPACPI_FAN_WR_ACPI_FANS (X31/X40/X41) | ||
5226 | * | ||
5227 | * FIRMWARE BUG: on some models, EC 0x2f might not be initialized at | ||
5228 | * boot. Apparently the EC does not intialize it, so unless ACPI DSDT | ||
5229 | * does so, its initial value is meaningless (0x07). | ||
5230 | * | ||
5231 | * For firmware bugs, refer to: | ||
5232 | * http://thinkwiki.org/wiki/Embedded_Controller_Firmware#Firmware_Issues | ||
5233 | * | ||
5234 | * ---- | ||
5235 | * | ||
5236 | * ThinkPad EC register 0x84 (LSB), 0x85 (MSB): | ||
5237 | * Main fan tachometer reading (in RPM) | ||
5238 | * | ||
5239 | * This register is present on all ThinkPads with a new-style EC, and | ||
5240 | * it is known not to be present on the A21m/e, and T22, as there is | ||
5241 | * something else in offset 0x84 according to the ACPI DSDT. Other | ||
5242 | * ThinkPads from this same time period (and earlier) probably lack the | ||
5243 | * tachometer as well. | ||
5244 | * | ||
5245 | * Unfortunately a lot of ThinkPads with new-style ECs but whose firwmare | ||
5246 | * was never fixed by IBM to report the EC firmware version string | ||
5247 | * probably support the tachometer (like the early X models), so | ||
5248 | * detecting it is quite hard. We need more data to know for sure. | ||
5249 | * | ||
5250 | * FIRMWARE BUG: always read 0x84 first, otherwise incorrect readings | ||
5251 | * might result. | ||
5252 | * | ||
5253 | * FIRMWARE BUG: may go stale while the EC is switching to full speed | ||
5254 | * mode. | ||
5255 | * | ||
5256 | * For firmware bugs, refer to: | ||
5257 | * http://thinkwiki.org/wiki/Embedded_Controller_Firmware#Firmware_Issues | ||
5258 | * | ||
5259 | * TPACPI_FAN_WR_ACPI_FANS: | ||
5260 | * ThinkPad X31, X40, X41. Not available in the X60. | ||
5261 | * | ||
5262 | * FANS ACPI handle: takes three arguments: low speed, medium speed, | ||
5263 | * high speed. ACPI DSDT seems to map these three speeds to levels | ||
5264 | * as follows: STOP LOW LOW MED MED HIGH HIGH HIGH HIGH | ||
5265 | * (this map is stored on FAN0..FAN8 as "0,1,1,2,2,3,3,3,3") | ||
5266 | * | ||
5267 | * The speeds are stored on handles | ||
5268 | * (FANA:FAN9), (FANC:FANB), (FANE:FAND). | ||
5269 | * | ||
5270 | * There are three default speed sets, acessible as handles: | ||
5271 | * FS1L,FS1M,FS1H; FS2L,FS2M,FS2H; FS3L,FS3M,FS3H | ||
5272 | * | ||
5273 | * ACPI DSDT switches which set is in use depending on various | ||
5274 | * factors. | ||
5275 | * | ||
5276 | * TPACPI_FAN_WR_TPEC is also available and should be used to | ||
5277 | * command the fan. The X31/X40/X41 seems to have 8 fan levels, | ||
5278 | * but the ACPI tables just mention level 7. | ||
5279 | */ | ||
5280 | |||
5281 | enum { /* Fan control constants */ | ||
5282 | fan_status_offset = 0x2f, /* EC register 0x2f */ | ||
5283 | fan_rpm_offset = 0x84, /* EC register 0x84: LSB, 0x85 MSB (RPM) | ||
5284 | * 0x84 must be read before 0x85 */ | ||
5285 | |||
5286 | TP_EC_FAN_FULLSPEED = 0x40, /* EC fan mode: full speed */ | ||
5287 | TP_EC_FAN_AUTO = 0x80, /* EC fan mode: auto fan control */ | ||
5288 | |||
5289 | TPACPI_FAN_LAST_LEVEL = 0x100, /* Use cached last-seen fan level */ | ||
5290 | }; | ||
5291 | |||
5292 | enum fan_status_access_mode { | ||
5293 | TPACPI_FAN_NONE = 0, /* No fan status or control */ | ||
5294 | TPACPI_FAN_RD_ACPI_GFAN, /* Use ACPI GFAN */ | ||
5295 | TPACPI_FAN_RD_TPEC, /* Use ACPI EC regs 0x2f, 0x84-0x85 */ | ||
5296 | }; | ||
5297 | |||
5298 | enum fan_control_access_mode { | ||
5299 | TPACPI_FAN_WR_NONE = 0, /* No fan control */ | ||
5300 | TPACPI_FAN_WR_ACPI_SFAN, /* Use ACPI SFAN */ | ||
5301 | TPACPI_FAN_WR_TPEC, /* Use ACPI EC reg 0x2f */ | ||
5302 | TPACPI_FAN_WR_ACPI_FANS, /* Use ACPI FANS and EC reg 0x2f */ | ||
5303 | }; | ||
5304 | |||
5305 | enum fan_control_commands { | ||
5306 | TPACPI_FAN_CMD_SPEED = 0x0001, /* speed command */ | ||
5307 | TPACPI_FAN_CMD_LEVEL = 0x0002, /* level command */ | ||
5308 | TPACPI_FAN_CMD_ENABLE = 0x0004, /* enable/disable cmd, | ||
5309 | * and also watchdog cmd */ | ||
5310 | }; | ||
5311 | |||
5312 | static int fan_control_allowed; | ||
5313 | |||
5314 | static enum fan_status_access_mode fan_status_access_mode; | ||
5315 | static enum fan_control_access_mode fan_control_access_mode; | ||
5316 | static enum fan_control_commands fan_control_commands; | ||
5317 | |||
5318 | static u8 fan_control_initial_status; | ||
5319 | static u8 fan_control_desired_level; | ||
5320 | static u8 fan_control_resume_level; | ||
5321 | static int fan_watchdog_maxinterval; | ||
5322 | |||
5323 | static struct mutex fan_mutex; | ||
5324 | |||
5325 | static void fan_watchdog_fire(struct work_struct *ignored); | ||
5326 | static DECLARE_DELAYED_WORK(fan_watchdog_task, fan_watchdog_fire); | ||
5327 | |||
5328 | TPACPI_HANDLE(fans, ec, "FANS"); /* X31, X40, X41 */ | ||
5329 | TPACPI_HANDLE(gfan, ec, "GFAN", /* 570 */ | ||
5330 | "\\FSPD", /* 600e/x, 770e, 770x */ | ||
5331 | ); /* all others */ | ||
5332 | TPACPI_HANDLE(sfan, ec, "SFAN", /* 570 */ | ||
5333 | "JFNS", /* 770x-JL */ | ||
5334 | ); /* all others */ | ||
5335 | |||
5336 | /* | ||
5337 | * Call with fan_mutex held | ||
5338 | */ | ||
5339 | static void fan_update_desired_level(u8 status) | ||
5340 | { | ||
5341 | if ((status & | ||
5342 | (TP_EC_FAN_AUTO | TP_EC_FAN_FULLSPEED)) == 0) { | ||
5343 | if (status > 7) | ||
5344 | fan_control_desired_level = 7; | ||
5345 | else | ||
5346 | fan_control_desired_level = status; | ||
5347 | } | ||
5348 | } | ||
5349 | |||
5350 | static int fan_get_status(u8 *status) | ||
5351 | { | ||
5352 | u8 s; | ||
5353 | |||
5354 | /* TODO: | ||
5355 | * Add TPACPI_FAN_RD_ACPI_FANS ? */ | ||
5356 | |||
5357 | switch (fan_status_access_mode) { | ||
5358 | case TPACPI_FAN_RD_ACPI_GFAN: | ||
5359 | /* 570, 600e/x, 770e, 770x */ | ||
5360 | |||
5361 | if (unlikely(!acpi_evalf(gfan_handle, &s, NULL, "d"))) | ||
5362 | return -EIO; | ||
5363 | |||
5364 | if (likely(status)) | ||
5365 | *status = s & 0x07; | ||
5366 | |||
5367 | break; | ||
5368 | |||
5369 | case TPACPI_FAN_RD_TPEC: | ||
5370 | /* all except 570, 600e/x, 770e, 770x */ | ||
5371 | if (unlikely(!acpi_ec_read(fan_status_offset, &s))) | ||
5372 | return -EIO; | ||
5373 | |||
5374 | if (likely(status)) | ||
5375 | *status = s; | ||
5376 | |||
5377 | break; | ||
5378 | |||
5379 | default: | ||
5380 | return -ENXIO; | ||
5381 | } | ||
5382 | |||
5383 | return 0; | ||
5384 | } | ||
5385 | |||
5386 | static int fan_get_status_safe(u8 *status) | ||
5387 | { | ||
5388 | int rc; | ||
5389 | u8 s; | ||
5390 | |||
5391 | if (mutex_lock_interruptible(&fan_mutex)) | ||
5392 | return -ERESTARTSYS; | ||
5393 | rc = fan_get_status(&s); | ||
5394 | if (!rc) | ||
5395 | fan_update_desired_level(s); | ||
5396 | mutex_unlock(&fan_mutex); | ||
5397 | |||
5398 | if (status) | ||
5399 | *status = s; | ||
5400 | |||
5401 | return rc; | ||
5402 | } | ||
5403 | |||
5404 | static int fan_get_speed(unsigned int *speed) | ||
5405 | { | ||
5406 | u8 hi, lo; | ||
5407 | |||
5408 | switch (fan_status_access_mode) { | ||
5409 | case TPACPI_FAN_RD_TPEC: | ||
5410 | /* all except 570, 600e/x, 770e, 770x */ | ||
5411 | if (unlikely(!acpi_ec_read(fan_rpm_offset, &lo) || | ||
5412 | !acpi_ec_read(fan_rpm_offset + 1, &hi))) | ||
5413 | return -EIO; | ||
5414 | |||
5415 | if (likely(speed)) | ||
5416 | *speed = (hi << 8) | lo; | ||
5417 | |||
5418 | break; | ||
5419 | |||
5420 | default: | ||
5421 | return -ENXIO; | ||
5422 | } | ||
5423 | |||
5424 | return 0; | ||
5425 | } | ||
5426 | |||
5427 | static int fan_set_level(int level) | ||
5428 | { | ||
5429 | if (!fan_control_allowed) | ||
5430 | return -EPERM; | ||
5431 | |||
5432 | switch (fan_control_access_mode) { | ||
5433 | case TPACPI_FAN_WR_ACPI_SFAN: | ||
5434 | if (level >= 0 && level <= 7) { | ||
5435 | if (!acpi_evalf(sfan_handle, NULL, NULL, "vd", level)) | ||
5436 | return -EIO; | ||
5437 | } else | ||
5438 | return -EINVAL; | ||
5439 | break; | ||
5440 | |||
5441 | case TPACPI_FAN_WR_ACPI_FANS: | ||
5442 | case TPACPI_FAN_WR_TPEC: | ||
5443 | if (!(level & TP_EC_FAN_AUTO) && | ||
5444 | !(level & TP_EC_FAN_FULLSPEED) && | ||
5445 | ((level < 0) || (level > 7))) | ||
5446 | return -EINVAL; | ||
5447 | |||
5448 | /* safety net should the EC not support AUTO | ||
5449 | * or FULLSPEED mode bits and just ignore them */ | ||
5450 | if (level & TP_EC_FAN_FULLSPEED) | ||
5451 | level |= 7; /* safety min speed 7 */ | ||
5452 | else if (level & TP_EC_FAN_AUTO) | ||
5453 | level |= 4; /* safety min speed 4 */ | ||
5454 | |||
5455 | if (!acpi_ec_write(fan_status_offset, level)) | ||
5456 | return -EIO; | ||
5457 | else | ||
5458 | tp_features.fan_ctrl_status_undef = 0; | ||
5459 | break; | ||
5460 | |||
5461 | default: | ||
5462 | return -ENXIO; | ||
5463 | } | ||
5464 | return 0; | ||
5465 | } | ||
5466 | |||
5467 | static int fan_set_level_safe(int level) | ||
5468 | { | ||
5469 | int rc; | ||
5470 | |||
5471 | if (!fan_control_allowed) | ||
5472 | return -EPERM; | ||
5473 | |||
5474 | if (mutex_lock_interruptible(&fan_mutex)) | ||
5475 | return -ERESTARTSYS; | ||
5476 | |||
5477 | if (level == TPACPI_FAN_LAST_LEVEL) | ||
5478 | level = fan_control_desired_level; | ||
5479 | |||
5480 | rc = fan_set_level(level); | ||
5481 | if (!rc) | ||
5482 | fan_update_desired_level(level); | ||
5483 | |||
5484 | mutex_unlock(&fan_mutex); | ||
5485 | return rc; | ||
5486 | } | ||
5487 | |||
5488 | static int fan_set_enable(void) | ||
5489 | { | ||
5490 | u8 s; | ||
5491 | int rc; | ||
5492 | |||
5493 | if (!fan_control_allowed) | ||
5494 | return -EPERM; | ||
5495 | |||
5496 | if (mutex_lock_interruptible(&fan_mutex)) | ||
5497 | return -ERESTARTSYS; | ||
5498 | |||
5499 | switch (fan_control_access_mode) { | ||
5500 | case TPACPI_FAN_WR_ACPI_FANS: | ||
5501 | case TPACPI_FAN_WR_TPEC: | ||
5502 | rc = fan_get_status(&s); | ||
5503 | if (rc < 0) | ||
5504 | break; | ||
5505 | |||
5506 | /* Don't go out of emergency fan mode */ | ||
5507 | if (s != 7) { | ||
5508 | s &= 0x07; | ||
5509 | s |= TP_EC_FAN_AUTO | 4; /* min fan speed 4 */ | ||
5510 | } | ||
5511 | |||
5512 | if (!acpi_ec_write(fan_status_offset, s)) | ||
5513 | rc = -EIO; | ||
5514 | else { | ||
5515 | tp_features.fan_ctrl_status_undef = 0; | ||
5516 | rc = 0; | ||
5517 | } | ||
5518 | break; | ||
5519 | |||
5520 | case TPACPI_FAN_WR_ACPI_SFAN: | ||
5521 | rc = fan_get_status(&s); | ||
5522 | if (rc < 0) | ||
5523 | break; | ||
5524 | |||
5525 | s &= 0x07; | ||
5526 | |||
5527 | /* Set fan to at least level 4 */ | ||
5528 | s |= 4; | ||
5529 | |||
5530 | if (!acpi_evalf(sfan_handle, NULL, NULL, "vd", s)) | ||
5531 | rc = -EIO; | ||
5532 | else | ||
5533 | rc = 0; | ||
5534 | break; | ||
5535 | |||
5536 | default: | ||
5537 | rc = -ENXIO; | ||
5538 | } | ||
5539 | |||
5540 | mutex_unlock(&fan_mutex); | ||
5541 | return rc; | ||
5542 | } | ||
5543 | |||
5544 | static int fan_set_disable(void) | ||
5545 | { | ||
5546 | int rc; | ||
5547 | |||
5548 | if (!fan_control_allowed) | ||
5549 | return -EPERM; | ||
5550 | |||
5551 | if (mutex_lock_interruptible(&fan_mutex)) | ||
5552 | return -ERESTARTSYS; | ||
5553 | |||
5554 | rc = 0; | ||
5555 | switch (fan_control_access_mode) { | ||
5556 | case TPACPI_FAN_WR_ACPI_FANS: | ||
5557 | case TPACPI_FAN_WR_TPEC: | ||
5558 | if (!acpi_ec_write(fan_status_offset, 0x00)) | ||
5559 | rc = -EIO; | ||
5560 | else { | ||
5561 | fan_control_desired_level = 0; | ||
5562 | tp_features.fan_ctrl_status_undef = 0; | ||
5563 | } | ||
5564 | break; | ||
5565 | |||
5566 | case TPACPI_FAN_WR_ACPI_SFAN: | ||
5567 | if (!acpi_evalf(sfan_handle, NULL, NULL, "vd", 0x00)) | ||
5568 | rc = -EIO; | ||
5569 | else | ||
5570 | fan_control_desired_level = 0; | ||
5571 | break; | ||
5572 | |||
5573 | default: | ||
5574 | rc = -ENXIO; | ||
5575 | } | ||
5576 | |||
5577 | |||
5578 | mutex_unlock(&fan_mutex); | ||
5579 | return rc; | ||
5580 | } | ||
5581 | |||
5582 | static int fan_set_speed(int speed) | ||
5583 | { | ||
5584 | int rc; | ||
5585 | |||
5586 | if (!fan_control_allowed) | ||
5587 | return -EPERM; | ||
5588 | |||
5589 | if (mutex_lock_interruptible(&fan_mutex)) | ||
5590 | return -ERESTARTSYS; | ||
5591 | |||
5592 | rc = 0; | ||
5593 | switch (fan_control_access_mode) { | ||
5594 | case TPACPI_FAN_WR_ACPI_FANS: | ||
5595 | if (speed >= 0 && speed <= 65535) { | ||
5596 | if (!acpi_evalf(fans_handle, NULL, NULL, "vddd", | ||
5597 | speed, speed, speed)) | ||
5598 | rc = -EIO; | ||
5599 | } else | ||
5600 | rc = -EINVAL; | ||
5601 | break; | ||
5602 | |||
5603 | default: | ||
5604 | rc = -ENXIO; | ||
5605 | } | ||
5606 | |||
5607 | mutex_unlock(&fan_mutex); | ||
5608 | return rc; | ||
5609 | } | ||
5610 | |||
5611 | static void fan_watchdog_reset(void) | ||
5612 | { | ||
5613 | static int fan_watchdog_active; | ||
5614 | |||
5615 | if (fan_control_access_mode == TPACPI_FAN_WR_NONE) | ||
5616 | return; | ||
5617 | |||
5618 | if (fan_watchdog_active) | ||
5619 | cancel_delayed_work(&fan_watchdog_task); | ||
5620 | |||
5621 | if (fan_watchdog_maxinterval > 0 && | ||
5622 | tpacpi_lifecycle != TPACPI_LIFE_EXITING) { | ||
5623 | fan_watchdog_active = 1; | ||
5624 | if (!queue_delayed_work(tpacpi_wq, &fan_watchdog_task, | ||
5625 | msecs_to_jiffies(fan_watchdog_maxinterval | ||
5626 | * 1000))) { | ||
5627 | printk(TPACPI_ERR | ||
5628 | "failed to queue the fan watchdog, " | ||
5629 | "watchdog will not trigger\n"); | ||
5630 | } | ||
5631 | } else | ||
5632 | fan_watchdog_active = 0; | ||
5633 | } | ||
5634 | |||
5635 | static void fan_watchdog_fire(struct work_struct *ignored) | ||
5636 | { | ||
5637 | int rc; | ||
5638 | |||
5639 | if (tpacpi_lifecycle != TPACPI_LIFE_RUNNING) | ||
5640 | return; | ||
5641 | |||
5642 | printk(TPACPI_NOTICE "fan watchdog: enabling fan\n"); | ||
5643 | rc = fan_set_enable(); | ||
5644 | if (rc < 0) { | ||
5645 | printk(TPACPI_ERR "fan watchdog: error %d while enabling fan, " | ||
5646 | "will try again later...\n", -rc); | ||
5647 | /* reschedule for later */ | ||
5648 | fan_watchdog_reset(); | ||
5649 | } | ||
5650 | } | ||
5651 | |||
5652 | /* | ||
5653 | * SYSFS fan layout: hwmon compatible (device) | ||
5654 | * | ||
5655 | * pwm*_enable: | ||
5656 | * 0: "disengaged" mode | ||
5657 | * 1: manual mode | ||
5658 | * 2: native EC "auto" mode (recommended, hardware default) | ||
5659 | * | ||
5660 | * pwm*: set speed in manual mode, ignored otherwise. | ||
5661 | * 0 is level 0; 255 is level 7. Intermediate points done with linear | ||
5662 | * interpolation. | ||
5663 | * | ||
5664 | * fan*_input: tachometer reading, RPM | ||
5665 | * | ||
5666 | * | ||
5667 | * SYSFS fan layout: extensions | ||
5668 | * | ||
5669 | * fan_watchdog (driver): | ||
5670 | * fan watchdog interval in seconds, 0 disables (default), max 120 | ||
5671 | */ | ||
5672 | |||
5673 | /* sysfs fan pwm1_enable ----------------------------------------------- */ | ||
5674 | static ssize_t fan_pwm1_enable_show(struct device *dev, | ||
5675 | struct device_attribute *attr, | ||
5676 | char *buf) | ||
5677 | { | ||
5678 | int res, mode; | ||
5679 | u8 status; | ||
5680 | |||
5681 | res = fan_get_status_safe(&status); | ||
5682 | if (res) | ||
5683 | return res; | ||
5684 | |||
5685 | if (unlikely(tp_features.fan_ctrl_status_undef)) { | ||
5686 | if (status != fan_control_initial_status) { | ||
5687 | tp_features.fan_ctrl_status_undef = 0; | ||
5688 | } else { | ||
5689 | /* Return most likely status. In fact, it | ||
5690 | * might be the only possible status */ | ||
5691 | status = TP_EC_FAN_AUTO; | ||
5692 | } | ||
5693 | } | ||
5694 | |||
5695 | if (status & TP_EC_FAN_FULLSPEED) { | ||
5696 | mode = 0; | ||
5697 | } else if (status & TP_EC_FAN_AUTO) { | ||
5698 | mode = 2; | ||
5699 | } else | ||
5700 | mode = 1; | ||
5701 | |||
5702 | return snprintf(buf, PAGE_SIZE, "%d\n", mode); | ||
5703 | } | ||
5704 | |||
5705 | static ssize_t fan_pwm1_enable_store(struct device *dev, | ||
5706 | struct device_attribute *attr, | ||
5707 | const char *buf, size_t count) | ||
5708 | { | ||
5709 | unsigned long t; | ||
5710 | int res, level; | ||
5711 | |||
5712 | if (parse_strtoul(buf, 2, &t)) | ||
5713 | return -EINVAL; | ||
5714 | |||
5715 | switch (t) { | ||
5716 | case 0: | ||
5717 | level = TP_EC_FAN_FULLSPEED; | ||
5718 | break; | ||
5719 | case 1: | ||
5720 | level = TPACPI_FAN_LAST_LEVEL; | ||
5721 | break; | ||
5722 | case 2: | ||
5723 | level = TP_EC_FAN_AUTO; | ||
5724 | break; | ||
5725 | case 3: | ||
5726 | /* reserved for software-controlled auto mode */ | ||
5727 | return -ENOSYS; | ||
5728 | default: | ||
5729 | return -EINVAL; | ||
5730 | } | ||
5731 | |||
5732 | res = fan_set_level_safe(level); | ||
5733 | if (res == -ENXIO) | ||
5734 | return -EINVAL; | ||
5735 | else if (res < 0) | ||
5736 | return res; | ||
5737 | |||
5738 | fan_watchdog_reset(); | ||
5739 | |||
5740 | return count; | ||
5741 | } | ||
5742 | |||
5743 | static struct device_attribute dev_attr_fan_pwm1_enable = | ||
5744 | __ATTR(pwm1_enable, S_IWUSR | S_IRUGO, | ||
5745 | fan_pwm1_enable_show, fan_pwm1_enable_store); | ||
5746 | |||
5747 | /* sysfs fan pwm1 ------------------------------------------------------ */ | ||
5748 | static ssize_t fan_pwm1_show(struct device *dev, | ||
5749 | struct device_attribute *attr, | ||
5750 | char *buf) | ||
5751 | { | ||
5752 | int res; | ||
5753 | u8 status; | ||
5754 | |||
5755 | res = fan_get_status_safe(&status); | ||
5756 | if (res) | ||
5757 | return res; | ||
5758 | |||
5759 | if (unlikely(tp_features.fan_ctrl_status_undef)) { | ||
5760 | if (status != fan_control_initial_status) { | ||
5761 | tp_features.fan_ctrl_status_undef = 0; | ||
5762 | } else { | ||
5763 | status = TP_EC_FAN_AUTO; | ||
5764 | } | ||
5765 | } | ||
5766 | |||
5767 | if ((status & | ||
5768 | (TP_EC_FAN_AUTO | TP_EC_FAN_FULLSPEED)) != 0) | ||
5769 | status = fan_control_desired_level; | ||
5770 | |||
5771 | if (status > 7) | ||
5772 | status = 7; | ||
5773 | |||
5774 | return snprintf(buf, PAGE_SIZE, "%u\n", (status * 255) / 7); | ||
5775 | } | ||
5776 | |||
5777 | static ssize_t fan_pwm1_store(struct device *dev, | ||
5778 | struct device_attribute *attr, | ||
5779 | const char *buf, size_t count) | ||
5780 | { | ||
5781 | unsigned long s; | ||
5782 | int rc; | ||
5783 | u8 status, newlevel; | ||
5784 | |||
5785 | if (parse_strtoul(buf, 255, &s)) | ||
5786 | return -EINVAL; | ||
5787 | |||
5788 | /* scale down from 0-255 to 0-7 */ | ||
5789 | newlevel = (s >> 5) & 0x07; | ||
5790 | |||
5791 | if (mutex_lock_interruptible(&fan_mutex)) | ||
5792 | return -ERESTARTSYS; | ||
5793 | |||
5794 | rc = fan_get_status(&status); | ||
5795 | if (!rc && (status & | ||
5796 | (TP_EC_FAN_AUTO | TP_EC_FAN_FULLSPEED)) == 0) { | ||
5797 | rc = fan_set_level(newlevel); | ||
5798 | if (rc == -ENXIO) | ||
5799 | rc = -EINVAL; | ||
5800 | else if (!rc) { | ||
5801 | fan_update_desired_level(newlevel); | ||
5802 | fan_watchdog_reset(); | ||
5803 | } | ||
5804 | } | ||
5805 | |||
5806 | mutex_unlock(&fan_mutex); | ||
5807 | return (rc)? rc : count; | ||
5808 | } | ||
5809 | |||
5810 | static struct device_attribute dev_attr_fan_pwm1 = | ||
5811 | __ATTR(pwm1, S_IWUSR | S_IRUGO, | ||
5812 | fan_pwm1_show, fan_pwm1_store); | ||
5813 | |||
5814 | /* sysfs fan fan1_input ------------------------------------------------ */ | ||
5815 | static ssize_t fan_fan1_input_show(struct device *dev, | ||
5816 | struct device_attribute *attr, | ||
5817 | char *buf) | ||
5818 | { | ||
5819 | int res; | ||
5820 | unsigned int speed; | ||
5821 | |||
5822 | res = fan_get_speed(&speed); | ||
5823 | if (res < 0) | ||
5824 | return res; | ||
5825 | |||
5826 | return snprintf(buf, PAGE_SIZE, "%u\n", speed); | ||
5827 | } | ||
5828 | |||
5829 | static struct device_attribute dev_attr_fan_fan1_input = | ||
5830 | __ATTR(fan1_input, S_IRUGO, | ||
5831 | fan_fan1_input_show, NULL); | ||
5832 | |||
5833 | /* sysfs fan fan_watchdog (hwmon driver) ------------------------------- */ | ||
5834 | static ssize_t fan_fan_watchdog_show(struct device_driver *drv, | ||
5835 | char *buf) | ||
5836 | { | ||
5837 | return snprintf(buf, PAGE_SIZE, "%u\n", fan_watchdog_maxinterval); | ||
5838 | } | ||
5839 | |||
5840 | static ssize_t fan_fan_watchdog_store(struct device_driver *drv, | ||
5841 | const char *buf, size_t count) | ||
5842 | { | ||
5843 | unsigned long t; | ||
5844 | |||
5845 | if (parse_strtoul(buf, 120, &t)) | ||
5846 | return -EINVAL; | ||
5847 | |||
5848 | if (!fan_control_allowed) | ||
5849 | return -EPERM; | ||
5850 | |||
5851 | fan_watchdog_maxinterval = t; | ||
5852 | fan_watchdog_reset(); | ||
5853 | |||
5854 | return count; | ||
5855 | } | ||
5856 | |||
5857 | static DRIVER_ATTR(fan_watchdog, S_IWUSR | S_IRUGO, | ||
5858 | fan_fan_watchdog_show, fan_fan_watchdog_store); | ||
5859 | |||
5860 | /* --------------------------------------------------------------------- */ | ||
5861 | static struct attribute *fan_attributes[] = { | ||
5862 | &dev_attr_fan_pwm1_enable.attr, &dev_attr_fan_pwm1.attr, | ||
5863 | &dev_attr_fan_fan1_input.attr, | ||
5864 | NULL | ||
5865 | }; | ||
5866 | |||
5867 | static const struct attribute_group fan_attr_group = { | ||
5868 | .attrs = fan_attributes, | ||
5869 | }; | ||
5870 | |||
5871 | static int __init fan_init(struct ibm_init_struct *iibm) | ||
5872 | { | ||
5873 | int rc; | ||
5874 | |||
5875 | vdbg_printk(TPACPI_DBG_INIT, "initializing fan subdriver\n"); | ||
5876 | |||
5877 | mutex_init(&fan_mutex); | ||
5878 | fan_status_access_mode = TPACPI_FAN_NONE; | ||
5879 | fan_control_access_mode = TPACPI_FAN_WR_NONE; | ||
5880 | fan_control_commands = 0; | ||
5881 | fan_watchdog_maxinterval = 0; | ||
5882 | tp_features.fan_ctrl_status_undef = 0; | ||
5883 | fan_control_desired_level = 7; | ||
5884 | |||
5885 | TPACPI_ACPIHANDLE_INIT(fans); | ||
5886 | TPACPI_ACPIHANDLE_INIT(gfan); | ||
5887 | TPACPI_ACPIHANDLE_INIT(sfan); | ||
5888 | |||
5889 | if (gfan_handle) { | ||
5890 | /* 570, 600e/x, 770e, 770x */ | ||
5891 | fan_status_access_mode = TPACPI_FAN_RD_ACPI_GFAN; | ||
5892 | } else { | ||
5893 | /* all other ThinkPads: note that even old-style | ||
5894 | * ThinkPad ECs supports the fan control register */ | ||
5895 | if (likely(acpi_ec_read(fan_status_offset, | ||
5896 | &fan_control_initial_status))) { | ||
5897 | fan_status_access_mode = TPACPI_FAN_RD_TPEC; | ||
5898 | |||
5899 | /* In some ThinkPads, neither the EC nor the ACPI | ||
5900 | * DSDT initialize the fan status, and it ends up | ||
5901 | * being set to 0x07 when it *could* be either | ||
5902 | * 0x07 or 0x80. | ||
5903 | * | ||
5904 | * Enable for TP-1Y (T43), TP-78 (R51e), | ||
5905 | * TP-76 (R52), TP-70 (T43, R52), which are known | ||
5906 | * to be buggy. */ | ||
5907 | if (fan_control_initial_status == 0x07) { | ||
5908 | switch (thinkpad_id.ec_model) { | ||
5909 | case 0x5931: /* TP-1Y */ | ||
5910 | case 0x3837: /* TP-78 */ | ||
5911 | case 0x3637: /* TP-76 */ | ||
5912 | case 0x3037: /* TP-70 */ | ||
5913 | printk(TPACPI_NOTICE | ||
5914 | "fan_init: initial fan status " | ||
5915 | "is unknown, assuming it is " | ||
5916 | "in auto mode\n"); | ||
5917 | tp_features.fan_ctrl_status_undef = 1; | ||
5918 | ;; | ||
5919 | } | ||
5920 | } | ||
5921 | } else { | ||
5922 | printk(TPACPI_ERR | ||
5923 | "ThinkPad ACPI EC access misbehaving, " | ||
5924 | "fan status and control unavailable\n"); | ||
5925 | return 1; | ||
5926 | } | ||
5927 | } | ||
5928 | |||
5929 | if (sfan_handle) { | ||
5930 | /* 570, 770x-JL */ | ||
5931 | fan_control_access_mode = TPACPI_FAN_WR_ACPI_SFAN; | ||
5932 | fan_control_commands |= | ||
5933 | TPACPI_FAN_CMD_LEVEL | TPACPI_FAN_CMD_ENABLE; | ||
5934 | } else { | ||
5935 | if (!gfan_handle) { | ||
5936 | /* gfan without sfan means no fan control */ | ||
5937 | /* all other models implement TP EC 0x2f control */ | ||
5938 | |||
5939 | if (fans_handle) { | ||
5940 | /* X31, X40, X41 */ | ||
5941 | fan_control_access_mode = | ||
5942 | TPACPI_FAN_WR_ACPI_FANS; | ||
5943 | fan_control_commands |= | ||
5944 | TPACPI_FAN_CMD_SPEED | | ||
5945 | TPACPI_FAN_CMD_LEVEL | | ||
5946 | TPACPI_FAN_CMD_ENABLE; | ||
5947 | } else { | ||
5948 | fan_control_access_mode = TPACPI_FAN_WR_TPEC; | ||
5949 | fan_control_commands |= | ||
5950 | TPACPI_FAN_CMD_LEVEL | | ||
5951 | TPACPI_FAN_CMD_ENABLE; | ||
5952 | } | ||
5953 | } | ||
5954 | } | ||
5955 | |||
5956 | vdbg_printk(TPACPI_DBG_INIT, "fan is %s, modes %d, %d\n", | ||
5957 | str_supported(fan_status_access_mode != TPACPI_FAN_NONE || | ||
5958 | fan_control_access_mode != TPACPI_FAN_WR_NONE), | ||
5959 | fan_status_access_mode, fan_control_access_mode); | ||
5960 | |||
5961 | /* fan control master switch */ | ||
5962 | if (!fan_control_allowed) { | ||
5963 | fan_control_access_mode = TPACPI_FAN_WR_NONE; | ||
5964 | fan_control_commands = 0; | ||
5965 | dbg_printk(TPACPI_DBG_INIT, | ||
5966 | "fan control features disabled by parameter\n"); | ||
5967 | } | ||
5968 | |||
5969 | /* update fan_control_desired_level */ | ||
5970 | if (fan_status_access_mode != TPACPI_FAN_NONE) | ||
5971 | fan_get_status_safe(NULL); | ||
5972 | |||
5973 | if (fan_status_access_mode != TPACPI_FAN_NONE || | ||
5974 | fan_control_access_mode != TPACPI_FAN_WR_NONE) { | ||
5975 | rc = sysfs_create_group(&tpacpi_sensors_pdev->dev.kobj, | ||
5976 | &fan_attr_group); | ||
5977 | if (rc < 0) | ||
5978 | return rc; | ||
5979 | |||
5980 | rc = driver_create_file(&tpacpi_hwmon_pdriver.driver, | ||
5981 | &driver_attr_fan_watchdog); | ||
5982 | if (rc < 0) { | ||
5983 | sysfs_remove_group(&tpacpi_sensors_pdev->dev.kobj, | ||
5984 | &fan_attr_group); | ||
5985 | return rc; | ||
5986 | } | ||
5987 | return 0; | ||
5988 | } else | ||
5989 | return 1; | ||
5990 | } | ||
5991 | |||
5992 | static void fan_exit(void) | ||
5993 | { | ||
5994 | vdbg_printk(TPACPI_DBG_EXIT, | ||
5995 | "cancelling any pending fan watchdog tasks\n"); | ||
5996 | |||
5997 | /* FIXME: can we really do this unconditionally? */ | ||
5998 | sysfs_remove_group(&tpacpi_sensors_pdev->dev.kobj, &fan_attr_group); | ||
5999 | driver_remove_file(&tpacpi_hwmon_pdriver.driver, | ||
6000 | &driver_attr_fan_watchdog); | ||
6001 | |||
6002 | cancel_delayed_work(&fan_watchdog_task); | ||
6003 | flush_workqueue(tpacpi_wq); | ||
6004 | } | ||
6005 | |||
6006 | static void fan_suspend(pm_message_t state) | ||
6007 | { | ||
6008 | int rc; | ||
6009 | |||
6010 | if (!fan_control_allowed) | ||
6011 | return; | ||
6012 | |||
6013 | /* Store fan status in cache */ | ||
6014 | fan_control_resume_level = 0; | ||
6015 | rc = fan_get_status_safe(&fan_control_resume_level); | ||
6016 | if (rc < 0) | ||
6017 | printk(TPACPI_NOTICE | ||
6018 | "failed to read fan level for later " | ||
6019 | "restore during resume: %d\n", rc); | ||
6020 | |||
6021 | /* if it is undefined, don't attempt to restore it. | ||
6022 | * KEEP THIS LAST */ | ||
6023 | if (tp_features.fan_ctrl_status_undef) | ||
6024 | fan_control_resume_level = 0; | ||
6025 | } | ||
6026 | |||
6027 | static void fan_resume(void) | ||
6028 | { | ||
6029 | u8 current_level = 7; | ||
6030 | bool do_set = false; | ||
6031 | int rc; | ||
6032 | |||
6033 | /* DSDT *always* updates status on resume */ | ||
6034 | tp_features.fan_ctrl_status_undef = 0; | ||
6035 | |||
6036 | if (!fan_control_allowed || | ||
6037 | !fan_control_resume_level || | ||
6038 | (fan_get_status_safe(¤t_level) < 0)) | ||
6039 | return; | ||
6040 | |||
6041 | switch (fan_control_access_mode) { | ||
6042 | case TPACPI_FAN_WR_ACPI_SFAN: | ||
6043 | /* never decrease fan level */ | ||
6044 | do_set = (fan_control_resume_level > current_level); | ||
6045 | break; | ||
6046 | case TPACPI_FAN_WR_ACPI_FANS: | ||
6047 | case TPACPI_FAN_WR_TPEC: | ||
6048 | /* never decrease fan level, scale is: | ||
6049 | * TP_EC_FAN_FULLSPEED > 7 >= TP_EC_FAN_AUTO | ||
6050 | * | ||
6051 | * We expect the firmware to set either 7 or AUTO, but we | ||
6052 | * handle FULLSPEED out of paranoia. | ||
6053 | * | ||
6054 | * So, we can safely only restore FULLSPEED or 7, anything | ||
6055 | * else could slow the fan. Restoring AUTO is useless, at | ||
6056 | * best that's exactly what the DSDT already set (it is the | ||
6057 | * slower it uses). | ||
6058 | * | ||
6059 | * Always keep in mind that the DSDT *will* have set the | ||
6060 | * fans to what the vendor supposes is the best level. We | ||
6061 | * muck with it only to speed the fan up. | ||
6062 | */ | ||
6063 | if (fan_control_resume_level != 7 && | ||
6064 | !(fan_control_resume_level & TP_EC_FAN_FULLSPEED)) | ||
6065 | return; | ||
6066 | else | ||
6067 | do_set = !(current_level & TP_EC_FAN_FULLSPEED) && | ||
6068 | (current_level != fan_control_resume_level); | ||
6069 | break; | ||
6070 | default: | ||
6071 | return; | ||
6072 | } | ||
6073 | if (do_set) { | ||
6074 | printk(TPACPI_NOTICE | ||
6075 | "restoring fan level to 0x%02x\n", | ||
6076 | fan_control_resume_level); | ||
6077 | rc = fan_set_level_safe(fan_control_resume_level); | ||
6078 | if (rc < 0) | ||
6079 | printk(TPACPI_NOTICE | ||
6080 | "failed to restore fan level: %d\n", rc); | ||
6081 | } | ||
6082 | } | ||
6083 | |||
6084 | static int fan_read(char *p) | ||
6085 | { | ||
6086 | int len = 0; | ||
6087 | int rc; | ||
6088 | u8 status; | ||
6089 | unsigned int speed = 0; | ||
6090 | |||
6091 | switch (fan_status_access_mode) { | ||
6092 | case TPACPI_FAN_RD_ACPI_GFAN: | ||
6093 | /* 570, 600e/x, 770e, 770x */ | ||
6094 | rc = fan_get_status_safe(&status); | ||
6095 | if (rc < 0) | ||
6096 | return rc; | ||
6097 | |||
6098 | len += sprintf(p + len, "status:\t\t%s\n" | ||
6099 | "level:\t\t%d\n", | ||
6100 | (status != 0) ? "enabled" : "disabled", status); | ||
6101 | break; | ||
6102 | |||
6103 | case TPACPI_FAN_RD_TPEC: | ||
6104 | /* all except 570, 600e/x, 770e, 770x */ | ||
6105 | rc = fan_get_status_safe(&status); | ||
6106 | if (rc < 0) | ||
6107 | return rc; | ||
6108 | |||
6109 | if (unlikely(tp_features.fan_ctrl_status_undef)) { | ||
6110 | if (status != fan_control_initial_status) | ||
6111 | tp_features.fan_ctrl_status_undef = 0; | ||
6112 | else | ||
6113 | /* Return most likely status. In fact, it | ||
6114 | * might be the only possible status */ | ||
6115 | status = TP_EC_FAN_AUTO; | ||
6116 | } | ||
6117 | |||
6118 | len += sprintf(p + len, "status:\t\t%s\n", | ||
6119 | (status != 0) ? "enabled" : "disabled"); | ||
6120 | |||
6121 | rc = fan_get_speed(&speed); | ||
6122 | if (rc < 0) | ||
6123 | return rc; | ||
6124 | |||
6125 | len += sprintf(p + len, "speed:\t\t%d\n", speed); | ||
6126 | |||
6127 | if (status & TP_EC_FAN_FULLSPEED) | ||
6128 | /* Disengaged mode takes precedence */ | ||
6129 | len += sprintf(p + len, "level:\t\tdisengaged\n"); | ||
6130 | else if (status & TP_EC_FAN_AUTO) | ||
6131 | len += sprintf(p + len, "level:\t\tauto\n"); | ||
6132 | else | ||
6133 | len += sprintf(p + len, "level:\t\t%d\n", status); | ||
6134 | break; | ||
6135 | |||
6136 | case TPACPI_FAN_NONE: | ||
6137 | default: | ||
6138 | len += sprintf(p + len, "status:\t\tnot supported\n"); | ||
6139 | } | ||
6140 | |||
6141 | if (fan_control_commands & TPACPI_FAN_CMD_LEVEL) { | ||
6142 | len += sprintf(p + len, "commands:\tlevel <level>"); | ||
6143 | |||
6144 | switch (fan_control_access_mode) { | ||
6145 | case TPACPI_FAN_WR_ACPI_SFAN: | ||
6146 | len += sprintf(p + len, " (<level> is 0-7)\n"); | ||
6147 | break; | ||
6148 | |||
6149 | default: | ||
6150 | len += sprintf(p + len, " (<level> is 0-7, " | ||
6151 | "auto, disengaged, full-speed)\n"); | ||
6152 | break; | ||
6153 | } | ||
6154 | } | ||
6155 | |||
6156 | if (fan_control_commands & TPACPI_FAN_CMD_ENABLE) | ||
6157 | len += sprintf(p + len, "commands:\tenable, disable\n" | ||
6158 | "commands:\twatchdog <timeout> (<timeout> " | ||
6159 | "is 0 (off), 1-120 (seconds))\n"); | ||
6160 | |||
6161 | if (fan_control_commands & TPACPI_FAN_CMD_SPEED) | ||
6162 | len += sprintf(p + len, "commands:\tspeed <speed>" | ||
6163 | " (<speed> is 0-65535)\n"); | ||
6164 | |||
6165 | return len; | ||
6166 | } | ||
6167 | |||
6168 | static int fan_write_cmd_level(const char *cmd, int *rc) | ||
6169 | { | ||
6170 | int level; | ||
6171 | |||
6172 | if (strlencmp(cmd, "level auto") == 0) | ||
6173 | level = TP_EC_FAN_AUTO; | ||
6174 | else if ((strlencmp(cmd, "level disengaged") == 0) | | ||
6175 | (strlencmp(cmd, "level full-speed") == 0)) | ||
6176 | level = TP_EC_FAN_FULLSPEED; | ||
6177 | else if (sscanf(cmd, "level %d", &level) != 1) | ||
6178 | return 0; | ||
6179 | |||
6180 | *rc = fan_set_level_safe(level); | ||
6181 | if (*rc == -ENXIO) | ||
6182 | printk(TPACPI_ERR "level command accepted for unsupported " | ||
6183 | "access mode %d", fan_control_access_mode); | ||
6184 | |||
6185 | return 1; | ||
6186 | } | ||
6187 | |||
6188 | static int fan_write_cmd_enable(const char *cmd, int *rc) | ||
6189 | { | ||
6190 | if (strlencmp(cmd, "enable") != 0) | ||
6191 | return 0; | ||
6192 | |||
6193 | *rc = fan_set_enable(); | ||
6194 | if (*rc == -ENXIO) | ||
6195 | printk(TPACPI_ERR "enable command accepted for unsupported " | ||
6196 | "access mode %d", fan_control_access_mode); | ||
6197 | |||
6198 | return 1; | ||
6199 | } | ||
6200 | |||
6201 | static int fan_write_cmd_disable(const char *cmd, int *rc) | ||
6202 | { | ||
6203 | if (strlencmp(cmd, "disable") != 0) | ||
6204 | return 0; | ||
6205 | |||
6206 | *rc = fan_set_disable(); | ||
6207 | if (*rc == -ENXIO) | ||
6208 | printk(TPACPI_ERR "disable command accepted for unsupported " | ||
6209 | "access mode %d", fan_control_access_mode); | ||
6210 | |||
6211 | return 1; | ||
6212 | } | ||
6213 | |||
6214 | static int fan_write_cmd_speed(const char *cmd, int *rc) | ||
6215 | { | ||
6216 | int speed; | ||
6217 | |||
6218 | /* TODO: | ||
6219 | * Support speed <low> <medium> <high> ? */ | ||
6220 | |||
6221 | if (sscanf(cmd, "speed %d", &speed) != 1) | ||
6222 | return 0; | ||
6223 | |||
6224 | *rc = fan_set_speed(speed); | ||
6225 | if (*rc == -ENXIO) | ||
6226 | printk(TPACPI_ERR "speed command accepted for unsupported " | ||
6227 | "access mode %d", fan_control_access_mode); | ||
6228 | |||
6229 | return 1; | ||
6230 | } | ||
6231 | |||
6232 | static int fan_write_cmd_watchdog(const char *cmd, int *rc) | ||
6233 | { | ||
6234 | int interval; | ||
6235 | |||
6236 | if (sscanf(cmd, "watchdog %d", &interval) != 1) | ||
6237 | return 0; | ||
6238 | |||
6239 | if (interval < 0 || interval > 120) | ||
6240 | *rc = -EINVAL; | ||
6241 | else | ||
6242 | fan_watchdog_maxinterval = interval; | ||
6243 | |||
6244 | return 1; | ||
6245 | } | ||
6246 | |||
6247 | static int fan_write(char *buf) | ||
6248 | { | ||
6249 | char *cmd; | ||
6250 | int rc = 0; | ||
6251 | |||
6252 | while (!rc && (cmd = next_cmd(&buf))) { | ||
6253 | if (!((fan_control_commands & TPACPI_FAN_CMD_LEVEL) && | ||
6254 | fan_write_cmd_level(cmd, &rc)) && | ||
6255 | !((fan_control_commands & TPACPI_FAN_CMD_ENABLE) && | ||
6256 | (fan_write_cmd_enable(cmd, &rc) || | ||
6257 | fan_write_cmd_disable(cmd, &rc) || | ||
6258 | fan_write_cmd_watchdog(cmd, &rc))) && | ||
6259 | !((fan_control_commands & TPACPI_FAN_CMD_SPEED) && | ||
6260 | fan_write_cmd_speed(cmd, &rc)) | ||
6261 | ) | ||
6262 | rc = -EINVAL; | ||
6263 | else if (!rc) | ||
6264 | fan_watchdog_reset(); | ||
6265 | } | ||
6266 | |||
6267 | return rc; | ||
6268 | } | ||
6269 | |||
6270 | static struct ibm_struct fan_driver_data = { | ||
6271 | .name = "fan", | ||
6272 | .read = fan_read, | ||
6273 | .write = fan_write, | ||
6274 | .exit = fan_exit, | ||
6275 | .suspend = fan_suspend, | ||
6276 | .resume = fan_resume, | ||
6277 | }; | ||
6278 | |||
6279 | /**************************************************************************** | ||
6280 | **************************************************************************** | ||
6281 | * | ||
6282 | * Infrastructure | ||
6283 | * | ||
6284 | **************************************************************************** | ||
6285 | ****************************************************************************/ | ||
6286 | |||
6287 | /* sysfs name ---------------------------------------------------------- */ | ||
6288 | static ssize_t thinkpad_acpi_pdev_name_show(struct device *dev, | ||
6289 | struct device_attribute *attr, | ||
6290 | char *buf) | ||
6291 | { | ||
6292 | return snprintf(buf, PAGE_SIZE, "%s\n", TPACPI_NAME); | ||
6293 | } | ||
6294 | |||
6295 | static struct device_attribute dev_attr_thinkpad_acpi_pdev_name = | ||
6296 | __ATTR(name, S_IRUGO, thinkpad_acpi_pdev_name_show, NULL); | ||
6297 | |||
6298 | /* --------------------------------------------------------------------- */ | ||
6299 | |||
6300 | /* /proc support */ | ||
6301 | static struct proc_dir_entry *proc_dir; | ||
6302 | |||
6303 | /* | ||
6304 | * Module and infrastructure proble, init and exit handling | ||
6305 | */ | ||
6306 | |||
6307 | static int force_load; | ||
6308 | |||
6309 | #ifdef CONFIG_THINKPAD_ACPI_DEBUG | ||
6310 | static const char * __init str_supported(int is_supported) | ||
6311 | { | ||
6312 | static char text_unsupported[] __initdata = "not supported"; | ||
6313 | |||
6314 | return (is_supported)? &text_unsupported[4] : &text_unsupported[0]; | ||
6315 | } | ||
6316 | #endif /* CONFIG_THINKPAD_ACPI_DEBUG */ | ||
6317 | |||
6318 | static void ibm_exit(struct ibm_struct *ibm) | ||
6319 | { | ||
6320 | dbg_printk(TPACPI_DBG_EXIT, "removing %s\n", ibm->name); | ||
6321 | |||
6322 | list_del_init(&ibm->all_drivers); | ||
6323 | |||
6324 | if (ibm->flags.acpi_notify_installed) { | ||
6325 | dbg_printk(TPACPI_DBG_EXIT, | ||
6326 | "%s: acpi_remove_notify_handler\n", ibm->name); | ||
6327 | BUG_ON(!ibm->acpi); | ||
6328 | acpi_remove_notify_handler(*ibm->acpi->handle, | ||
6329 | ibm->acpi->type, | ||
6330 | dispatch_acpi_notify); | ||
6331 | ibm->flags.acpi_notify_installed = 0; | ||
6332 | ibm->flags.acpi_notify_installed = 0; | ||
6333 | } | ||
6334 | |||
6335 | if (ibm->flags.proc_created) { | ||
6336 | dbg_printk(TPACPI_DBG_EXIT, | ||
6337 | "%s: remove_proc_entry\n", ibm->name); | ||
6338 | remove_proc_entry(ibm->name, proc_dir); | ||
6339 | ibm->flags.proc_created = 0; | ||
6340 | } | ||
6341 | |||
6342 | if (ibm->flags.acpi_driver_registered) { | ||
6343 | dbg_printk(TPACPI_DBG_EXIT, | ||
6344 | "%s: acpi_bus_unregister_driver\n", ibm->name); | ||
6345 | BUG_ON(!ibm->acpi); | ||
6346 | acpi_bus_unregister_driver(ibm->acpi->driver); | ||
6347 | kfree(ibm->acpi->driver); | ||
6348 | ibm->acpi->driver = NULL; | ||
6349 | ibm->flags.acpi_driver_registered = 0; | ||
6350 | } | ||
6351 | |||
6352 | if (ibm->flags.init_called && ibm->exit) { | ||
6353 | ibm->exit(); | ||
6354 | ibm->flags.init_called = 0; | ||
6355 | } | ||
6356 | |||
6357 | dbg_printk(TPACPI_DBG_INIT, "finished removing %s\n", ibm->name); | ||
6358 | } | ||
6359 | |||
6360 | static int __init ibm_init(struct ibm_init_struct *iibm) | ||
6361 | { | ||
6362 | int ret; | ||
6363 | struct ibm_struct *ibm = iibm->data; | ||
6364 | struct proc_dir_entry *entry; | ||
6365 | |||
6366 | BUG_ON(ibm == NULL); | ||
6367 | |||
6368 | INIT_LIST_HEAD(&ibm->all_drivers); | ||
6369 | |||
6370 | if (ibm->flags.experimental && !experimental) | ||
6371 | return 0; | ||
6372 | |||
6373 | dbg_printk(TPACPI_DBG_INIT, | ||
6374 | "probing for %s\n", ibm->name); | ||
6375 | |||
6376 | if (iibm->init) { | ||
6377 | ret = iibm->init(iibm); | ||
6378 | if (ret > 0) | ||
6379 | return 0; /* probe failed */ | ||
6380 | if (ret) | ||
6381 | return ret; | ||
6382 | |||
6383 | ibm->flags.init_called = 1; | ||
6384 | } | ||
6385 | |||
6386 | if (ibm->acpi) { | ||
6387 | if (ibm->acpi->hid) { | ||
6388 | ret = register_tpacpi_subdriver(ibm); | ||
6389 | if (ret) | ||
6390 | goto err_out; | ||
6391 | } | ||
6392 | |||
6393 | if (ibm->acpi->notify) { | ||
6394 | ret = setup_acpi_notify(ibm); | ||
6395 | if (ret == -ENODEV) { | ||
6396 | printk(TPACPI_NOTICE "disabling subdriver %s\n", | ||
6397 | ibm->name); | ||
6398 | ret = 0; | ||
6399 | goto err_out; | ||
6400 | } | ||
6401 | if (ret < 0) | ||
6402 | goto err_out; | ||
6403 | } | ||
6404 | } | ||
6405 | |||
6406 | dbg_printk(TPACPI_DBG_INIT, | ||
6407 | "%s installed\n", ibm->name); | ||
6408 | |||
6409 | if (ibm->read) { | ||
6410 | entry = create_proc_entry(ibm->name, | ||
6411 | S_IFREG | S_IRUGO | S_IWUSR, | ||
6412 | proc_dir); | ||
6413 | if (!entry) { | ||
6414 | printk(TPACPI_ERR "unable to create proc entry %s\n", | ||
6415 | ibm->name); | ||
6416 | ret = -ENODEV; | ||
6417 | goto err_out; | ||
6418 | } | ||
6419 | entry->owner = THIS_MODULE; | ||
6420 | entry->data = ibm; | ||
6421 | entry->read_proc = &dispatch_procfs_read; | ||
6422 | if (ibm->write) | ||
6423 | entry->write_proc = &dispatch_procfs_write; | ||
6424 | ibm->flags.proc_created = 1; | ||
6425 | } | ||
6426 | |||
6427 | list_add_tail(&ibm->all_drivers, &tpacpi_all_drivers); | ||
6428 | |||
6429 | return 0; | ||
6430 | |||
6431 | err_out: | ||
6432 | dbg_printk(TPACPI_DBG_INIT, | ||
6433 | "%s: at error exit path with result %d\n", | ||
6434 | ibm->name, ret); | ||
6435 | |||
6436 | ibm_exit(ibm); | ||
6437 | return (ret < 0)? ret : 0; | ||
6438 | } | ||
6439 | |||
6440 | /* Probing */ | ||
6441 | |||
6442 | /* returns 0 - probe ok, or < 0 - probe error. | ||
6443 | * Probe ok doesn't mean thinkpad found. | ||
6444 | * On error, kfree() cleanup on tp->* is not performed, caller must do it */ | ||
6445 | static int __must_check __init get_thinkpad_model_data( | ||
6446 | struct thinkpad_id_data *tp) | ||
6447 | { | ||
6448 | const struct dmi_device *dev = NULL; | ||
6449 | char ec_fw_string[18]; | ||
6450 | char const *s; | ||
6451 | |||
6452 | if (!tp) | ||
6453 | return -EINVAL; | ||
6454 | |||
6455 | memset(tp, 0, sizeof(*tp)); | ||
6456 | |||
6457 | if (dmi_name_in_vendors("IBM")) | ||
6458 | tp->vendor = PCI_VENDOR_ID_IBM; | ||
6459 | else if (dmi_name_in_vendors("LENOVO")) | ||
6460 | tp->vendor = PCI_VENDOR_ID_LENOVO; | ||
6461 | else | ||
6462 | return 0; | ||
6463 | |||
6464 | s = dmi_get_system_info(DMI_BIOS_VERSION); | ||
6465 | tp->bios_version_str = kstrdup(s, GFP_KERNEL); | ||
6466 | if (s && !tp->bios_version_str) | ||
6467 | return -ENOMEM; | ||
6468 | if (!tp->bios_version_str) | ||
6469 | return 0; | ||
6470 | tp->bios_model = tp->bios_version_str[0] | ||
6471 | | (tp->bios_version_str[1] << 8); | ||
6472 | |||
6473 | /* | ||
6474 | * ThinkPad T23 or newer, A31 or newer, R50e or newer, | ||
6475 | * X32 or newer, all Z series; Some models must have an | ||
6476 | * up-to-date BIOS or they will not be detected. | ||
6477 | * | ||
6478 | * See http://thinkwiki.org/wiki/List_of_DMI_IDs | ||
6479 | */ | ||
6480 | while ((dev = dmi_find_device(DMI_DEV_TYPE_OEM_STRING, NULL, dev))) { | ||
6481 | if (sscanf(dev->name, | ||
6482 | "IBM ThinkPad Embedded Controller -[%17c", | ||
6483 | ec_fw_string) == 1) { | ||
6484 | ec_fw_string[sizeof(ec_fw_string) - 1] = 0; | ||
6485 | ec_fw_string[strcspn(ec_fw_string, " ]")] = 0; | ||
6486 | |||
6487 | tp->ec_version_str = kstrdup(ec_fw_string, GFP_KERNEL); | ||
6488 | if (!tp->ec_version_str) | ||
6489 | return -ENOMEM; | ||
6490 | tp->ec_model = ec_fw_string[0] | ||
6491 | | (ec_fw_string[1] << 8); | ||
6492 | break; | ||
6493 | } | ||
6494 | } | ||
6495 | |||
6496 | s = dmi_get_system_info(DMI_PRODUCT_VERSION); | ||
6497 | if (s && !strnicmp(s, "ThinkPad", 8)) { | ||
6498 | tp->model_str = kstrdup(s, GFP_KERNEL); | ||
6499 | if (!tp->model_str) | ||
6500 | return -ENOMEM; | ||
6501 | } | ||
6502 | |||
6503 | s = dmi_get_system_info(DMI_PRODUCT_NAME); | ||
6504 | tp->nummodel_str = kstrdup(s, GFP_KERNEL); | ||
6505 | if (s && !tp->nummodel_str) | ||
6506 | return -ENOMEM; | ||
6507 | |||
6508 | return 0; | ||
6509 | } | ||
6510 | |||
6511 | static int __init probe_for_thinkpad(void) | ||
6512 | { | ||
6513 | int is_thinkpad; | ||
6514 | |||
6515 | if (acpi_disabled) | ||
6516 | return -ENODEV; | ||
6517 | |||
6518 | /* | ||
6519 | * Non-ancient models have better DMI tagging, but very old models | ||
6520 | * don't. | ||
6521 | */ | ||
6522 | is_thinkpad = (thinkpad_id.model_str != NULL); | ||
6523 | |||
6524 | /* ec is required because many other handles are relative to it */ | ||
6525 | TPACPI_ACPIHANDLE_INIT(ec); | ||
6526 | if (!ec_handle) { | ||
6527 | if (is_thinkpad) | ||
6528 | printk(TPACPI_ERR | ||
6529 | "Not yet supported ThinkPad detected!\n"); | ||
6530 | return -ENODEV; | ||
6531 | } | ||
6532 | |||
6533 | /* | ||
6534 | * Risks a regression on very old machines, but reduces potential | ||
6535 | * false positives a damn great deal | ||
6536 | */ | ||
6537 | if (!is_thinkpad) | ||
6538 | is_thinkpad = (thinkpad_id.vendor == PCI_VENDOR_ID_IBM); | ||
6539 | |||
6540 | if (!is_thinkpad && !force_load) | ||
6541 | return -ENODEV; | ||
6542 | |||
6543 | return 0; | ||
6544 | } | ||
6545 | |||
6546 | |||
6547 | /* Module init, exit, parameters */ | ||
6548 | |||
6549 | static struct ibm_init_struct ibms_init[] __initdata = { | ||
6550 | { | ||
6551 | .init = thinkpad_acpi_driver_init, | ||
6552 | .data = &thinkpad_acpi_driver_data, | ||
6553 | }, | ||
6554 | { | ||
6555 | .init = hotkey_init, | ||
6556 | .data = &hotkey_driver_data, | ||
6557 | }, | ||
6558 | { | ||
6559 | .init = bluetooth_init, | ||
6560 | .data = &bluetooth_driver_data, | ||
6561 | }, | ||
6562 | { | ||
6563 | .init = wan_init, | ||
6564 | .data = &wan_driver_data, | ||
6565 | }, | ||
6566 | #ifdef CONFIG_THINKPAD_ACPI_VIDEO | ||
6567 | { | ||
6568 | .init = video_init, | ||
6569 | .data = &video_driver_data, | ||
6570 | }, | ||
6571 | #endif | ||
6572 | { | ||
6573 | .init = light_init, | ||
6574 | .data = &light_driver_data, | ||
6575 | }, | ||
6576 | #ifdef CONFIG_THINKPAD_ACPI_DOCK | ||
6577 | { | ||
6578 | .init = dock_init, | ||
6579 | .data = &dock_driver_data[0], | ||
6580 | }, | ||
6581 | { | ||
6582 | .init = dock_init2, | ||
6583 | .data = &dock_driver_data[1], | ||
6584 | }, | ||
6585 | #endif | ||
6586 | #ifdef CONFIG_THINKPAD_ACPI_BAY | ||
6587 | { | ||
6588 | .init = bay_init, | ||
6589 | .data = &bay_driver_data, | ||
6590 | }, | ||
6591 | #endif | ||
6592 | { | ||
6593 | .init = cmos_init, | ||
6594 | .data = &cmos_driver_data, | ||
6595 | }, | ||
6596 | { | ||
6597 | .init = led_init, | ||
6598 | .data = &led_driver_data, | ||
6599 | }, | ||
6600 | { | ||
6601 | .init = beep_init, | ||
6602 | .data = &beep_driver_data, | ||
6603 | }, | ||
6604 | { | ||
6605 | .init = thermal_init, | ||
6606 | .data = &thermal_driver_data, | ||
6607 | }, | ||
6608 | { | ||
6609 | .data = &ecdump_driver_data, | ||
6610 | }, | ||
6611 | { | ||
6612 | .init = brightness_init, | ||
6613 | .data = &brightness_driver_data, | ||
6614 | }, | ||
6615 | { | ||
6616 | .data = &volume_driver_data, | ||
6617 | }, | ||
6618 | { | ||
6619 | .init = fan_init, | ||
6620 | .data = &fan_driver_data, | ||
6621 | }, | ||
6622 | }; | ||
6623 | |||
6624 | static int __init set_ibm_param(const char *val, struct kernel_param *kp) | ||
6625 | { | ||
6626 | unsigned int i; | ||
6627 | struct ibm_struct *ibm; | ||
6628 | |||
6629 | if (!kp || !kp->name || !val) | ||
6630 | return -EINVAL; | ||
6631 | |||
6632 | for (i = 0; i < ARRAY_SIZE(ibms_init); i++) { | ||
6633 | ibm = ibms_init[i].data; | ||
6634 | WARN_ON(ibm == NULL); | ||
6635 | |||
6636 | if (!ibm || !ibm->name) | ||
6637 | continue; | ||
6638 | |||
6639 | if (strcmp(ibm->name, kp->name) == 0 && ibm->write) { | ||
6640 | if (strlen(val) > sizeof(ibms_init[i].param) - 2) | ||
6641 | return -ENOSPC; | ||
6642 | strcpy(ibms_init[i].param, val); | ||
6643 | strcat(ibms_init[i].param, ","); | ||
6644 | return 0; | ||
6645 | } | ||
6646 | } | ||
6647 | |||
6648 | return -EINVAL; | ||
6649 | } | ||
6650 | |||
6651 | module_param(experimental, int, 0); | ||
6652 | MODULE_PARM_DESC(experimental, | ||
6653 | "Enables experimental features when non-zero"); | ||
6654 | |||
6655 | module_param_named(debug, dbg_level, uint, 0); | ||
6656 | MODULE_PARM_DESC(debug, "Sets debug level bit-mask"); | ||
6657 | |||
6658 | module_param(force_load, bool, 0); | ||
6659 | MODULE_PARM_DESC(force_load, | ||
6660 | "Attempts to load the driver even on a " | ||
6661 | "mis-identified ThinkPad when true"); | ||
6662 | |||
6663 | module_param_named(fan_control, fan_control_allowed, bool, 0); | ||
6664 | MODULE_PARM_DESC(fan_control, | ||
6665 | "Enables setting fan parameters features when true"); | ||
6666 | |||
6667 | module_param_named(brightness_mode, brightness_mode, int, 0); | ||
6668 | MODULE_PARM_DESC(brightness_mode, | ||
6669 | "Selects brightness control strategy: " | ||
6670 | "0=auto, 1=EC, 2=CMOS, 3=both"); | ||
6671 | |||
6672 | module_param(brightness_enable, uint, 0); | ||
6673 | MODULE_PARM_DESC(brightness_enable, | ||
6674 | "Enables backlight control when 1, disables when 0"); | ||
6675 | |||
6676 | module_param(hotkey_report_mode, uint, 0); | ||
6677 | MODULE_PARM_DESC(hotkey_report_mode, | ||
6678 | "used for backwards compatibility with userspace, " | ||
6679 | "see documentation"); | ||
6680 | |||
6681 | #define TPACPI_PARAM(feature) \ | ||
6682 | module_param_call(feature, set_ibm_param, NULL, NULL, 0); \ | ||
6683 | MODULE_PARM_DESC(feature, "Simulates thinkpad-acpi procfs command " \ | ||
6684 | "at module load, see documentation") | ||
6685 | |||
6686 | TPACPI_PARAM(hotkey); | ||
6687 | TPACPI_PARAM(bluetooth); | ||
6688 | TPACPI_PARAM(video); | ||
6689 | TPACPI_PARAM(light); | ||
6690 | #ifdef CONFIG_THINKPAD_ACPI_DOCK | ||
6691 | TPACPI_PARAM(dock); | ||
6692 | #endif | ||
6693 | #ifdef CONFIG_THINKPAD_ACPI_BAY | ||
6694 | TPACPI_PARAM(bay); | ||
6695 | #endif /* CONFIG_THINKPAD_ACPI_BAY */ | ||
6696 | TPACPI_PARAM(cmos); | ||
6697 | TPACPI_PARAM(led); | ||
6698 | TPACPI_PARAM(beep); | ||
6699 | TPACPI_PARAM(ecdump); | ||
6700 | TPACPI_PARAM(brightness); | ||
6701 | TPACPI_PARAM(volume); | ||
6702 | TPACPI_PARAM(fan); | ||
6703 | |||
6704 | static void thinkpad_acpi_module_exit(void) | ||
6705 | { | ||
6706 | struct ibm_struct *ibm, *itmp; | ||
6707 | |||
6708 | tpacpi_lifecycle = TPACPI_LIFE_EXITING; | ||
6709 | |||
6710 | list_for_each_entry_safe_reverse(ibm, itmp, | ||
6711 | &tpacpi_all_drivers, | ||
6712 | all_drivers) { | ||
6713 | ibm_exit(ibm); | ||
6714 | } | ||
6715 | |||
6716 | dbg_printk(TPACPI_DBG_INIT, "finished subdriver exit path...\n"); | ||
6717 | |||
6718 | if (tpacpi_inputdev) { | ||
6719 | if (tp_features.input_device_registered) | ||
6720 | input_unregister_device(tpacpi_inputdev); | ||
6721 | else | ||
6722 | input_free_device(tpacpi_inputdev); | ||
6723 | } | ||
6724 | |||
6725 | if (tpacpi_hwmon) | ||
6726 | hwmon_device_unregister(tpacpi_hwmon); | ||
6727 | |||
6728 | if (tp_features.sensors_pdev_attrs_registered) | ||
6729 | device_remove_file(&tpacpi_sensors_pdev->dev, | ||
6730 | &dev_attr_thinkpad_acpi_pdev_name); | ||
6731 | if (tpacpi_sensors_pdev) | ||
6732 | platform_device_unregister(tpacpi_sensors_pdev); | ||
6733 | if (tpacpi_pdev) | ||
6734 | platform_device_unregister(tpacpi_pdev); | ||
6735 | |||
6736 | if (tp_features.sensors_pdrv_attrs_registered) | ||
6737 | tpacpi_remove_driver_attributes(&tpacpi_hwmon_pdriver.driver); | ||
6738 | if (tp_features.platform_drv_attrs_registered) | ||
6739 | tpacpi_remove_driver_attributes(&tpacpi_pdriver.driver); | ||
6740 | |||
6741 | if (tp_features.sensors_pdrv_registered) | ||
6742 | platform_driver_unregister(&tpacpi_hwmon_pdriver); | ||
6743 | |||
6744 | if (tp_features.platform_drv_registered) | ||
6745 | platform_driver_unregister(&tpacpi_pdriver); | ||
6746 | |||
6747 | if (proc_dir) | ||
6748 | remove_proc_entry(TPACPI_PROC_DIR, acpi_root_dir); | ||
6749 | |||
6750 | if (tpacpi_wq) | ||
6751 | destroy_workqueue(tpacpi_wq); | ||
6752 | |||
6753 | kfree(thinkpad_id.bios_version_str); | ||
6754 | kfree(thinkpad_id.ec_version_str); | ||
6755 | kfree(thinkpad_id.model_str); | ||
6756 | } | ||
6757 | |||
6758 | |||
6759 | static int __init thinkpad_acpi_module_init(void) | ||
6760 | { | ||
6761 | int ret, i; | ||
6762 | |||
6763 | tpacpi_lifecycle = TPACPI_LIFE_INIT; | ||
6764 | |||
6765 | /* Parameter checking */ | ||
6766 | if (hotkey_report_mode > 2) | ||
6767 | return -EINVAL; | ||
6768 | |||
6769 | /* Driver-level probe */ | ||
6770 | |||
6771 | ret = get_thinkpad_model_data(&thinkpad_id); | ||
6772 | if (ret) { | ||
6773 | printk(TPACPI_ERR | ||
6774 | "unable to get DMI data: %d\n", ret); | ||
6775 | thinkpad_acpi_module_exit(); | ||
6776 | return ret; | ||
6777 | } | ||
6778 | ret = probe_for_thinkpad(); | ||
6779 | if (ret) { | ||
6780 | thinkpad_acpi_module_exit(); | ||
6781 | return ret; | ||
6782 | } | ||
6783 | |||
6784 | /* Driver initialization */ | ||
6785 | |||
6786 | TPACPI_ACPIHANDLE_INIT(ecrd); | ||
6787 | TPACPI_ACPIHANDLE_INIT(ecwr); | ||
6788 | |||
6789 | tpacpi_wq = create_singlethread_workqueue(TPACPI_WORKQUEUE_NAME); | ||
6790 | if (!tpacpi_wq) { | ||
6791 | thinkpad_acpi_module_exit(); | ||
6792 | return -ENOMEM; | ||
6793 | } | ||
6794 | |||
6795 | proc_dir = proc_mkdir(TPACPI_PROC_DIR, acpi_root_dir); | ||
6796 | if (!proc_dir) { | ||
6797 | printk(TPACPI_ERR | ||
6798 | "unable to create proc dir " TPACPI_PROC_DIR); | ||
6799 | thinkpad_acpi_module_exit(); | ||
6800 | return -ENODEV; | ||
6801 | } | ||
6802 | proc_dir->owner = THIS_MODULE; | ||
6803 | |||
6804 | ret = platform_driver_register(&tpacpi_pdriver); | ||
6805 | if (ret) { | ||
6806 | printk(TPACPI_ERR | ||
6807 | "unable to register main platform driver\n"); | ||
6808 | thinkpad_acpi_module_exit(); | ||
6809 | return ret; | ||
6810 | } | ||
6811 | tp_features.platform_drv_registered = 1; | ||
6812 | |||
6813 | ret = platform_driver_register(&tpacpi_hwmon_pdriver); | ||
6814 | if (ret) { | ||
6815 | printk(TPACPI_ERR | ||
6816 | "unable to register hwmon platform driver\n"); | ||
6817 | thinkpad_acpi_module_exit(); | ||
6818 | return ret; | ||
6819 | } | ||
6820 | tp_features.sensors_pdrv_registered = 1; | ||
6821 | |||
6822 | ret = tpacpi_create_driver_attributes(&tpacpi_pdriver.driver); | ||
6823 | if (!ret) { | ||
6824 | tp_features.platform_drv_attrs_registered = 1; | ||
6825 | ret = tpacpi_create_driver_attributes( | ||
6826 | &tpacpi_hwmon_pdriver.driver); | ||
6827 | } | ||
6828 | if (ret) { | ||
6829 | printk(TPACPI_ERR | ||
6830 | "unable to create sysfs driver attributes\n"); | ||
6831 | thinkpad_acpi_module_exit(); | ||
6832 | return ret; | ||
6833 | } | ||
6834 | tp_features.sensors_pdrv_attrs_registered = 1; | ||
6835 | |||
6836 | |||
6837 | /* Device initialization */ | ||
6838 | tpacpi_pdev = platform_device_register_simple(TPACPI_DRVR_NAME, -1, | ||
6839 | NULL, 0); | ||
6840 | if (IS_ERR(tpacpi_pdev)) { | ||
6841 | ret = PTR_ERR(tpacpi_pdev); | ||
6842 | tpacpi_pdev = NULL; | ||
6843 | printk(TPACPI_ERR "unable to register platform device\n"); | ||
6844 | thinkpad_acpi_module_exit(); | ||
6845 | return ret; | ||
6846 | } | ||
6847 | tpacpi_sensors_pdev = platform_device_register_simple( | ||
6848 | TPACPI_HWMON_DRVR_NAME, | ||
6849 | -1, NULL, 0); | ||
6850 | if (IS_ERR(tpacpi_sensors_pdev)) { | ||
6851 | ret = PTR_ERR(tpacpi_sensors_pdev); | ||
6852 | tpacpi_sensors_pdev = NULL; | ||
6853 | printk(TPACPI_ERR | ||
6854 | "unable to register hwmon platform device\n"); | ||
6855 | thinkpad_acpi_module_exit(); | ||
6856 | return ret; | ||
6857 | } | ||
6858 | ret = device_create_file(&tpacpi_sensors_pdev->dev, | ||
6859 | &dev_attr_thinkpad_acpi_pdev_name); | ||
6860 | if (ret) { | ||
6861 | printk(TPACPI_ERR | ||
6862 | "unable to create sysfs hwmon device attributes\n"); | ||
6863 | thinkpad_acpi_module_exit(); | ||
6864 | return ret; | ||
6865 | } | ||
6866 | tp_features.sensors_pdev_attrs_registered = 1; | ||
6867 | tpacpi_hwmon = hwmon_device_register(&tpacpi_sensors_pdev->dev); | ||
6868 | if (IS_ERR(tpacpi_hwmon)) { | ||
6869 | ret = PTR_ERR(tpacpi_hwmon); | ||
6870 | tpacpi_hwmon = NULL; | ||
6871 | printk(TPACPI_ERR "unable to register hwmon device\n"); | ||
6872 | thinkpad_acpi_module_exit(); | ||
6873 | return ret; | ||
6874 | } | ||
6875 | mutex_init(&tpacpi_inputdev_send_mutex); | ||
6876 | tpacpi_inputdev = input_allocate_device(); | ||
6877 | if (!tpacpi_inputdev) { | ||
6878 | printk(TPACPI_ERR "unable to allocate input device\n"); | ||
6879 | thinkpad_acpi_module_exit(); | ||
6880 | return -ENOMEM; | ||
6881 | } else { | ||
6882 | /* Prepare input device, but don't register */ | ||
6883 | tpacpi_inputdev->name = "ThinkPad Extra Buttons"; | ||
6884 | tpacpi_inputdev->phys = TPACPI_DRVR_NAME "/input0"; | ||
6885 | tpacpi_inputdev->id.bustype = BUS_HOST; | ||
6886 | tpacpi_inputdev->id.vendor = (thinkpad_id.vendor) ? | ||
6887 | thinkpad_id.vendor : | ||
6888 | PCI_VENDOR_ID_IBM; | ||
6889 | tpacpi_inputdev->id.product = TPACPI_HKEY_INPUT_PRODUCT; | ||
6890 | tpacpi_inputdev->id.version = TPACPI_HKEY_INPUT_VERSION; | ||
6891 | } | ||
6892 | for (i = 0; i < ARRAY_SIZE(ibms_init); i++) { | ||
6893 | ret = ibm_init(&ibms_init[i]); | ||
6894 | if (ret >= 0 && *ibms_init[i].param) | ||
6895 | ret = ibms_init[i].data->write(ibms_init[i].param); | ||
6896 | if (ret < 0) { | ||
6897 | thinkpad_acpi_module_exit(); | ||
6898 | return ret; | ||
6899 | } | ||
6900 | } | ||
6901 | ret = input_register_device(tpacpi_inputdev); | ||
6902 | if (ret < 0) { | ||
6903 | printk(TPACPI_ERR "unable to register input device\n"); | ||
6904 | thinkpad_acpi_module_exit(); | ||
6905 | return ret; | ||
6906 | } else { | ||
6907 | tp_features.input_device_registered = 1; | ||
6908 | } | ||
6909 | |||
6910 | tpacpi_lifecycle = TPACPI_LIFE_RUNNING; | ||
6911 | return 0; | ||
6912 | } | ||
6913 | |||
6914 | /* Please remove this in year 2009 */ | ||
6915 | MODULE_ALIAS("ibm_acpi"); | ||
6916 | |||
6917 | MODULE_ALIAS(TPACPI_DRVR_SHORTNAME); | ||
6918 | |||
6919 | /* | ||
6920 | * DMI matching for module autoloading | ||
6921 | * | ||
6922 | * See http://thinkwiki.org/wiki/List_of_DMI_IDs | ||
6923 | * See http://thinkwiki.org/wiki/BIOS_Upgrade_Downloads | ||
6924 | * | ||
6925 | * Only models listed in thinkwiki will be supported, so add yours | ||
6926 | * if it is not there yet. | ||
6927 | */ | ||
6928 | #define IBM_BIOS_MODULE_ALIAS(__type) \ | ||
6929 | MODULE_ALIAS("dmi:bvnIBM:bvr" __type "ET??WW") | ||
6930 | |||
6931 | /* Non-ancient thinkpads */ | ||
6932 | MODULE_ALIAS("dmi:bvnIBM:*:svnIBM:*:pvrThinkPad*:rvnIBM:*"); | ||
6933 | MODULE_ALIAS("dmi:bvnLENOVO:*:svnLENOVO:*:pvrThinkPad*:rvnLENOVO:*"); | ||
6934 | |||
6935 | /* Ancient thinkpad BIOSes have to be identified by | ||
6936 | * BIOS type or model number, and there are far less | ||
6937 | * BIOS types than model numbers... */ | ||
6938 | IBM_BIOS_MODULE_ALIAS("I[B,D,H,I,M,N,O,T,W,V,Y,Z]"); | ||
6939 | IBM_BIOS_MODULE_ALIAS("1[0,3,6,8,A-G,I,K,M-P,S,T]"); | ||
6940 | IBM_BIOS_MODULE_ALIAS("K[U,X-Z]"); | ||
6941 | |||
6942 | MODULE_AUTHOR("Borislav Deianov, Henrique de Moraes Holschuh"); | ||
6943 | MODULE_DESCRIPTION(TPACPI_DESC); | ||
6944 | MODULE_VERSION(TPACPI_VERSION); | ||
6945 | MODULE_LICENSE("GPL"); | ||
6946 | |||
6947 | module_init(thinkpad_acpi_module_init); | ||
6948 | module_exit(thinkpad_acpi_module_exit); | ||
diff --git a/drivers/platform/x86/toshiba_acpi.c b/drivers/platform/x86/toshiba_acpi.c new file mode 100644 index 000000000000..40e60fc2e596 --- /dev/null +++ b/drivers/platform/x86/toshiba_acpi.c | |||
@@ -0,0 +1,863 @@ | |||
1 | /* | ||
2 | * toshiba_acpi.c - Toshiba Laptop ACPI Extras | ||
3 | * | ||
4 | * | ||
5 | * Copyright (C) 2002-2004 John Belmonte | ||
6 | * Copyright (C) 2008 Philip Langdale | ||
7 | * | ||
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. | ||
12 | * | ||
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. | ||
17 | * | ||
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 | ||
21 | * | ||
22 | * | ||
23 | * The devolpment page for this driver is located at | ||
24 | * http://memebeam.org/toys/ToshibaAcpiDriver. | ||
25 | * | ||
26 | * Credits: | ||
27 | * Jonathan A. Buzzard - Toshiba HCI info, and critical tips on reverse | ||
28 | * engineering the Windows drivers | ||
29 | * Yasushi Nagato - changes for linux kernel 2.4 -> 2.5 | ||
30 | * Rob Miller - TV out and hotkeys help | ||
31 | * | ||
32 | * | ||
33 | * TODO | ||
34 | * | ||
35 | */ | ||
36 | |||
37 | #define TOSHIBA_ACPI_VERSION "0.19" | ||
38 | #define PROC_INTERFACE_VERSION 1 | ||
39 | |||
40 | #include <linux/kernel.h> | ||
41 | #include <linux/module.h> | ||
42 | #include <linux/init.h> | ||
43 | #include <linux/types.h> | ||
44 | #include <linux/proc_fs.h> | ||
45 | #include <linux/backlight.h> | ||
46 | #include <linux/platform_device.h> | ||
47 | #include <linux/rfkill.h> | ||
48 | #include <linux/input-polldev.h> | ||
49 | |||
50 | #include <asm/uaccess.h> | ||
51 | |||
52 | #include <acpi/acpi_drivers.h> | ||
53 | |||
54 | MODULE_AUTHOR("John Belmonte"); | ||
55 | MODULE_DESCRIPTION("Toshiba Laptop ACPI Extras Driver"); | ||
56 | MODULE_LICENSE("GPL"); | ||
57 | |||
58 | #define MY_LOGPREFIX "toshiba_acpi: " | ||
59 | #define MY_ERR KERN_ERR MY_LOGPREFIX | ||
60 | #define MY_NOTICE KERN_NOTICE MY_LOGPREFIX | ||
61 | #define MY_INFO KERN_INFO MY_LOGPREFIX | ||
62 | |||
63 | /* Toshiba ACPI method paths */ | ||
64 | #define METHOD_LCD_BRIGHTNESS "\\_SB_.PCI0.VGA_.LCD_._BCM" | ||
65 | #define METHOD_HCI_1 "\\_SB_.VALD.GHCI" | ||
66 | #define METHOD_HCI_2 "\\_SB_.VALZ.GHCI" | ||
67 | #define METHOD_VIDEO_OUT "\\_SB_.VALX.DSSX" | ||
68 | |||
69 | /* Toshiba HCI interface definitions | ||
70 | * | ||
71 | * HCI is Toshiba's "Hardware Control Interface" which is supposed to | ||
72 | * be uniform across all their models. Ideally we would just call | ||
73 | * dedicated ACPI methods instead of using this primitive interface. | ||
74 | * However the ACPI methods seem to be incomplete in some areas (for | ||
75 | * example they allow setting, but not reading, the LCD brightness value), | ||
76 | * so this is still useful. | ||
77 | */ | ||
78 | |||
79 | #define HCI_WORDS 6 | ||
80 | |||
81 | /* operations */ | ||
82 | #define HCI_SET 0xff00 | ||
83 | #define HCI_GET 0xfe00 | ||
84 | |||
85 | /* return codes */ | ||
86 | #define HCI_SUCCESS 0x0000 | ||
87 | #define HCI_FAILURE 0x1000 | ||
88 | #define HCI_NOT_SUPPORTED 0x8000 | ||
89 | #define HCI_EMPTY 0x8c00 | ||
90 | |||
91 | /* registers */ | ||
92 | #define HCI_FAN 0x0004 | ||
93 | #define HCI_SYSTEM_EVENT 0x0016 | ||
94 | #define HCI_VIDEO_OUT 0x001c | ||
95 | #define HCI_HOTKEY_EVENT 0x001e | ||
96 | #define HCI_LCD_BRIGHTNESS 0x002a | ||
97 | #define HCI_WIRELESS 0x0056 | ||
98 | |||
99 | /* field definitions */ | ||
100 | #define HCI_LCD_BRIGHTNESS_BITS 3 | ||
101 | #define HCI_LCD_BRIGHTNESS_SHIFT (16-HCI_LCD_BRIGHTNESS_BITS) | ||
102 | #define HCI_LCD_BRIGHTNESS_LEVELS (1 << HCI_LCD_BRIGHTNESS_BITS) | ||
103 | #define HCI_VIDEO_OUT_LCD 0x1 | ||
104 | #define HCI_VIDEO_OUT_CRT 0x2 | ||
105 | #define HCI_VIDEO_OUT_TV 0x4 | ||
106 | #define HCI_WIRELESS_KILL_SWITCH 0x01 | ||
107 | #define HCI_WIRELESS_BT_PRESENT 0x0f | ||
108 | #define HCI_WIRELESS_BT_ATTACH 0x40 | ||
109 | #define HCI_WIRELESS_BT_POWER 0x80 | ||
110 | |||
111 | static const struct acpi_device_id toshiba_device_ids[] = { | ||
112 | {"TOS6200", 0}, | ||
113 | {"TOS6208", 0}, | ||
114 | {"TOS1900", 0}, | ||
115 | {"", 0}, | ||
116 | }; | ||
117 | MODULE_DEVICE_TABLE(acpi, toshiba_device_ids); | ||
118 | |||
119 | /* utility | ||
120 | */ | ||
121 | |||
122 | static __inline__ void _set_bit(u32 * word, u32 mask, int value) | ||
123 | { | ||
124 | *word = (*word & ~mask) | (mask * value); | ||
125 | } | ||
126 | |||
127 | /* acpi interface wrappers | ||
128 | */ | ||
129 | |||
130 | static int is_valid_acpi_path(const char *methodName) | ||
131 | { | ||
132 | acpi_handle handle; | ||
133 | acpi_status status; | ||
134 | |||
135 | status = acpi_get_handle(NULL, (char *)methodName, &handle); | ||
136 | return !ACPI_FAILURE(status); | ||
137 | } | ||
138 | |||
139 | static int write_acpi_int(const char *methodName, int val) | ||
140 | { | ||
141 | struct acpi_object_list params; | ||
142 | union acpi_object in_objs[1]; | ||
143 | acpi_status status; | ||
144 | |||
145 | params.count = ARRAY_SIZE(in_objs); | ||
146 | params.pointer = in_objs; | ||
147 | in_objs[0].type = ACPI_TYPE_INTEGER; | ||
148 | in_objs[0].integer.value = val; | ||
149 | |||
150 | status = acpi_evaluate_object(NULL, (char *)methodName, ¶ms, NULL); | ||
151 | return (status == AE_OK); | ||
152 | } | ||
153 | |||
154 | #if 0 | ||
155 | static int read_acpi_int(const char *methodName, int *pVal) | ||
156 | { | ||
157 | struct acpi_buffer results; | ||
158 | union acpi_object out_objs[1]; | ||
159 | acpi_status status; | ||
160 | |||
161 | results.length = sizeof(out_objs); | ||
162 | results.pointer = out_objs; | ||
163 | |||
164 | status = acpi_evaluate_object(0, (char *)methodName, 0, &results); | ||
165 | *pVal = out_objs[0].integer.value; | ||
166 | |||
167 | return (status == AE_OK) && (out_objs[0].type == ACPI_TYPE_INTEGER); | ||
168 | } | ||
169 | #endif | ||
170 | |||
171 | static const char *method_hci /*= 0*/ ; | ||
172 | |||
173 | /* Perform a raw HCI call. Here we don't care about input or output buffer | ||
174 | * format. | ||
175 | */ | ||
176 | static acpi_status hci_raw(const u32 in[HCI_WORDS], u32 out[HCI_WORDS]) | ||
177 | { | ||
178 | struct acpi_object_list params; | ||
179 | union acpi_object in_objs[HCI_WORDS]; | ||
180 | struct acpi_buffer results; | ||
181 | union acpi_object out_objs[HCI_WORDS + 1]; | ||
182 | acpi_status status; | ||
183 | int i; | ||
184 | |||
185 | params.count = HCI_WORDS; | ||
186 | params.pointer = in_objs; | ||
187 | for (i = 0; i < HCI_WORDS; ++i) { | ||
188 | in_objs[i].type = ACPI_TYPE_INTEGER; | ||
189 | in_objs[i].integer.value = in[i]; | ||
190 | } | ||
191 | |||
192 | results.length = sizeof(out_objs); | ||
193 | results.pointer = out_objs; | ||
194 | |||
195 | status = acpi_evaluate_object(NULL, (char *)method_hci, ¶ms, | ||
196 | &results); | ||
197 | if ((status == AE_OK) && (out_objs->package.count <= HCI_WORDS)) { | ||
198 | for (i = 0; i < out_objs->package.count; ++i) { | ||
199 | out[i] = out_objs->package.elements[i].integer.value; | ||
200 | } | ||
201 | } | ||
202 | |||
203 | return status; | ||
204 | } | ||
205 | |||
206 | /* common hci tasks (get or set one or two value) | ||
207 | * | ||
208 | * In addition to the ACPI status, the HCI system returns a result which | ||
209 | * may be useful (such as "not supported"). | ||
210 | */ | ||
211 | |||
212 | static acpi_status hci_write1(u32 reg, u32 in1, u32 * result) | ||
213 | { | ||
214 | u32 in[HCI_WORDS] = { HCI_SET, reg, in1, 0, 0, 0 }; | ||
215 | u32 out[HCI_WORDS]; | ||
216 | acpi_status status = hci_raw(in, out); | ||
217 | *result = (status == AE_OK) ? out[0] : HCI_FAILURE; | ||
218 | return status; | ||
219 | } | ||
220 | |||
221 | static acpi_status hci_read1(u32 reg, u32 * out1, u32 * result) | ||
222 | { | ||
223 | u32 in[HCI_WORDS] = { HCI_GET, reg, 0, 0, 0, 0 }; | ||
224 | u32 out[HCI_WORDS]; | ||
225 | acpi_status status = hci_raw(in, out); | ||
226 | *out1 = out[2]; | ||
227 | *result = (status == AE_OK) ? out[0] : HCI_FAILURE; | ||
228 | return status; | ||
229 | } | ||
230 | |||
231 | static acpi_status hci_write2(u32 reg, u32 in1, u32 in2, u32 *result) | ||
232 | { | ||
233 | u32 in[HCI_WORDS] = { HCI_SET, reg, in1, in2, 0, 0 }; | ||
234 | u32 out[HCI_WORDS]; | ||
235 | acpi_status status = hci_raw(in, out); | ||
236 | *result = (status == AE_OK) ? out[0] : HCI_FAILURE; | ||
237 | return status; | ||
238 | } | ||
239 | |||
240 | static acpi_status hci_read2(u32 reg, u32 *out1, u32 *out2, u32 *result) | ||
241 | { | ||
242 | u32 in[HCI_WORDS] = { HCI_GET, reg, *out1, *out2, 0, 0 }; | ||
243 | u32 out[HCI_WORDS]; | ||
244 | acpi_status status = hci_raw(in, out); | ||
245 | *out1 = out[2]; | ||
246 | *out2 = out[3]; | ||
247 | *result = (status == AE_OK) ? out[0] : HCI_FAILURE; | ||
248 | return status; | ||
249 | } | ||
250 | |||
251 | struct toshiba_acpi_dev { | ||
252 | struct platform_device *p_dev; | ||
253 | struct rfkill *rfk_dev; | ||
254 | struct input_polled_dev *poll_dev; | ||
255 | |||
256 | const char *bt_name; | ||
257 | const char *rfk_name; | ||
258 | |||
259 | bool last_rfk_state; | ||
260 | |||
261 | struct mutex mutex; | ||
262 | }; | ||
263 | |||
264 | static struct toshiba_acpi_dev toshiba_acpi = { | ||
265 | .bt_name = "Toshiba Bluetooth", | ||
266 | .rfk_name = "Toshiba RFKill Switch", | ||
267 | .last_rfk_state = false, | ||
268 | }; | ||
269 | |||
270 | /* Bluetooth rfkill handlers */ | ||
271 | |||
272 | static u32 hci_get_bt_present(bool *present) | ||
273 | { | ||
274 | u32 hci_result; | ||
275 | u32 value, value2; | ||
276 | |||
277 | value = 0; | ||
278 | value2 = 0; | ||
279 | hci_read2(HCI_WIRELESS, &value, &value2, &hci_result); | ||
280 | if (hci_result == HCI_SUCCESS) | ||
281 | *present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false; | ||
282 | |||
283 | return hci_result; | ||
284 | } | ||
285 | |||
286 | static u32 hci_get_bt_on(bool *on) | ||
287 | { | ||
288 | u32 hci_result; | ||
289 | u32 value, value2; | ||
290 | |||
291 | value = 0; | ||
292 | value2 = 0x0001; | ||
293 | hci_read2(HCI_WIRELESS, &value, &value2, &hci_result); | ||
294 | if (hci_result == HCI_SUCCESS) | ||
295 | *on = (value & HCI_WIRELESS_BT_POWER) && | ||
296 | (value & HCI_WIRELESS_BT_ATTACH); | ||
297 | |||
298 | return hci_result; | ||
299 | } | ||
300 | |||
301 | static u32 hci_get_radio_state(bool *radio_state) | ||
302 | { | ||
303 | u32 hci_result; | ||
304 | u32 value, value2; | ||
305 | |||
306 | value = 0; | ||
307 | value2 = 0x0001; | ||
308 | hci_read2(HCI_WIRELESS, &value, &value2, &hci_result); | ||
309 | |||
310 | *radio_state = value & HCI_WIRELESS_KILL_SWITCH; | ||
311 | return hci_result; | ||
312 | } | ||
313 | |||
314 | static int bt_rfkill_toggle_radio(void *data, enum rfkill_state state) | ||
315 | { | ||
316 | u32 result1, result2; | ||
317 | u32 value; | ||
318 | bool radio_state; | ||
319 | struct toshiba_acpi_dev *dev = data; | ||
320 | |||
321 | value = (state == RFKILL_STATE_UNBLOCKED); | ||
322 | |||
323 | if (hci_get_radio_state(&radio_state) != HCI_SUCCESS) | ||
324 | return -EFAULT; | ||
325 | |||
326 | switch (state) { | ||
327 | case RFKILL_STATE_UNBLOCKED: | ||
328 | if (!radio_state) | ||
329 | return -EPERM; | ||
330 | break; | ||
331 | case RFKILL_STATE_SOFT_BLOCKED: | ||
332 | break; | ||
333 | default: | ||
334 | return -EINVAL; | ||
335 | } | ||
336 | |||
337 | mutex_lock(&dev->mutex); | ||
338 | hci_write2(HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1); | ||
339 | hci_write2(HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2); | ||
340 | mutex_unlock(&dev->mutex); | ||
341 | |||
342 | if (result1 != HCI_SUCCESS || result2 != HCI_SUCCESS) | ||
343 | return -EFAULT; | ||
344 | |||
345 | return 0; | ||
346 | } | ||
347 | |||
348 | static void bt_poll_rfkill(struct input_polled_dev *poll_dev) | ||
349 | { | ||
350 | bool state_changed; | ||
351 | bool new_rfk_state; | ||
352 | bool value; | ||
353 | u32 hci_result; | ||
354 | struct toshiba_acpi_dev *dev = poll_dev->private; | ||
355 | |||
356 | hci_result = hci_get_radio_state(&value); | ||
357 | if (hci_result != HCI_SUCCESS) | ||
358 | return; /* Can't do anything useful */ | ||
359 | |||
360 | new_rfk_state = value; | ||
361 | |||
362 | mutex_lock(&dev->mutex); | ||
363 | state_changed = new_rfk_state != dev->last_rfk_state; | ||
364 | dev->last_rfk_state = new_rfk_state; | ||
365 | mutex_unlock(&dev->mutex); | ||
366 | |||
367 | if (unlikely(state_changed)) { | ||
368 | rfkill_force_state(dev->rfk_dev, | ||
369 | new_rfk_state ? | ||
370 | RFKILL_STATE_SOFT_BLOCKED : | ||
371 | RFKILL_STATE_HARD_BLOCKED); | ||
372 | input_report_switch(poll_dev->input, SW_RFKILL_ALL, | ||
373 | new_rfk_state); | ||
374 | input_sync(poll_dev->input); | ||
375 | } | ||
376 | } | ||
377 | |||
378 | static struct proc_dir_entry *toshiba_proc_dir /*= 0*/ ; | ||
379 | static struct backlight_device *toshiba_backlight_device; | ||
380 | static int force_fan; | ||
381 | static int last_key_event; | ||
382 | static int key_event_valid; | ||
383 | |||
384 | typedef struct _ProcItem { | ||
385 | const char *name; | ||
386 | char *(*read_func) (char *); | ||
387 | unsigned long (*write_func) (const char *, unsigned long); | ||
388 | } ProcItem; | ||
389 | |||
390 | /* proc file handlers | ||
391 | */ | ||
392 | |||
393 | static int | ||
394 | dispatch_read(char *page, char **start, off_t off, int count, int *eof, | ||
395 | ProcItem * item) | ||
396 | { | ||
397 | char *p = page; | ||
398 | int len; | ||
399 | |||
400 | if (off == 0) | ||
401 | p = item->read_func(p); | ||
402 | |||
403 | /* ISSUE: I don't understand this code */ | ||
404 | len = (p - page); | ||
405 | if (len <= off + count) | ||
406 | *eof = 1; | ||
407 | *start = page + off; | ||
408 | len -= off; | ||
409 | if (len > count) | ||
410 | len = count; | ||
411 | if (len < 0) | ||
412 | len = 0; | ||
413 | return len; | ||
414 | } | ||
415 | |||
416 | static int | ||
417 | dispatch_write(struct file *file, const char __user * buffer, | ||
418 | unsigned long count, ProcItem * item) | ||
419 | { | ||
420 | int result; | ||
421 | char *tmp_buffer; | ||
422 | |||
423 | /* Arg buffer points to userspace memory, which can't be accessed | ||
424 | * directly. Since we're making a copy, zero-terminate the | ||
425 | * destination so that sscanf can be used on it safely. | ||
426 | */ | ||
427 | tmp_buffer = kmalloc(count + 1, GFP_KERNEL); | ||
428 | if (!tmp_buffer) | ||
429 | return -ENOMEM; | ||
430 | |||
431 | if (copy_from_user(tmp_buffer, buffer, count)) { | ||
432 | result = -EFAULT; | ||
433 | } else { | ||
434 | tmp_buffer[count] = 0; | ||
435 | result = item->write_func(tmp_buffer, count); | ||
436 | } | ||
437 | kfree(tmp_buffer); | ||
438 | return result; | ||
439 | } | ||
440 | |||
441 | static int get_lcd(struct backlight_device *bd) | ||
442 | { | ||
443 | u32 hci_result; | ||
444 | u32 value; | ||
445 | |||
446 | hci_read1(HCI_LCD_BRIGHTNESS, &value, &hci_result); | ||
447 | if (hci_result == HCI_SUCCESS) { | ||
448 | return (value >> HCI_LCD_BRIGHTNESS_SHIFT); | ||
449 | } else | ||
450 | return -EFAULT; | ||
451 | } | ||
452 | |||
453 | static char *read_lcd(char *p) | ||
454 | { | ||
455 | int value = get_lcd(NULL); | ||
456 | |||
457 | if (value >= 0) { | ||
458 | p += sprintf(p, "brightness: %d\n", value); | ||
459 | p += sprintf(p, "brightness_levels: %d\n", | ||
460 | HCI_LCD_BRIGHTNESS_LEVELS); | ||
461 | } else { | ||
462 | printk(MY_ERR "Error reading LCD brightness\n"); | ||
463 | } | ||
464 | |||
465 | return p; | ||
466 | } | ||
467 | |||
468 | static int set_lcd(int value) | ||
469 | { | ||
470 | u32 hci_result; | ||
471 | |||
472 | value = value << HCI_LCD_BRIGHTNESS_SHIFT; | ||
473 | hci_write1(HCI_LCD_BRIGHTNESS, value, &hci_result); | ||
474 | if (hci_result != HCI_SUCCESS) | ||
475 | return -EFAULT; | ||
476 | |||
477 | return 0; | ||
478 | } | ||
479 | |||
480 | static int set_lcd_status(struct backlight_device *bd) | ||
481 | { | ||
482 | return set_lcd(bd->props.brightness); | ||
483 | } | ||
484 | |||
485 | static unsigned long write_lcd(const char *buffer, unsigned long count) | ||
486 | { | ||
487 | int value; | ||
488 | int ret; | ||
489 | |||
490 | if (sscanf(buffer, " brightness : %i", &value) == 1 && | ||
491 | value >= 0 && value < HCI_LCD_BRIGHTNESS_LEVELS) { | ||
492 | ret = set_lcd(value); | ||
493 | if (ret == 0) | ||
494 | ret = count; | ||
495 | } else { | ||
496 | ret = -EINVAL; | ||
497 | } | ||
498 | return ret; | ||
499 | } | ||
500 | |||
501 | static char *read_video(char *p) | ||
502 | { | ||
503 | u32 hci_result; | ||
504 | u32 value; | ||
505 | |||
506 | hci_read1(HCI_VIDEO_OUT, &value, &hci_result); | ||
507 | if (hci_result == HCI_SUCCESS) { | ||
508 | int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0; | ||
509 | int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0; | ||
510 | int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0; | ||
511 | p += sprintf(p, "lcd_out: %d\n", is_lcd); | ||
512 | p += sprintf(p, "crt_out: %d\n", is_crt); | ||
513 | p += sprintf(p, "tv_out: %d\n", is_tv); | ||
514 | } else { | ||
515 | printk(MY_ERR "Error reading video out status\n"); | ||
516 | } | ||
517 | |||
518 | return p; | ||
519 | } | ||
520 | |||
521 | static unsigned long write_video(const char *buffer, unsigned long count) | ||
522 | { | ||
523 | int value; | ||
524 | int remain = count; | ||
525 | int lcd_out = -1; | ||
526 | int crt_out = -1; | ||
527 | int tv_out = -1; | ||
528 | u32 hci_result; | ||
529 | u32 video_out; | ||
530 | |||
531 | /* scan expression. Multiple expressions may be delimited with ; | ||
532 | * | ||
533 | * NOTE: to keep scanning simple, invalid fields are ignored | ||
534 | */ | ||
535 | while (remain) { | ||
536 | if (sscanf(buffer, " lcd_out : %i", &value) == 1) | ||
537 | lcd_out = value & 1; | ||
538 | else if (sscanf(buffer, " crt_out : %i", &value) == 1) | ||
539 | crt_out = value & 1; | ||
540 | else if (sscanf(buffer, " tv_out : %i", &value) == 1) | ||
541 | tv_out = value & 1; | ||
542 | /* advance to one character past the next ; */ | ||
543 | do { | ||
544 | ++buffer; | ||
545 | --remain; | ||
546 | } | ||
547 | while (remain && *(buffer - 1) != ';'); | ||
548 | } | ||
549 | |||
550 | hci_read1(HCI_VIDEO_OUT, &video_out, &hci_result); | ||
551 | if (hci_result == HCI_SUCCESS) { | ||
552 | unsigned int new_video_out = video_out; | ||
553 | if (lcd_out != -1) | ||
554 | _set_bit(&new_video_out, HCI_VIDEO_OUT_LCD, lcd_out); | ||
555 | if (crt_out != -1) | ||
556 | _set_bit(&new_video_out, HCI_VIDEO_OUT_CRT, crt_out); | ||
557 | if (tv_out != -1) | ||
558 | _set_bit(&new_video_out, HCI_VIDEO_OUT_TV, tv_out); | ||
559 | /* To avoid unnecessary video disruption, only write the new | ||
560 | * video setting if something changed. */ | ||
561 | if (new_video_out != video_out) | ||
562 | write_acpi_int(METHOD_VIDEO_OUT, new_video_out); | ||
563 | } else { | ||
564 | return -EFAULT; | ||
565 | } | ||
566 | |||
567 | return count; | ||
568 | } | ||
569 | |||
570 | static char *read_fan(char *p) | ||
571 | { | ||
572 | u32 hci_result; | ||
573 | u32 value; | ||
574 | |||
575 | hci_read1(HCI_FAN, &value, &hci_result); | ||
576 | if (hci_result == HCI_SUCCESS) { | ||
577 | p += sprintf(p, "running: %d\n", (value > 0)); | ||
578 | p += sprintf(p, "force_on: %d\n", force_fan); | ||
579 | } else { | ||
580 | printk(MY_ERR "Error reading fan status\n"); | ||
581 | } | ||
582 | |||
583 | return p; | ||
584 | } | ||
585 | |||
586 | static unsigned long write_fan(const char *buffer, unsigned long count) | ||
587 | { | ||
588 | int value; | ||
589 | u32 hci_result; | ||
590 | |||
591 | if (sscanf(buffer, " force_on : %i", &value) == 1 && | ||
592 | value >= 0 && value <= 1) { | ||
593 | hci_write1(HCI_FAN, value, &hci_result); | ||
594 | if (hci_result != HCI_SUCCESS) | ||
595 | return -EFAULT; | ||
596 | else | ||
597 | force_fan = value; | ||
598 | } else { | ||
599 | return -EINVAL; | ||
600 | } | ||
601 | |||
602 | return count; | ||
603 | } | ||
604 | |||
605 | static char *read_keys(char *p) | ||
606 | { | ||
607 | u32 hci_result; | ||
608 | u32 value; | ||
609 | |||
610 | if (!key_event_valid) { | ||
611 | hci_read1(HCI_SYSTEM_EVENT, &value, &hci_result); | ||
612 | if (hci_result == HCI_SUCCESS) { | ||
613 | key_event_valid = 1; | ||
614 | last_key_event = value; | ||
615 | } else if (hci_result == HCI_EMPTY) { | ||
616 | /* better luck next time */ | ||
617 | } else if (hci_result == HCI_NOT_SUPPORTED) { | ||
618 | /* This is a workaround for an unresolved issue on | ||
619 | * some machines where system events sporadically | ||
620 | * become disabled. */ | ||
621 | hci_write1(HCI_SYSTEM_EVENT, 1, &hci_result); | ||
622 | printk(MY_NOTICE "Re-enabled hotkeys\n"); | ||
623 | } else { | ||
624 | printk(MY_ERR "Error reading hotkey status\n"); | ||
625 | goto end; | ||
626 | } | ||
627 | } | ||
628 | |||
629 | p += sprintf(p, "hotkey_ready: %d\n", key_event_valid); | ||
630 | p += sprintf(p, "hotkey: 0x%04x\n", last_key_event); | ||
631 | |||
632 | end: | ||
633 | return p; | ||
634 | } | ||
635 | |||
636 | static unsigned long write_keys(const char *buffer, unsigned long count) | ||
637 | { | ||
638 | int value; | ||
639 | |||
640 | if (sscanf(buffer, " hotkey_ready : %i", &value) == 1 && value == 0) { | ||
641 | key_event_valid = 0; | ||
642 | } else { | ||
643 | return -EINVAL; | ||
644 | } | ||
645 | |||
646 | return count; | ||
647 | } | ||
648 | |||
649 | static char *read_version(char *p) | ||
650 | { | ||
651 | p += sprintf(p, "driver: %s\n", TOSHIBA_ACPI_VERSION); | ||
652 | p += sprintf(p, "proc_interface: %d\n", | ||
653 | PROC_INTERFACE_VERSION); | ||
654 | return p; | ||
655 | } | ||
656 | |||
657 | /* proc and module init | ||
658 | */ | ||
659 | |||
660 | #define PROC_TOSHIBA "toshiba" | ||
661 | |||
662 | static ProcItem proc_items[] = { | ||
663 | {"lcd", read_lcd, write_lcd}, | ||
664 | {"video", read_video, write_video}, | ||
665 | {"fan", read_fan, write_fan}, | ||
666 | {"keys", read_keys, write_keys}, | ||
667 | {"version", read_version, NULL}, | ||
668 | {NULL} | ||
669 | }; | ||
670 | |||
671 | static acpi_status __init add_device(void) | ||
672 | { | ||
673 | struct proc_dir_entry *proc; | ||
674 | ProcItem *item; | ||
675 | |||
676 | for (item = proc_items; item->name; ++item) { | ||
677 | proc = create_proc_read_entry(item->name, | ||
678 | S_IFREG | S_IRUGO | S_IWUSR, | ||
679 | toshiba_proc_dir, | ||
680 | (read_proc_t *) dispatch_read, | ||
681 | item); | ||
682 | if (proc) | ||
683 | proc->owner = THIS_MODULE; | ||
684 | if (proc && item->write_func) | ||
685 | proc->write_proc = (write_proc_t *) dispatch_write; | ||
686 | } | ||
687 | |||
688 | return AE_OK; | ||
689 | } | ||
690 | |||
691 | static acpi_status remove_device(void) | ||
692 | { | ||
693 | ProcItem *item; | ||
694 | |||
695 | for (item = proc_items; item->name; ++item) | ||
696 | remove_proc_entry(item->name, toshiba_proc_dir); | ||
697 | return AE_OK; | ||
698 | } | ||
699 | |||
700 | static struct backlight_ops toshiba_backlight_data = { | ||
701 | .get_brightness = get_lcd, | ||
702 | .update_status = set_lcd_status, | ||
703 | }; | ||
704 | |||
705 | static void toshiba_acpi_exit(void) | ||
706 | { | ||
707 | if (toshiba_acpi.poll_dev) { | ||
708 | input_unregister_polled_device(toshiba_acpi.poll_dev); | ||
709 | input_free_polled_device(toshiba_acpi.poll_dev); | ||
710 | } | ||
711 | |||
712 | if (toshiba_acpi.rfk_dev) | ||
713 | rfkill_unregister(toshiba_acpi.rfk_dev); | ||
714 | |||
715 | if (toshiba_backlight_device) | ||
716 | backlight_device_unregister(toshiba_backlight_device); | ||
717 | |||
718 | remove_device(); | ||
719 | |||
720 | if (toshiba_proc_dir) | ||
721 | remove_proc_entry(PROC_TOSHIBA, acpi_root_dir); | ||
722 | |||
723 | platform_device_unregister(toshiba_acpi.p_dev); | ||
724 | |||
725 | return; | ||
726 | } | ||
727 | |||
728 | static int __init toshiba_acpi_init(void) | ||
729 | { | ||
730 | acpi_status status = AE_OK; | ||
731 | u32 hci_result; | ||
732 | bool bt_present; | ||
733 | bool bt_on; | ||
734 | bool radio_on; | ||
735 | int ret = 0; | ||
736 | |||
737 | if (acpi_disabled) | ||
738 | return -ENODEV; | ||
739 | |||
740 | /* simple device detection: look for HCI method */ | ||
741 | if (is_valid_acpi_path(METHOD_HCI_1)) | ||
742 | method_hci = METHOD_HCI_1; | ||
743 | else if (is_valid_acpi_path(METHOD_HCI_2)) | ||
744 | method_hci = METHOD_HCI_2; | ||
745 | else | ||
746 | return -ENODEV; | ||
747 | |||
748 | printk(MY_INFO "Toshiba Laptop ACPI Extras version %s\n", | ||
749 | TOSHIBA_ACPI_VERSION); | ||
750 | printk(MY_INFO " HCI method: %s\n", method_hci); | ||
751 | |||
752 | mutex_init(&toshiba_acpi.mutex); | ||
753 | |||
754 | toshiba_acpi.p_dev = platform_device_register_simple("toshiba_acpi", | ||
755 | -1, NULL, 0); | ||
756 | if (IS_ERR(toshiba_acpi.p_dev)) { | ||
757 | ret = PTR_ERR(toshiba_acpi.p_dev); | ||
758 | printk(MY_ERR "unable to register platform device\n"); | ||
759 | toshiba_acpi.p_dev = NULL; | ||
760 | toshiba_acpi_exit(); | ||
761 | return ret; | ||
762 | } | ||
763 | |||
764 | force_fan = 0; | ||
765 | key_event_valid = 0; | ||
766 | |||
767 | /* enable event fifo */ | ||
768 | hci_write1(HCI_SYSTEM_EVENT, 1, &hci_result); | ||
769 | |||
770 | toshiba_proc_dir = proc_mkdir(PROC_TOSHIBA, acpi_root_dir); | ||
771 | if (!toshiba_proc_dir) { | ||
772 | toshiba_acpi_exit(); | ||
773 | return -ENODEV; | ||
774 | } else { | ||
775 | toshiba_proc_dir->owner = THIS_MODULE; | ||
776 | status = add_device(); | ||
777 | if (ACPI_FAILURE(status)) { | ||
778 | toshiba_acpi_exit(); | ||
779 | return -ENODEV; | ||
780 | } | ||
781 | } | ||
782 | |||
783 | toshiba_backlight_device = backlight_device_register("toshiba", | ||
784 | &toshiba_acpi.p_dev->dev, | ||
785 | NULL, | ||
786 | &toshiba_backlight_data); | ||
787 | if (IS_ERR(toshiba_backlight_device)) { | ||
788 | ret = PTR_ERR(toshiba_backlight_device); | ||
789 | |||
790 | printk(KERN_ERR "Could not register toshiba backlight device\n"); | ||
791 | toshiba_backlight_device = NULL; | ||
792 | toshiba_acpi_exit(); | ||
793 | return ret; | ||
794 | } | ||
795 | toshiba_backlight_device->props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1; | ||
796 | |||
797 | /* Register rfkill switch for Bluetooth */ | ||
798 | if (hci_get_bt_present(&bt_present) == HCI_SUCCESS && bt_present) { | ||
799 | toshiba_acpi.rfk_dev = rfkill_allocate(&toshiba_acpi.p_dev->dev, | ||
800 | RFKILL_TYPE_BLUETOOTH); | ||
801 | if (!toshiba_acpi.rfk_dev) { | ||
802 | printk(MY_ERR "unable to allocate rfkill device\n"); | ||
803 | toshiba_acpi_exit(); | ||
804 | return -ENOMEM; | ||
805 | } | ||
806 | |||
807 | toshiba_acpi.rfk_dev->name = toshiba_acpi.bt_name; | ||
808 | toshiba_acpi.rfk_dev->toggle_radio = bt_rfkill_toggle_radio; | ||
809 | toshiba_acpi.rfk_dev->user_claim_unsupported = 1; | ||
810 | toshiba_acpi.rfk_dev->data = &toshiba_acpi; | ||
811 | |||
812 | if (hci_get_bt_on(&bt_on) == HCI_SUCCESS && bt_on) { | ||
813 | toshiba_acpi.rfk_dev->state = RFKILL_STATE_UNBLOCKED; | ||
814 | } else if (hci_get_radio_state(&radio_on) == HCI_SUCCESS && | ||
815 | radio_on) { | ||
816 | toshiba_acpi.rfk_dev->state = RFKILL_STATE_SOFT_BLOCKED; | ||
817 | } else { | ||
818 | toshiba_acpi.rfk_dev->state = RFKILL_STATE_HARD_BLOCKED; | ||
819 | } | ||
820 | |||
821 | ret = rfkill_register(toshiba_acpi.rfk_dev); | ||
822 | if (ret) { | ||
823 | printk(MY_ERR "unable to register rfkill device\n"); | ||
824 | toshiba_acpi_exit(); | ||
825 | return -ENOMEM; | ||
826 | } | ||
827 | |||
828 | /* Register input device for kill switch */ | ||
829 | toshiba_acpi.poll_dev = input_allocate_polled_device(); | ||
830 | if (!toshiba_acpi.poll_dev) { | ||
831 | printk(MY_ERR | ||
832 | "unable to allocate kill-switch input device\n"); | ||
833 | toshiba_acpi_exit(); | ||
834 | return -ENOMEM; | ||
835 | } | ||
836 | toshiba_acpi.poll_dev->private = &toshiba_acpi; | ||
837 | toshiba_acpi.poll_dev->poll = bt_poll_rfkill; | ||
838 | toshiba_acpi.poll_dev->poll_interval = 1000; /* msecs */ | ||
839 | |||
840 | toshiba_acpi.poll_dev->input->name = toshiba_acpi.rfk_name; | ||
841 | toshiba_acpi.poll_dev->input->id.bustype = BUS_HOST; | ||
842 | /* Toshiba USB ID */ | ||
843 | toshiba_acpi.poll_dev->input->id.vendor = 0x0930; | ||
844 | set_bit(EV_SW, toshiba_acpi.poll_dev->input->evbit); | ||
845 | set_bit(SW_RFKILL_ALL, toshiba_acpi.poll_dev->input->swbit); | ||
846 | input_report_switch(toshiba_acpi.poll_dev->input, | ||
847 | SW_RFKILL_ALL, TRUE); | ||
848 | input_sync(toshiba_acpi.poll_dev->input); | ||
849 | |||
850 | ret = input_register_polled_device(toshiba_acpi.poll_dev); | ||
851 | if (ret) { | ||
852 | printk(MY_ERR | ||
853 | "unable to register kill-switch input device\n"); | ||
854 | toshiba_acpi_exit(); | ||
855 | return ret; | ||
856 | } | ||
857 | } | ||
858 | |||
859 | return 0; | ||
860 | } | ||
861 | |||
862 | module_init(toshiba_acpi_init); | ||
863 | module_exit(toshiba_acpi_exit); | ||
diff --git a/drivers/platform/x86/wmi.c b/drivers/platform/x86/wmi.c new file mode 100644 index 000000000000..8a8b377712c9 --- /dev/null +++ b/drivers/platform/x86/wmi.c | |||
@@ -0,0 +1,747 @@ | |||
1 | /* | ||
2 | * ACPI-WMI mapping driver | ||
3 | * | ||
4 | * Copyright (C) 2007-2008 Carlos Corbacho <carlos@strangeworlds.co.uk> | ||
5 | * | ||
6 | * GUID parsing code from ldm.c is: | ||
7 | * Copyright (C) 2001,2002 Richard Russon <ldm@flatcap.org> | ||
8 | * Copyright (c) 2001-2007 Anton Altaparmakov | ||
9 | * Copyright (C) 2001,2002 Jakob Kemi <jakob.kemi@telia.com> | ||
10 | * | ||
11 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
12 | * | ||
13 | * This program is free software; you can redistribute it and/or modify | ||
14 | * it under the terms of the GNU General Public License as published by | ||
15 | * the Free Software Foundation; either version 2 of the License, or (at | ||
16 | * your option) any later version. | ||
17 | * | ||
18 | * This program is distributed in the hope that it will be useful, but | ||
19 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
21 | * General Public License for more details. | ||
22 | * | ||
23 | * You should have received a copy of the GNU General Public License along | ||
24 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
25 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. | ||
26 | * | ||
27 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
28 | */ | ||
29 | |||
30 | #include <linux/kernel.h> | ||
31 | #include <linux/init.h> | ||
32 | #include <linux/types.h> | ||
33 | #include <linux/list.h> | ||
34 | #include <linux/acpi.h> | ||
35 | #include <acpi/acpi_bus.h> | ||
36 | #include <acpi/acpi_drivers.h> | ||
37 | |||
38 | ACPI_MODULE_NAME("wmi"); | ||
39 | MODULE_AUTHOR("Carlos Corbacho"); | ||
40 | MODULE_DESCRIPTION("ACPI-WMI Mapping Driver"); | ||
41 | MODULE_LICENSE("GPL"); | ||
42 | |||
43 | #define ACPI_WMI_CLASS "wmi" | ||
44 | |||
45 | #undef PREFIX | ||
46 | #define PREFIX "ACPI: WMI: " | ||
47 | |||
48 | static DEFINE_MUTEX(wmi_data_lock); | ||
49 | |||
50 | struct guid_block { | ||
51 | char guid[16]; | ||
52 | union { | ||
53 | char object_id[2]; | ||
54 | struct { | ||
55 | unsigned char notify_id; | ||
56 | unsigned char reserved; | ||
57 | }; | ||
58 | }; | ||
59 | u8 instance_count; | ||
60 | u8 flags; | ||
61 | }; | ||
62 | |||
63 | struct wmi_block { | ||
64 | struct list_head list; | ||
65 | struct guid_block gblock; | ||
66 | acpi_handle handle; | ||
67 | wmi_notify_handler handler; | ||
68 | void *handler_data; | ||
69 | }; | ||
70 | |||
71 | static struct wmi_block wmi_blocks; | ||
72 | |||
73 | /* | ||
74 | * If the GUID data block is marked as expensive, we must enable and | ||
75 | * explicitily disable data collection. | ||
76 | */ | ||
77 | #define ACPI_WMI_EXPENSIVE 0x1 | ||
78 | #define ACPI_WMI_METHOD 0x2 /* GUID is a method */ | ||
79 | #define ACPI_WMI_STRING 0x4 /* GUID takes & returns a string */ | ||
80 | #define ACPI_WMI_EVENT 0x8 /* GUID is an event */ | ||
81 | |||
82 | static int acpi_wmi_remove(struct acpi_device *device, int type); | ||
83 | static int acpi_wmi_add(struct acpi_device *device); | ||
84 | |||
85 | static const struct acpi_device_id wmi_device_ids[] = { | ||
86 | {"PNP0C14", 0}, | ||
87 | {"pnp0c14", 0}, | ||
88 | {"", 0}, | ||
89 | }; | ||
90 | MODULE_DEVICE_TABLE(acpi, wmi_device_ids); | ||
91 | |||
92 | static struct acpi_driver acpi_wmi_driver = { | ||
93 | .name = "wmi", | ||
94 | .class = ACPI_WMI_CLASS, | ||
95 | .ids = wmi_device_ids, | ||
96 | .ops = { | ||
97 | .add = acpi_wmi_add, | ||
98 | .remove = acpi_wmi_remove, | ||
99 | }, | ||
100 | }; | ||
101 | |||
102 | /* | ||
103 | * GUID parsing functions | ||
104 | */ | ||
105 | |||
106 | /** | ||
107 | * wmi_parse_hexbyte - Convert a ASCII hex number to a byte | ||
108 | * @src: Pointer to at least 2 characters to convert. | ||
109 | * | ||
110 | * Convert a two character ASCII hex string to a number. | ||
111 | * | ||
112 | * Return: 0-255 Success, the byte was parsed correctly | ||
113 | * -1 Error, an invalid character was supplied | ||
114 | */ | ||
115 | static int wmi_parse_hexbyte(const u8 *src) | ||
116 | { | ||
117 | unsigned int x; /* For correct wrapping */ | ||
118 | int h; | ||
119 | |||
120 | /* high part */ | ||
121 | x = src[0]; | ||
122 | if (x - '0' <= '9' - '0') { | ||
123 | h = x - '0'; | ||
124 | } else if (x - 'a' <= 'f' - 'a') { | ||
125 | h = x - 'a' + 10; | ||
126 | } else if (x - 'A' <= 'F' - 'A') { | ||
127 | h = x - 'A' + 10; | ||
128 | } else { | ||
129 | return -1; | ||
130 | } | ||
131 | h <<= 4; | ||
132 | |||
133 | /* low part */ | ||
134 | x = src[1]; | ||
135 | if (x - '0' <= '9' - '0') | ||
136 | return h | (x - '0'); | ||
137 | if (x - 'a' <= 'f' - 'a') | ||
138 | return h | (x - 'a' + 10); | ||
139 | if (x - 'A' <= 'F' - 'A') | ||
140 | return h | (x - 'A' + 10); | ||
141 | return -1; | ||
142 | } | ||
143 | |||
144 | /** | ||
145 | * wmi_swap_bytes - Rearrange GUID bytes to match GUID binary | ||
146 | * @src: Memory block holding binary GUID (16 bytes) | ||
147 | * @dest: Memory block to hold byte swapped binary GUID (16 bytes) | ||
148 | * | ||
149 | * Byte swap a binary GUID to match it's real GUID value | ||
150 | */ | ||
151 | static void wmi_swap_bytes(u8 *src, u8 *dest) | ||
152 | { | ||
153 | int i; | ||
154 | |||
155 | for (i = 0; i <= 3; i++) | ||
156 | memcpy(dest + i, src + (3 - i), 1); | ||
157 | |||
158 | for (i = 0; i <= 1; i++) | ||
159 | memcpy(dest + 4 + i, src + (5 - i), 1); | ||
160 | |||
161 | for (i = 0; i <= 1; i++) | ||
162 | memcpy(dest + 6 + i, src + (7 - i), 1); | ||
163 | |||
164 | memcpy(dest + 8, src + 8, 8); | ||
165 | } | ||
166 | |||
167 | /** | ||
168 | * wmi_parse_guid - Convert GUID from ASCII to binary | ||
169 | * @src: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba | ||
170 | * @dest: Memory block to hold binary GUID (16 bytes) | ||
171 | * | ||
172 | * N.B. The GUID need not be NULL terminated. | ||
173 | * | ||
174 | * Return: 'true' @dest contains binary GUID | ||
175 | * 'false' @dest contents are undefined | ||
176 | */ | ||
177 | static bool wmi_parse_guid(const u8 *src, u8 *dest) | ||
178 | { | ||
179 | static const int size[] = { 4, 2, 2, 2, 6 }; | ||
180 | int i, j, v; | ||
181 | |||
182 | if (src[8] != '-' || src[13] != '-' || | ||
183 | src[18] != '-' || src[23] != '-') | ||
184 | return false; | ||
185 | |||
186 | for (j = 0; j < 5; j++, src++) { | ||
187 | for (i = 0; i < size[j]; i++, src += 2, *dest++ = v) { | ||
188 | v = wmi_parse_hexbyte(src); | ||
189 | if (v < 0) | ||
190 | return false; | ||
191 | } | ||
192 | } | ||
193 | |||
194 | return true; | ||
195 | } | ||
196 | |||
197 | static bool find_guid(const char *guid_string, struct wmi_block **out) | ||
198 | { | ||
199 | char tmp[16], guid_input[16]; | ||
200 | struct wmi_block *wblock; | ||
201 | struct guid_block *block; | ||
202 | struct list_head *p; | ||
203 | |||
204 | wmi_parse_guid(guid_string, tmp); | ||
205 | wmi_swap_bytes(tmp, guid_input); | ||
206 | |||
207 | list_for_each(p, &wmi_blocks.list) { | ||
208 | wblock = list_entry(p, struct wmi_block, list); | ||
209 | block = &wblock->gblock; | ||
210 | |||
211 | if (memcmp(block->guid, guid_input, 16) == 0) { | ||
212 | if (out) | ||
213 | *out = wblock; | ||
214 | return 1; | ||
215 | } | ||
216 | } | ||
217 | return 0; | ||
218 | } | ||
219 | |||
220 | static acpi_status wmi_method_enable(struct wmi_block *wblock, int enable) | ||
221 | { | ||
222 | struct guid_block *block = NULL; | ||
223 | char method[5]; | ||
224 | struct acpi_object_list input; | ||
225 | union acpi_object params[1]; | ||
226 | acpi_status status; | ||
227 | acpi_handle handle; | ||
228 | |||
229 | block = &wblock->gblock; | ||
230 | handle = wblock->handle; | ||
231 | |||
232 | if (!block) | ||
233 | return AE_NOT_EXIST; | ||
234 | |||
235 | input.count = 1; | ||
236 | input.pointer = params; | ||
237 | params[0].type = ACPI_TYPE_INTEGER; | ||
238 | params[0].integer.value = enable; | ||
239 | |||
240 | snprintf(method, 5, "WE%02X", block->notify_id); | ||
241 | status = acpi_evaluate_object(handle, method, &input, NULL); | ||
242 | |||
243 | if (status != AE_OK && status != AE_NOT_FOUND) | ||
244 | return status; | ||
245 | else | ||
246 | return AE_OK; | ||
247 | } | ||
248 | |||
249 | /* | ||
250 | * Exported WMI functions | ||
251 | */ | ||
252 | /** | ||
253 | * wmi_evaluate_method - Evaluate a WMI method | ||
254 | * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba | ||
255 | * @instance: Instance index | ||
256 | * @method_id: Method ID to call | ||
257 | * &in: Buffer containing input for the method call | ||
258 | * &out: Empty buffer to return the method results | ||
259 | * | ||
260 | * Call an ACPI-WMI method | ||
261 | */ | ||
262 | acpi_status wmi_evaluate_method(const char *guid_string, u8 instance, | ||
263 | u32 method_id, const struct acpi_buffer *in, struct acpi_buffer *out) | ||
264 | { | ||
265 | struct guid_block *block = NULL; | ||
266 | struct wmi_block *wblock = NULL; | ||
267 | acpi_handle handle; | ||
268 | acpi_status status; | ||
269 | struct acpi_object_list input; | ||
270 | union acpi_object params[3]; | ||
271 | char method[4] = "WM"; | ||
272 | |||
273 | if (!find_guid(guid_string, &wblock)) | ||
274 | return AE_ERROR; | ||
275 | |||
276 | block = &wblock->gblock; | ||
277 | handle = wblock->handle; | ||
278 | |||
279 | if (!(block->flags & ACPI_WMI_METHOD)) | ||
280 | return AE_BAD_DATA; | ||
281 | |||
282 | if (block->instance_count < instance) | ||
283 | return AE_BAD_PARAMETER; | ||
284 | |||
285 | input.count = 2; | ||
286 | input.pointer = params; | ||
287 | params[0].type = ACPI_TYPE_INTEGER; | ||
288 | params[0].integer.value = instance; | ||
289 | params[1].type = ACPI_TYPE_INTEGER; | ||
290 | params[1].integer.value = method_id; | ||
291 | |||
292 | if (in) { | ||
293 | input.count = 3; | ||
294 | |||
295 | if (block->flags & ACPI_WMI_STRING) { | ||
296 | params[2].type = ACPI_TYPE_STRING; | ||
297 | } else { | ||
298 | params[2].type = ACPI_TYPE_BUFFER; | ||
299 | } | ||
300 | params[2].buffer.length = in->length; | ||
301 | params[2].buffer.pointer = in->pointer; | ||
302 | } | ||
303 | |||
304 | strncat(method, block->object_id, 2); | ||
305 | |||
306 | status = acpi_evaluate_object(handle, method, &input, out); | ||
307 | |||
308 | return status; | ||
309 | } | ||
310 | EXPORT_SYMBOL_GPL(wmi_evaluate_method); | ||
311 | |||
312 | /** | ||
313 | * wmi_query_block - Return contents of a WMI block | ||
314 | * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba | ||
315 | * @instance: Instance index | ||
316 | * &out: Empty buffer to return the contents of the data block to | ||
317 | * | ||
318 | * Return the contents of an ACPI-WMI data block to a buffer | ||
319 | */ | ||
320 | acpi_status wmi_query_block(const char *guid_string, u8 instance, | ||
321 | struct acpi_buffer *out) | ||
322 | { | ||
323 | struct guid_block *block = NULL; | ||
324 | struct wmi_block *wblock = NULL; | ||
325 | acpi_handle handle, wc_handle; | ||
326 | acpi_status status, wc_status = AE_ERROR; | ||
327 | struct acpi_object_list input, wc_input; | ||
328 | union acpi_object wc_params[1], wq_params[1]; | ||
329 | char method[4]; | ||
330 | char wc_method[4] = "WC"; | ||
331 | |||
332 | if (!guid_string || !out) | ||
333 | return AE_BAD_PARAMETER; | ||
334 | |||
335 | if (!find_guid(guid_string, &wblock)) | ||
336 | return AE_ERROR; | ||
337 | |||
338 | block = &wblock->gblock; | ||
339 | handle = wblock->handle; | ||
340 | |||
341 | if (block->instance_count < instance) | ||
342 | return AE_BAD_PARAMETER; | ||
343 | |||
344 | /* Check GUID is a data block */ | ||
345 | if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD)) | ||
346 | return AE_ERROR; | ||
347 | |||
348 | input.count = 1; | ||
349 | input.pointer = wq_params; | ||
350 | wq_params[0].type = ACPI_TYPE_INTEGER; | ||
351 | wq_params[0].integer.value = instance; | ||
352 | |||
353 | /* | ||
354 | * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method first to | ||
355 | * enable collection. | ||
356 | */ | ||
357 | if (block->flags & ACPI_WMI_EXPENSIVE) { | ||
358 | wc_input.count = 1; | ||
359 | wc_input.pointer = wc_params; | ||
360 | wc_params[0].type = ACPI_TYPE_INTEGER; | ||
361 | wc_params[0].integer.value = 1; | ||
362 | |||
363 | strncat(wc_method, block->object_id, 2); | ||
364 | |||
365 | /* | ||
366 | * Some GUIDs break the specification by declaring themselves | ||
367 | * expensive, but have no corresponding WCxx method. So we | ||
368 | * should not fail if this happens. | ||
369 | */ | ||
370 | wc_status = acpi_get_handle(handle, wc_method, &wc_handle); | ||
371 | if (ACPI_SUCCESS(wc_status)) | ||
372 | wc_status = acpi_evaluate_object(handle, wc_method, | ||
373 | &wc_input, NULL); | ||
374 | } | ||
375 | |||
376 | strcpy(method, "WQ"); | ||
377 | strncat(method, block->object_id, 2); | ||
378 | |||
379 | status = acpi_evaluate_object(handle, method, &input, out); | ||
380 | |||
381 | /* | ||
382 | * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method, even if | ||
383 | * the WQxx method failed - we should disable collection anyway. | ||
384 | */ | ||
385 | if ((block->flags & ACPI_WMI_EXPENSIVE) && ACPI_SUCCESS(wc_status)) { | ||
386 | wc_params[0].integer.value = 0; | ||
387 | status = acpi_evaluate_object(handle, | ||
388 | wc_method, &wc_input, NULL); | ||
389 | } | ||
390 | |||
391 | return status; | ||
392 | } | ||
393 | EXPORT_SYMBOL_GPL(wmi_query_block); | ||
394 | |||
395 | /** | ||
396 | * wmi_set_block - Write to a WMI block | ||
397 | * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba | ||
398 | * @instance: Instance index | ||
399 | * &in: Buffer containing new values for the data block | ||
400 | * | ||
401 | * Write the contents of the input buffer to an ACPI-WMI data block | ||
402 | */ | ||
403 | acpi_status wmi_set_block(const char *guid_string, u8 instance, | ||
404 | const struct acpi_buffer *in) | ||
405 | { | ||
406 | struct guid_block *block = NULL; | ||
407 | struct wmi_block *wblock = NULL; | ||
408 | acpi_handle handle; | ||
409 | struct acpi_object_list input; | ||
410 | union acpi_object params[2]; | ||
411 | char method[4] = "WS"; | ||
412 | |||
413 | if (!guid_string || !in) | ||
414 | return AE_BAD_DATA; | ||
415 | |||
416 | if (!find_guid(guid_string, &wblock)) | ||
417 | return AE_ERROR; | ||
418 | |||
419 | block = &wblock->gblock; | ||
420 | handle = wblock->handle; | ||
421 | |||
422 | if (block->instance_count < instance) | ||
423 | return AE_BAD_PARAMETER; | ||
424 | |||
425 | /* Check GUID is a data block */ | ||
426 | if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD)) | ||
427 | return AE_ERROR; | ||
428 | |||
429 | input.count = 2; | ||
430 | input.pointer = params; | ||
431 | params[0].type = ACPI_TYPE_INTEGER; | ||
432 | params[0].integer.value = instance; | ||
433 | |||
434 | if (block->flags & ACPI_WMI_STRING) { | ||
435 | params[1].type = ACPI_TYPE_STRING; | ||
436 | } else { | ||
437 | params[1].type = ACPI_TYPE_BUFFER; | ||
438 | } | ||
439 | params[1].buffer.length = in->length; | ||
440 | params[1].buffer.pointer = in->pointer; | ||
441 | |||
442 | strncat(method, block->object_id, 2); | ||
443 | |||
444 | return acpi_evaluate_object(handle, method, &input, NULL); | ||
445 | } | ||
446 | EXPORT_SYMBOL_GPL(wmi_set_block); | ||
447 | |||
448 | /** | ||
449 | * wmi_install_notify_handler - Register handler for WMI events | ||
450 | * @handler: Function to handle notifications | ||
451 | * @data: Data to be returned to handler when event is fired | ||
452 | * | ||
453 | * Register a handler for events sent to the ACPI-WMI mapper device. | ||
454 | */ | ||
455 | acpi_status wmi_install_notify_handler(const char *guid, | ||
456 | wmi_notify_handler handler, void *data) | ||
457 | { | ||
458 | struct wmi_block *block; | ||
459 | acpi_status status; | ||
460 | |||
461 | if (!guid || !handler) | ||
462 | return AE_BAD_PARAMETER; | ||
463 | |||
464 | find_guid(guid, &block); | ||
465 | if (!block) | ||
466 | return AE_NOT_EXIST; | ||
467 | |||
468 | if (block->handler) | ||
469 | return AE_ALREADY_ACQUIRED; | ||
470 | |||
471 | block->handler = handler; | ||
472 | block->handler_data = data; | ||
473 | |||
474 | status = wmi_method_enable(block, 1); | ||
475 | |||
476 | return status; | ||
477 | } | ||
478 | EXPORT_SYMBOL_GPL(wmi_install_notify_handler); | ||
479 | |||
480 | /** | ||
481 | * wmi_uninstall_notify_handler - Unregister handler for WMI events | ||
482 | * | ||
483 | * Unregister handler for events sent to the ACPI-WMI mapper device. | ||
484 | */ | ||
485 | acpi_status wmi_remove_notify_handler(const char *guid) | ||
486 | { | ||
487 | struct wmi_block *block; | ||
488 | acpi_status status; | ||
489 | |||
490 | if (!guid) | ||
491 | return AE_BAD_PARAMETER; | ||
492 | |||
493 | find_guid(guid, &block); | ||
494 | if (!block) | ||
495 | return AE_NOT_EXIST; | ||
496 | |||
497 | if (!block->handler) | ||
498 | return AE_NULL_ENTRY; | ||
499 | |||
500 | status = wmi_method_enable(block, 0); | ||
501 | |||
502 | block->handler = NULL; | ||
503 | block->handler_data = NULL; | ||
504 | |||
505 | return status; | ||
506 | } | ||
507 | EXPORT_SYMBOL_GPL(wmi_remove_notify_handler); | ||
508 | |||
509 | /** | ||
510 | * wmi_get_event_data - Get WMI data associated with an event | ||
511 | * | ||
512 | * @event - Event to find | ||
513 | * &out - Buffer to hold event data | ||
514 | * | ||
515 | * Returns extra data associated with an event in WMI. | ||
516 | */ | ||
517 | acpi_status wmi_get_event_data(u32 event, struct acpi_buffer *out) | ||
518 | { | ||
519 | struct acpi_object_list input; | ||
520 | union acpi_object params[1]; | ||
521 | struct guid_block *gblock; | ||
522 | struct wmi_block *wblock; | ||
523 | struct list_head *p; | ||
524 | |||
525 | input.count = 1; | ||
526 | input.pointer = params; | ||
527 | params[0].type = ACPI_TYPE_INTEGER; | ||
528 | params[0].integer.value = event; | ||
529 | |||
530 | list_for_each(p, &wmi_blocks.list) { | ||
531 | wblock = list_entry(p, struct wmi_block, list); | ||
532 | gblock = &wblock->gblock; | ||
533 | |||
534 | if ((gblock->flags & ACPI_WMI_EVENT) && | ||
535 | (gblock->notify_id == event)) | ||
536 | return acpi_evaluate_object(wblock->handle, "_WED", | ||
537 | &input, out); | ||
538 | } | ||
539 | |||
540 | return AE_NOT_FOUND; | ||
541 | } | ||
542 | EXPORT_SYMBOL_GPL(wmi_get_event_data); | ||
543 | |||
544 | /** | ||
545 | * wmi_has_guid - Check if a GUID is available | ||
546 | * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba | ||
547 | * | ||
548 | * Check if a given GUID is defined by _WDG | ||
549 | */ | ||
550 | bool wmi_has_guid(const char *guid_string) | ||
551 | { | ||
552 | return find_guid(guid_string, NULL); | ||
553 | } | ||
554 | EXPORT_SYMBOL_GPL(wmi_has_guid); | ||
555 | |||
556 | /* | ||
557 | * Parse the _WDG method for the GUID data blocks | ||
558 | */ | ||
559 | static __init acpi_status parse_wdg(acpi_handle handle) | ||
560 | { | ||
561 | struct acpi_buffer out = {ACPI_ALLOCATE_BUFFER, NULL}; | ||
562 | union acpi_object *obj; | ||
563 | struct guid_block *gblock; | ||
564 | struct wmi_block *wblock; | ||
565 | acpi_status status; | ||
566 | u32 i, total; | ||
567 | |||
568 | status = acpi_evaluate_object(handle, "_WDG", NULL, &out); | ||
569 | |||
570 | if (ACPI_FAILURE(status)) | ||
571 | return status; | ||
572 | |||
573 | obj = (union acpi_object *) out.pointer; | ||
574 | |||
575 | if (obj->type != ACPI_TYPE_BUFFER) | ||
576 | return AE_ERROR; | ||
577 | |||
578 | total = obj->buffer.length / sizeof(struct guid_block); | ||
579 | |||
580 | gblock = kzalloc(obj->buffer.length, GFP_KERNEL); | ||
581 | if (!gblock) | ||
582 | return AE_NO_MEMORY; | ||
583 | |||
584 | memcpy(gblock, obj->buffer.pointer, obj->buffer.length); | ||
585 | |||
586 | for (i = 0; i < total; i++) { | ||
587 | wblock = kzalloc(sizeof(struct wmi_block), GFP_KERNEL); | ||
588 | if (!wblock) | ||
589 | return AE_NO_MEMORY; | ||
590 | |||
591 | wblock->gblock = gblock[i]; | ||
592 | wblock->handle = handle; | ||
593 | list_add_tail(&wblock->list, &wmi_blocks.list); | ||
594 | } | ||
595 | |||
596 | kfree(out.pointer); | ||
597 | kfree(gblock); | ||
598 | |||
599 | return status; | ||
600 | } | ||
601 | |||
602 | /* | ||
603 | * WMI can have EmbeddedControl access regions. In which case, we just want to | ||
604 | * hand these off to the EC driver. | ||
605 | */ | ||
606 | static acpi_status | ||
607 | acpi_wmi_ec_space_handler(u32 function, acpi_physical_address address, | ||
608 | u32 bits, acpi_integer * value, | ||
609 | void *handler_context, void *region_context) | ||
610 | { | ||
611 | int result = 0, i = 0; | ||
612 | u8 temp = 0; | ||
613 | |||
614 | if ((address > 0xFF) || !value) | ||
615 | return AE_BAD_PARAMETER; | ||
616 | |||
617 | if (function != ACPI_READ && function != ACPI_WRITE) | ||
618 | return AE_BAD_PARAMETER; | ||
619 | |||
620 | if (bits != 8) | ||
621 | return AE_BAD_PARAMETER; | ||
622 | |||
623 | if (function == ACPI_READ) { | ||
624 | result = ec_read(address, &temp); | ||
625 | (*value) |= ((acpi_integer)temp) << i; | ||
626 | } else { | ||
627 | temp = 0xff & ((*value) >> i); | ||
628 | result = ec_write(address, temp); | ||
629 | } | ||
630 | |||
631 | switch (result) { | ||
632 | case -EINVAL: | ||
633 | return AE_BAD_PARAMETER; | ||
634 | break; | ||
635 | case -ENODEV: | ||
636 | return AE_NOT_FOUND; | ||
637 | break; | ||
638 | case -ETIME: | ||
639 | return AE_TIME; | ||
640 | break; | ||
641 | default: | ||
642 | return AE_OK; | ||
643 | } | ||
644 | } | ||
645 | |||
646 | static void acpi_wmi_notify(acpi_handle handle, u32 event, void *data) | ||
647 | { | ||
648 | struct guid_block *block; | ||
649 | struct wmi_block *wblock; | ||
650 | struct list_head *p; | ||
651 | struct acpi_device *device = data; | ||
652 | |||
653 | list_for_each(p, &wmi_blocks.list) { | ||
654 | wblock = list_entry(p, struct wmi_block, list); | ||
655 | block = &wblock->gblock; | ||
656 | |||
657 | if ((block->flags & ACPI_WMI_EVENT) && | ||
658 | (block->notify_id == event)) { | ||
659 | if (wblock->handler) | ||
660 | wblock->handler(event, wblock->handler_data); | ||
661 | |||
662 | acpi_bus_generate_netlink_event( | ||
663 | device->pnp.device_class, dev_name(&device->dev), | ||
664 | event, 0); | ||
665 | break; | ||
666 | } | ||
667 | } | ||
668 | } | ||
669 | |||
670 | static int acpi_wmi_remove(struct acpi_device *device, int type) | ||
671 | { | ||
672 | acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY, | ||
673 | acpi_wmi_notify); | ||
674 | |||
675 | acpi_remove_address_space_handler(device->handle, | ||
676 | ACPI_ADR_SPACE_EC, &acpi_wmi_ec_space_handler); | ||
677 | |||
678 | return 0; | ||
679 | } | ||
680 | |||
681 | static int __init acpi_wmi_add(struct acpi_device *device) | ||
682 | { | ||
683 | acpi_status status; | ||
684 | int result = 0; | ||
685 | |||
686 | status = acpi_install_notify_handler(device->handle, ACPI_DEVICE_NOTIFY, | ||
687 | acpi_wmi_notify, device); | ||
688 | if (ACPI_FAILURE(status)) { | ||
689 | printk(KERN_ERR PREFIX "Error installing notify handler\n"); | ||
690 | return -ENODEV; | ||
691 | } | ||
692 | |||
693 | status = acpi_install_address_space_handler(device->handle, | ||
694 | ACPI_ADR_SPACE_EC, | ||
695 | &acpi_wmi_ec_space_handler, | ||
696 | NULL, NULL); | ||
697 | if (ACPI_FAILURE(status)) | ||
698 | return -ENODEV; | ||
699 | |||
700 | status = parse_wdg(device->handle); | ||
701 | if (ACPI_FAILURE(status)) { | ||
702 | printk(KERN_ERR PREFIX "Error installing EC region handler\n"); | ||
703 | return -ENODEV; | ||
704 | } | ||
705 | |||
706 | return result; | ||
707 | } | ||
708 | |||
709 | static int __init acpi_wmi_init(void) | ||
710 | { | ||
711 | acpi_status result; | ||
712 | |||
713 | INIT_LIST_HEAD(&wmi_blocks.list); | ||
714 | |||
715 | if (acpi_disabled) | ||
716 | return -ENODEV; | ||
717 | |||
718 | result = acpi_bus_register_driver(&acpi_wmi_driver); | ||
719 | |||
720 | if (result < 0) { | ||
721 | printk(KERN_INFO PREFIX "Error loading mapper\n"); | ||
722 | } else { | ||
723 | printk(KERN_INFO PREFIX "Mapper loaded\n"); | ||
724 | } | ||
725 | |||
726 | return result; | ||
727 | } | ||
728 | |||
729 | static void __exit acpi_wmi_exit(void) | ||
730 | { | ||
731 | struct list_head *p, *tmp; | ||
732 | struct wmi_block *wblock; | ||
733 | |||
734 | acpi_bus_unregister_driver(&acpi_wmi_driver); | ||
735 | |||
736 | list_for_each_safe(p, tmp, &wmi_blocks.list) { | ||
737 | wblock = list_entry(p, struct wmi_block, list); | ||
738 | |||
739 | list_del(p); | ||
740 | kfree(wblock); | ||
741 | } | ||
742 | |||
743 | printk(KERN_INFO PREFIX "Mapper unloaded\n"); | ||
744 | } | ||
745 | |||
746 | subsys_initcall(acpi_wmi_init); | ||
747 | module_exit(acpi_wmi_exit); | ||