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_rotated_left
= {-2, 1, 3};
162 static struct axis_conversion lis3lv02d_axis_xy_rotated_left_usd
= {-2, 1, -3};
163 static struct axis_conversion lis3lv02d_axis_xy_swap_inverted
= {-2, -1, 3};
164 static struct axis_conversion lis3lv02d_axis_xy_rotated_right
= {2, -1, 3};
165 static struct axis_conversion lis3lv02d_axis_xy_swap_yz_inverted
= {2, -1, -3};
167 #define AXIS_DMI_MATCH(_ident, _name, _axis) { \
169 .callback = lis3lv02d_dmi_matched, \
171 DMI_MATCH(DMI_PRODUCT_NAME, _name) \
173 .driver_data = &lis3lv02d_axis_##_axis \
176 #define AXIS_DMI_MATCH2(_ident, _class1, _name1, \
180 .callback = lis3lv02d_dmi_matched, \
182 DMI_MATCH(DMI_##_class1, _name1), \
183 DMI_MATCH(DMI_##_class2, _name2), \
185 .driver_data = &lis3lv02d_axis_##_axis \
187 static struct dmi_system_id lis3lv02d_dmi_ids
[] = {
188 /* product names are truncated to match all kinds of a same model */
189 AXIS_DMI_MATCH("NC64x0", "HP Compaq nc64", x_inverted
),
190 AXIS_DMI_MATCH("NC84x0", "HP Compaq nc84", z_inverted
),
191 AXIS_DMI_MATCH("NX9420", "HP Compaq nx9420", x_inverted
),
192 AXIS_DMI_MATCH("NW9440", "HP Compaq nw9440", x_inverted
),
193 AXIS_DMI_MATCH("NC2510", "HP Compaq 2510", y_inverted
),
194 AXIS_DMI_MATCH("NC8510", "HP Compaq 8510", xy_swap_inverted
),
195 AXIS_DMI_MATCH("HP2133", "HP 2133", xy_rotated_left
),
196 AXIS_DMI_MATCH("HP2140", "HP 2140", xy_swap_inverted
),
197 AXIS_DMI_MATCH("NC653x", "HP Compaq 653", xy_rotated_left_usd
),
198 AXIS_DMI_MATCH("NC673x", "HP Compaq 673", xy_rotated_left_usd
),
199 AXIS_DMI_MATCH("NC651xx", "HP Compaq 651", xy_rotated_right
),
200 AXIS_DMI_MATCH("NC671xx", "HP Compaq 671", xy_swap_yz_inverted
),
201 /* Intel-based HP Pavilion dv5 */
202 AXIS_DMI_MATCH2("HPDV5_I",
203 PRODUCT_NAME
, "HP Pavilion dv5",
206 /* AMD-based HP Pavilion dv5 */
207 AXIS_DMI_MATCH2("HPDV5_A",
208 PRODUCT_NAME
, "HP Pavilion dv5",
211 AXIS_DMI_MATCH("DV7", "HP Pavilion dv7", x_inverted
),
212 AXIS_DMI_MATCH("HP8710", "HP Compaq 8710", y_inverted
),
214 /* Laptop models without axis info (yet):
215 * "NC6910" "HP Compaq 6910"
216 * HP Compaq 8710x Notebook PC / Mobile Workstation
217 * "NC2400" "HP Compaq nc2400"
218 * "NX74x0" "HP Compaq nx74"
219 * "NX6325" "HP Compaq nx6325"
220 * "NC4400" "HP Compaq nc4400"
224 static void hpled_set(struct delayed_led_classdev
*led_cdev
, enum led_brightness value
)
226 struct acpi_device
*dev
= lis3_dev
.bus_priv
;
227 unsigned long long ret
; /* Not used when writing */
228 union acpi_object in_obj
[1];
229 struct acpi_object_list args
= { 1, in_obj
};
231 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
232 in_obj
[0].integer
.value
= !!value
;
234 acpi_evaluate_integer(dev
->handle
, "ALED", &args
, &ret
);
237 static struct delayed_led_classdev hpled_led
= {
239 .name
= "hp::hddprotect",
240 .default_trigger
= "none",
241 .brightness_set
= delayed_sysfs_set
,
242 .flags
= LED_CORE_SUSPENDRESUME
,
244 .set_brightness
= hpled_set
,
248 lis3lv02d_get_resource(struct acpi_resource
*resource
, void *context
)
250 if (resource
->type
== ACPI_RESOURCE_TYPE_EXTENDED_IRQ
) {
251 struct acpi_resource_extended_irq
*irq
;
252 u32
*device_irq
= context
;
254 irq
= &resource
->data
.extended_irq
;
255 *device_irq
= irq
->interrupts
[0];
261 static void lis3lv02d_enum_resources(struct acpi_device
*device
)
265 status
= acpi_walk_resources(device
->handle
, METHOD_NAME__CRS
,
266 lis3lv02d_get_resource
, &lis3_dev
.irq
);
267 if (ACPI_FAILURE(status
))
268 printk(KERN_DEBUG DRIVER_NAME
": Error getting resources\n");
271 static int lis3lv02d_add(struct acpi_device
*device
)
278 lis3_dev
.bus_priv
= device
;
279 lis3_dev
.init
= lis3lv02d_acpi_init
;
280 lis3_dev
.read
= lis3lv02d_acpi_read
;
281 lis3_dev
.write
= lis3lv02d_acpi_write
;
282 strcpy(acpi_device_name(device
), DRIVER_NAME
);
283 strcpy(acpi_device_class(device
), ACPI_MDPS_CLASS
);
284 device
->driver_data
= &lis3_dev
;
286 /* obtain IRQ number of our device from ACPI */
287 lis3lv02d_enum_resources(device
);
289 /* If possible use a "standard" axes order */
290 if (dmi_check_system(lis3lv02d_dmi_ids
) == 0) {
291 printk(KERN_INFO DRIVER_NAME
": laptop model unknown, "
292 "using default axes configuration\n");
293 lis3_dev
.ac
= lis3lv02d_axis_normal
;
296 /* call the core layer do its init */
297 ret
= lis3lv02d_init_device(&lis3_dev
);
301 INIT_WORK(&hpled_led
.work
, delayed_set_status_worker
);
302 ret
= led_classdev_register(NULL
, &hpled_led
.led_classdev
);
304 lis3lv02d_joystick_disable();
305 lis3lv02d_poweroff(&lis3_dev
);
306 flush_work(&hpled_led
.work
);
313 static int lis3lv02d_remove(struct acpi_device
*device
, int type
)
318 lis3lv02d_joystick_disable();
319 lis3lv02d_poweroff(&lis3_dev
);
321 flush_work(&hpled_led
.work
);
322 led_classdev_unregister(&hpled_led
.led_classdev
);
324 return lis3lv02d_remove_fs(&lis3_dev
);
329 static int lis3lv02d_suspend(struct acpi_device
*device
, pm_message_t state
)
331 /* make sure the device is off when we suspend */
332 lis3lv02d_poweroff(&lis3_dev
);
336 static int lis3lv02d_resume(struct acpi_device
*device
)
338 lis3lv02d_poweron(&lis3_dev
);
342 #define lis3lv02d_suspend NULL
343 #define lis3lv02d_resume NULL
346 /* For the HP MDPS aka 3D Driveguard */
347 static struct acpi_driver lis3lv02d_driver
= {
349 .class = ACPI_MDPS_CLASS
,
350 .ids
= lis3lv02d_device_ids
,
352 .add
= lis3lv02d_add
,
353 .remove
= lis3lv02d_remove
,
354 .suspend
= lis3lv02d_suspend
,
355 .resume
= lis3lv02d_resume
,
359 static int __init
lis3lv02d_init_module(void)
366 ret
= acpi_bus_register_driver(&lis3lv02d_driver
);
370 printk(KERN_INFO DRIVER_NAME
" driver loaded.\n");
375 static void __exit
lis3lv02d_exit_module(void)
377 acpi_bus_unregister_driver(&lis3lv02d_driver
);
380 MODULE_DESCRIPTION("Glue between LIS3LV02Dx and HP ACPI BIOS and support for disk protection LED.");
381 MODULE_AUTHOR("Yan Burman, Eric Piel, Pavel Machek");
382 MODULE_LICENSE("GPL");
384 module_init(lis3lv02d_init_module
);
385 module_exit(lis3lv02d_exit_module
);