2 * hp_accel.c - Interface between LIS3LV02DL driver and HP ACPI BIOS
4 * Copyright (C) 2007-2008 Yan Burman
5 * Copyright (C) 2008 Eric Piel
6 * Copyright (C) 2008-2009 Pavel Machek
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 #include <linux/kernel.h>
24 #include <linux/init.h>
25 #include <linux/dmi.h>
26 #include <linux/module.h>
27 #include <linux/types.h>
28 #include <linux/platform_device.h>
29 #include <linux/interrupt.h>
30 #include <linux/input.h>
31 #include <linux/kthread.h>
32 #include <linux/semaphore.h>
33 #include <linux/delay.h>
34 #include <linux/wait.h>
35 #include <linux/poll.h>
36 #include <linux/freezer.h>
37 #include <linux/version.h>
38 #include <linux/uaccess.h>
39 #include <linux/leds.h>
40 #include <acpi/acpi_drivers.h>
41 #include <asm/atomic.h>
42 #include "lis3lv02d.h"
44 #define DRIVER_NAME "lis3lv02d"
45 #define ACPI_MDPS_CLASS "accelerometer"
47 /* Delayed LEDs infrastructure ------------------------------------ */
49 /* Special LED class that can defer work */
50 struct delayed_led_classdev
{
51 struct led_classdev led_classdev
;
52 struct work_struct work
;
53 enum led_brightness new_brightness
;
55 unsigned int led
; /* For driver */
56 void (*set_brightness
)(struct delayed_led_classdev
*data
, enum led_brightness value
);
59 static inline void delayed_set_status_worker(struct work_struct
*work
)
61 struct delayed_led_classdev
*data
=
62 container_of(work
, struct delayed_led_classdev
, work
);
64 data
->set_brightness(data
, data
->new_brightness
);
67 static inline void delayed_sysfs_set(struct led_classdev
*led_cdev
,
68 enum led_brightness brightness
)
70 struct delayed_led_classdev
*data
= container_of(led_cdev
,
71 struct delayed_led_classdev
, led_classdev
);
72 data
->new_brightness
= brightness
;
73 schedule_work(&data
->work
);
76 /* HP-specific accelerometer driver ------------------------------------ */
78 /* For automatic insertion of the module */
79 static struct acpi_device_id lis3lv02d_device_ids
[] = {
80 {"HPQ0004", 0}, /* HP Mobile Data Protection System PNP */
83 MODULE_DEVICE_TABLE(acpi
, lis3lv02d_device_ids
);
87 * lis3lv02d_acpi_init - ACPI _INI method: initialize the device.
88 * @handle: the handle of the device
90 * Returns AE_OK on success.
92 acpi_status
lis3lv02d_acpi_init(acpi_handle handle
)
94 return acpi_evaluate_object(handle
, METHOD_NAME__INI
, NULL
, NULL
);
98 * lis3lv02d_acpi_read - ACPI ALRD method: read a register
99 * @handle: the handle of the device
100 * @reg: the register to read
101 * @ret: result of the operation
103 * Returns AE_OK on success.
105 acpi_status
lis3lv02d_acpi_read(acpi_handle handle
, int reg
, u8
*ret
)
107 union acpi_object arg0
= { ACPI_TYPE_INTEGER
};
108 struct acpi_object_list args
= { 1, &arg0
};
109 unsigned long long lret
;
112 arg0
.integer
.value
= reg
;
114 status
= acpi_evaluate_integer(handle
, "ALRD", &args
, &lret
);
120 * lis3lv02d_acpi_write - ACPI ALWR method: write to a register
121 * @handle: the handle of the device
122 * @reg: the register to write to
123 * @val: the value to write
125 * Returns AE_OK on success.
127 acpi_status
lis3lv02d_acpi_write(acpi_handle handle
, int reg
, u8 val
)
129 unsigned long long ret
; /* Not used when writting */
130 union acpi_object in_obj
[2];
131 struct acpi_object_list args
= { 2, in_obj
};
133 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
134 in_obj
[0].integer
.value
= reg
;
135 in_obj
[1].type
= ACPI_TYPE_INTEGER
;
136 in_obj
[1].integer
.value
= val
;
138 return acpi_evaluate_integer(handle
, "ALWR", &args
, &ret
);
141 static int lis3lv02d_dmi_matched(const struct dmi_system_id
*dmi
)
143 adev
.ac
= *((struct axis_conversion
*)dmi
->driver_data
);
144 printk(KERN_INFO DRIVER_NAME
": hardware type %s found.\n", dmi
->ident
);
149 /* Represents, for each axis seen by userspace, the corresponding hw axis (+1).
150 * If the value is negative, the opposite of the hw value is used. */
151 static struct axis_conversion lis3lv02d_axis_normal
= {1, 2, 3};
152 static struct axis_conversion lis3lv02d_axis_y_inverted
= {1, -2, 3};
153 static struct axis_conversion lis3lv02d_axis_x_inverted
= {-1, 2, 3};
154 static struct axis_conversion lis3lv02d_axis_z_inverted
= {1, 2, -3};
155 static struct axis_conversion lis3lv02d_axis_xy_rotated_left
= {-2, 1, 3};
156 static struct axis_conversion lis3lv02d_axis_xy_rotated_left_usd
= {-2, 1, -3};
157 static struct axis_conversion lis3lv02d_axis_xy_swap_inverted
= {-2, -1, 3};
158 static struct axis_conversion lis3lv02d_axis_xy_rotated_right
= {2, -1, 3};
159 static struct axis_conversion lis3lv02d_axis_xy_swap_yz_inverted
= {2, -1, -3};
161 #define AXIS_DMI_MATCH(_ident, _name, _axis) { \
163 .callback = lis3lv02d_dmi_matched, \
165 DMI_MATCH(DMI_PRODUCT_NAME, _name) \
167 .driver_data = &lis3lv02d_axis_##_axis \
169 static struct dmi_system_id lis3lv02d_dmi_ids
[] = {
170 /* product names are truncated to match all kinds of a same model */
171 AXIS_DMI_MATCH("NC64x0", "HP Compaq nc64", x_inverted
),
172 AXIS_DMI_MATCH("NC84x0", "HP Compaq nc84", z_inverted
),
173 AXIS_DMI_MATCH("NX9420", "HP Compaq nx9420", x_inverted
),
174 AXIS_DMI_MATCH("NW9440", "HP Compaq nw9440", x_inverted
),
175 AXIS_DMI_MATCH("NC2510", "HP Compaq 2510", y_inverted
),
176 AXIS_DMI_MATCH("NC8510", "HP Compaq 8510", xy_swap_inverted
),
177 AXIS_DMI_MATCH("HP2133", "HP 2133", xy_rotated_left
),
178 AXIS_DMI_MATCH("NC653x", "HP Compaq 653", xy_rotated_left_usd
),
179 AXIS_DMI_MATCH("NC673x", "HP Compaq 673", xy_rotated_left_usd
),
180 AXIS_DMI_MATCH("NC651xx", "HP Compaq 651", xy_rotated_right
),
181 AXIS_DMI_MATCH("NC671xx", "HP Compaq 671", xy_swap_yz_inverted
),
183 /* Laptop models without axis info (yet):
184 * "NC6910" "HP Compaq 6910"
185 * HP Compaq 8710x Notebook PC / Mobile Workstation
186 * "NC2400" "HP Compaq nc2400"
187 * "NX74x0" "HP Compaq nx74"
188 * "NX6325" "HP Compaq nx6325"
189 * "NC4400" "HP Compaq nc4400"
193 static void hpled_set(struct delayed_led_classdev
*led_cdev
, enum led_brightness value
)
195 acpi_handle handle
= adev
.device
->handle
;
196 unsigned long long ret
; /* Not used when writing */
197 union acpi_object in_obj
[1];
198 struct acpi_object_list args
= { 1, in_obj
};
200 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
201 in_obj
[0].integer
.value
= !!value
;
203 acpi_evaluate_integer(handle
, "ALED", &args
, &ret
);
206 static struct delayed_led_classdev hpled_led
= {
208 .name
= "hp::hddprotect",
209 .default_trigger
= "none",
210 .brightness_set
= delayed_sysfs_set
,
211 .flags
= LED_CORE_SUSPENDRESUME
,
213 .set_brightness
= hpled_set
,
217 lis3lv02d_get_resource(struct acpi_resource
*resource
, void *context
)
219 if (resource
->type
== ACPI_RESOURCE_TYPE_EXTENDED_IRQ
) {
220 struct acpi_resource_extended_irq
*irq
;
221 u32
*device_irq
= context
;
223 irq
= &resource
->data
.extended_irq
;
224 *device_irq
= irq
->interrupts
[0];
230 static void lis3lv02d_enum_resources(struct acpi_device
*device
)
234 status
= acpi_walk_resources(device
->handle
, METHOD_NAME__CRS
,
235 lis3lv02d_get_resource
, &adev
.irq
);
236 if (ACPI_FAILURE(status
))
237 printk(KERN_DEBUG DRIVER_NAME
": Error getting resources\n");
240 static s16
lis3lv02d_read_16(acpi_handle handle
, int reg
)
244 adev
.read(handle
, reg
- 1, &lo
);
245 adev
.read(handle
, reg
, &hi
);
246 /* In "12 bit right justified" mode, bit 6, bit 7, bit 8 = bit 5 */
247 return (s16
)((hi
<< 8) | lo
);
250 static s16
lis3lv02d_read_8(acpi_handle handle
, int reg
)
253 adev
.read(handle
, reg
, &lo
);
257 static int lis3lv02d_add(struct acpi_device
*device
)
264 adev
.device
= device
;
265 adev
.init
= lis3lv02d_acpi_init
;
266 adev
.read
= lis3lv02d_acpi_read
;
267 adev
.write
= lis3lv02d_acpi_write
;
268 strcpy(acpi_device_name(device
), DRIVER_NAME
);
269 strcpy(acpi_device_class(device
), ACPI_MDPS_CLASS
);
270 device
->driver_data
= &adev
;
272 lis3lv02d_acpi_read(device
->handle
, WHO_AM_I
, &adev
.whoami
);
273 switch (adev
.whoami
) {
275 printk(KERN_INFO DRIVER_NAME
": 2-byte sensor found\n");
276 adev
.read_data
= lis3lv02d_read_16
;
277 adev
.mdps_max_val
= 2048;
280 printk(KERN_INFO DRIVER_NAME
": 1-byte sensor found\n");
281 adev
.read_data
= lis3lv02d_read_8
;
282 adev
.mdps_max_val
= 128;
285 printk(KERN_ERR DRIVER_NAME
286 ": unknown sensor type 0x%X\n", adev
.whoami
);
290 /* If possible use a "standard" axes order */
291 if (dmi_check_system(lis3lv02d_dmi_ids
) == 0) {
292 printk(KERN_INFO DRIVER_NAME
": laptop model unknown, "
293 "using default axes configuration\n");
294 adev
.ac
= lis3lv02d_axis_normal
;
297 INIT_WORK(&hpled_led
.work
, delayed_set_status_worker
);
298 ret
= led_classdev_register(NULL
, &hpled_led
.led_classdev
);
302 /* obtain IRQ number of our device from ACPI */
303 lis3lv02d_enum_resources(adev
.device
);
305 ret
= lis3lv02d_init_device(&adev
);
307 flush_work(&hpled_led
.work
);
308 led_classdev_unregister(&hpled_led
.led_classdev
);
315 static int lis3lv02d_remove(struct acpi_device
*device
, int type
)
320 lis3lv02d_joystick_disable();
321 lis3lv02d_poweroff(device
->handle
);
323 flush_work(&hpled_led
.work
);
324 led_classdev_unregister(&hpled_led
.led_classdev
);
326 return lis3lv02d_remove_fs();
331 static int lis3lv02d_suspend(struct acpi_device
*device
, pm_message_t state
)
333 /* make sure the device is off when we suspend */
334 lis3lv02d_poweroff(device
->handle
);
338 static int lis3lv02d_resume(struct acpi_device
*device
)
340 /* put back the device in the right state (ACPI might turn it on) */
341 mutex_lock(&adev
.lock
);
343 lis3lv02d_poweron(device
->handle
);
345 lis3lv02d_poweroff(device
->handle
);
346 mutex_unlock(&adev
.lock
);
350 #define lis3lv02d_suspend NULL
351 #define lis3lv02d_resume NULL
354 /* For the HP MDPS aka 3D Driveguard */
355 static struct acpi_driver lis3lv02d_driver
= {
357 .class = ACPI_MDPS_CLASS
,
358 .ids
= lis3lv02d_device_ids
,
360 .add
= lis3lv02d_add
,
361 .remove
= lis3lv02d_remove
,
362 .suspend
= lis3lv02d_suspend
,
363 .resume
= lis3lv02d_resume
,
367 static int __init
lis3lv02d_init_module(void)
374 ret
= acpi_bus_register_driver(&lis3lv02d_driver
);
378 printk(KERN_INFO DRIVER_NAME
" driver loaded.\n");
383 static void __exit
lis3lv02d_exit_module(void)
385 acpi_bus_unregister_driver(&lis3lv02d_driver
);
388 MODULE_DESCRIPTION("Glue between LIS3LV02Dx and HP ACPI BIOS and support for disk protection LED.");
389 MODULE_AUTHOR("Yan Burman, Eric Piel, Pavel Machek");
390 MODULE_LICENSE("GPL");
392 module_init(lis3lv02d_init_module
);
393 module_exit(lis3lv02d_exit_module
);