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/delay.h>
31 #include <linux/wait.h>
32 #include <linux/poll.h>
33 #include <linux/freezer.h>
34 #include <linux/uaccess.h>
35 #include <linux/leds.h>
36 #include <acpi/acpi_drivers.h>
37 #include <asm/atomic.h>
38 #include "lis3lv02d.h"
40 #define DRIVER_NAME "lis3lv02d"
41 #define ACPI_MDPS_CLASS "accelerometer"
43 /* Delayed LEDs infrastructure ------------------------------------ */
45 /* Special LED class that can defer work */
46 struct delayed_led_classdev
{
47 struct led_classdev led_classdev
;
48 struct work_struct work
;
49 enum led_brightness new_brightness
;
51 unsigned int led
; /* For driver */
52 void (*set_brightness
)(struct delayed_led_classdev
*data
, enum led_brightness value
);
55 static inline void delayed_set_status_worker(struct work_struct
*work
)
57 struct delayed_led_classdev
*data
=
58 container_of(work
, struct delayed_led_classdev
, work
);
60 data
->set_brightness(data
, data
->new_brightness
);
63 static inline void delayed_sysfs_set(struct led_classdev
*led_cdev
,
64 enum led_brightness brightness
)
66 struct delayed_led_classdev
*data
= container_of(led_cdev
,
67 struct delayed_led_classdev
, led_classdev
);
68 data
->new_brightness
= brightness
;
69 schedule_work(&data
->work
);
72 /* HP-specific accelerometer driver ------------------------------------ */
74 /* For automatic insertion of the module */
75 static struct acpi_device_id lis3lv02d_device_ids
[] = {
76 {"HPQ0004", 0}, /* HP Mobile Data Protection System PNP */
79 MODULE_DEVICE_TABLE(acpi
, lis3lv02d_device_ids
);
83 * lis3lv02d_acpi_init - ACPI _INI method: initialize the device.
84 * @lis3: pointer to the device struct
86 * Returns 0 on success.
88 int lis3lv02d_acpi_init(struct lis3lv02d
*lis3
)
90 struct acpi_device
*dev
= lis3
->bus_priv
;
91 if (acpi_evaluate_object(dev
->handle
, METHOD_NAME__INI
,
99 * lis3lv02d_acpi_read - ACPI ALRD method: read a register
100 * @lis3: pointer to the device struct
101 * @reg: the register to read
102 * @ret: result of the operation
104 * Returns 0 on success.
106 int lis3lv02d_acpi_read(struct lis3lv02d
*lis3
, int reg
, u8
*ret
)
108 struct acpi_device
*dev
= lis3
->bus_priv
;
109 union acpi_object arg0
= { ACPI_TYPE_INTEGER
};
110 struct acpi_object_list args
= { 1, &arg0
};
111 unsigned long long lret
;
114 arg0
.integer
.value
= reg
;
116 status
= acpi_evaluate_integer(dev
->handle
, "ALRD", &args
, &lret
);
118 return (status
!= AE_OK
) ? -EINVAL
: 0;
122 * lis3lv02d_acpi_write - ACPI ALWR method: write to a register
123 * @lis3: pointer to the device struct
124 * @reg: the register to write to
125 * @val: the value to write
127 * Returns 0 on success.
129 int lis3lv02d_acpi_write(struct lis3lv02d
*lis3
, int reg
, u8 val
)
131 struct acpi_device
*dev
= lis3
->bus_priv
;
132 unsigned long long ret
; /* Not used when writting */
133 union acpi_object in_obj
[2];
134 struct acpi_object_list args
= { 2, in_obj
};
136 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
137 in_obj
[0].integer
.value
= reg
;
138 in_obj
[1].type
= ACPI_TYPE_INTEGER
;
139 in_obj
[1].integer
.value
= val
;
141 if (acpi_evaluate_integer(dev
->handle
, "ALWR", &args
, &ret
) != AE_OK
)
147 static int lis3lv02d_dmi_matched(const struct dmi_system_id
*dmi
)
149 lis3_dev
.ac
= *((struct axis_conversion
*)dmi
->driver_data
);
150 printk(KERN_INFO DRIVER_NAME
": hardware type %s found.\n", dmi
->ident
);
155 /* Represents, for each axis seen by userspace, the corresponding hw axis (+1).
156 * If the value is negative, the opposite of the hw value is used. */
157 static struct axis_conversion lis3lv02d_axis_normal
= {1, 2, 3};
158 static struct axis_conversion lis3lv02d_axis_y_inverted
= {1, -2, 3};
159 static struct axis_conversion lis3lv02d_axis_x_inverted
= {-1, 2, 3};
160 static struct axis_conversion lis3lv02d_axis_z_inverted
= {1, 2, -3};
161 static struct axis_conversion lis3lv02d_axis_xy_swap
= {2, 1, 3};
162 static struct axis_conversion lis3lv02d_axis_xy_rotated_left
= {-2, 1, 3};
163 static struct axis_conversion lis3lv02d_axis_xy_rotated_left_usd
= {-2, 1, -3};
164 static struct axis_conversion lis3lv02d_axis_xy_swap_inverted
= {-2, -1, 3};
165 static struct axis_conversion lis3lv02d_axis_xy_rotated_right
= {2, -1, 3};
166 static struct axis_conversion lis3lv02d_axis_xy_swap_yz_inverted
= {2, -1, -3};
168 #define AXIS_DMI_MATCH(_ident, _name, _axis) { \
170 .callback = lis3lv02d_dmi_matched, \
172 DMI_MATCH(DMI_PRODUCT_NAME, _name) \
174 .driver_data = &lis3lv02d_axis_##_axis \
177 #define AXIS_DMI_MATCH2(_ident, _class1, _name1, \
181 .callback = lis3lv02d_dmi_matched, \
183 DMI_MATCH(DMI_##_class1, _name1), \
184 DMI_MATCH(DMI_##_class2, _name2), \
186 .driver_data = &lis3lv02d_axis_##_axis \
188 static struct dmi_system_id lis3lv02d_dmi_ids
[] = {
189 /* product names are truncated to match all kinds of a same model */
190 AXIS_DMI_MATCH("NC64x0", "HP Compaq nc64", x_inverted
),
191 AXIS_DMI_MATCH("NC84x0", "HP Compaq nc84", z_inverted
),
192 AXIS_DMI_MATCH("NX9420", "HP Compaq nx9420", x_inverted
),
193 AXIS_DMI_MATCH("NW9440", "HP Compaq nw9440", x_inverted
),
194 AXIS_DMI_MATCH("NC2510", "HP Compaq 2510", y_inverted
),
195 AXIS_DMI_MATCH("NC2710", "HP Compaq 2710", xy_swap
),
196 AXIS_DMI_MATCH("NC8510", "HP Compaq 8510", xy_swap_inverted
),
197 AXIS_DMI_MATCH("HP2133", "HP 2133", xy_rotated_left
),
198 AXIS_DMI_MATCH("HP2140", "HP 2140", xy_swap_inverted
),
199 AXIS_DMI_MATCH("NC653x", "HP Compaq 653", xy_rotated_left_usd
),
200 AXIS_DMI_MATCH("NC6730b", "HP Compaq 6730b", xy_rotated_left_usd
),
201 AXIS_DMI_MATCH("NC6730s", "HP Compaq 6730s", xy_swap
),
202 AXIS_DMI_MATCH("NC651xx", "HP Compaq 651", xy_rotated_right
),
203 AXIS_DMI_MATCH("NC6710x", "HP Compaq 6710", xy_swap_yz_inverted
),
204 AXIS_DMI_MATCH("NC6715x", "HP Compaq 6715", y_inverted
),
205 AXIS_DMI_MATCH("NC693xx", "HP EliteBook 693", xy_rotated_right
),
206 AXIS_DMI_MATCH("NC693xx", "HP EliteBook 853", xy_swap
),
207 /* Intel-based HP Pavilion dv5 */
208 AXIS_DMI_MATCH2("HPDV5_I",
209 PRODUCT_NAME
, "HP Pavilion dv5",
212 /* AMD-based HP Pavilion dv5 */
213 AXIS_DMI_MATCH2("HPDV5_A",
214 PRODUCT_NAME
, "HP Pavilion dv5",
217 AXIS_DMI_MATCH("DV7", "HP Pavilion dv7", x_inverted
),
218 AXIS_DMI_MATCH("HP8710", "HP Compaq 8710", y_inverted
),
219 AXIS_DMI_MATCH("HDX18", "HP HDX 18", x_inverted
),
221 /* Laptop models without axis info (yet):
222 * "NC6910" "HP Compaq 6910"
223 * "NC2400" "HP Compaq nc2400"
224 * "NX74x0" "HP Compaq nx74"
225 * "NX6325" "HP Compaq nx6325"
226 * "NC4400" "HP Compaq nc4400"
230 static void hpled_set(struct delayed_led_classdev
*led_cdev
, enum led_brightness value
)
232 struct acpi_device
*dev
= lis3_dev
.bus_priv
;
233 unsigned long long ret
; /* Not used when writing */
234 union acpi_object in_obj
[1];
235 struct acpi_object_list args
= { 1, in_obj
};
237 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
238 in_obj
[0].integer
.value
= !!value
;
240 acpi_evaluate_integer(dev
->handle
, "ALED", &args
, &ret
);
243 static struct delayed_led_classdev hpled_led
= {
245 .name
= "hp::hddprotect",
246 .default_trigger
= "none",
247 .brightness_set
= delayed_sysfs_set
,
248 .flags
= LED_CORE_SUSPENDRESUME
,
250 .set_brightness
= hpled_set
,
254 lis3lv02d_get_resource(struct acpi_resource
*resource
, void *context
)
256 if (resource
->type
== ACPI_RESOURCE_TYPE_EXTENDED_IRQ
) {
257 struct acpi_resource_extended_irq
*irq
;
258 u32
*device_irq
= context
;
260 irq
= &resource
->data
.extended_irq
;
261 *device_irq
= irq
->interrupts
[0];
267 static void lis3lv02d_enum_resources(struct acpi_device
*device
)
271 status
= acpi_walk_resources(device
->handle
, METHOD_NAME__CRS
,
272 lis3lv02d_get_resource
, &lis3_dev
.irq
);
273 if (ACPI_FAILURE(status
))
274 printk(KERN_DEBUG DRIVER_NAME
": Error getting resources\n");
277 static int lis3lv02d_add(struct acpi_device
*device
)
284 lis3_dev
.bus_priv
= device
;
285 lis3_dev
.init
= lis3lv02d_acpi_init
;
286 lis3_dev
.read
= lis3lv02d_acpi_read
;
287 lis3_dev
.write
= lis3lv02d_acpi_write
;
288 strcpy(acpi_device_name(device
), DRIVER_NAME
);
289 strcpy(acpi_device_class(device
), ACPI_MDPS_CLASS
);
290 device
->driver_data
= &lis3_dev
;
292 /* obtain IRQ number of our device from ACPI */
293 lis3lv02d_enum_resources(device
);
295 /* If possible use a "standard" axes order */
296 if (dmi_check_system(lis3lv02d_dmi_ids
) == 0) {
297 printk(KERN_INFO DRIVER_NAME
": laptop model unknown, "
298 "using default axes configuration\n");
299 lis3_dev
.ac
= lis3lv02d_axis_normal
;
302 /* call the core layer do its init */
303 ret
= lis3lv02d_init_device(&lis3_dev
);
307 INIT_WORK(&hpled_led
.work
, delayed_set_status_worker
);
308 ret
= led_classdev_register(NULL
, &hpled_led
.led_classdev
);
310 lis3lv02d_joystick_disable();
311 lis3lv02d_poweroff(&lis3_dev
);
312 flush_work(&hpled_led
.work
);
319 static int lis3lv02d_remove(struct acpi_device
*device
, int type
)
324 lis3lv02d_joystick_disable();
325 lis3lv02d_poweroff(&lis3_dev
);
327 flush_work(&hpled_led
.work
);
328 led_classdev_unregister(&hpled_led
.led_classdev
);
330 return lis3lv02d_remove_fs(&lis3_dev
);
335 static int lis3lv02d_suspend(struct acpi_device
*device
, pm_message_t state
)
337 /* make sure the device is off when we suspend */
338 lis3lv02d_poweroff(&lis3_dev
);
342 static int lis3lv02d_resume(struct acpi_device
*device
)
344 lis3lv02d_poweron(&lis3_dev
);
348 #define lis3lv02d_suspend NULL
349 #define lis3lv02d_resume NULL
352 /* For the HP MDPS aka 3D Driveguard */
353 static struct acpi_driver lis3lv02d_driver
= {
355 .class = ACPI_MDPS_CLASS
,
356 .ids
= lis3lv02d_device_ids
,
358 .add
= lis3lv02d_add
,
359 .remove
= lis3lv02d_remove
,
360 .suspend
= lis3lv02d_suspend
,
361 .resume
= lis3lv02d_resume
,
365 static int __init
lis3lv02d_init_module(void)
372 ret
= acpi_bus_register_driver(&lis3lv02d_driver
);
376 printk(KERN_INFO DRIVER_NAME
" driver loaded.\n");
381 static void __exit
lis3lv02d_exit_module(void)
383 acpi_bus_unregister_driver(&lis3lv02d_driver
);
386 MODULE_DESCRIPTION("Glue between LIS3LV02Dx and HP ACPI BIOS and support for disk protection LED.");
387 MODULE_AUTHOR("Yan Burman, Eric Piel, Pavel Machek");
388 MODULE_LICENSE("GPL");
390 module_init(lis3lv02d_init_module
);
391 module_exit(lis3lv02d_exit_module
);