1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * hp_accel.c - Interface between LIS3LV02DL driver and HP ACPI BIOS
5 * Copyright (C) 2007-2008 Yan Burman
6 * Copyright (C) 2008 Eric Piel
7 * Copyright (C) 2008-2009 Pavel Machek
10 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/dmi.h>
15 #include <linux/module.h>
16 #include <linux/types.h>
17 #include <linux/platform_device.h>
18 #include <linux/interrupt.h>
19 #include <linux/delay.h>
20 #include <linux/wait.h>
21 #include <linux/poll.h>
22 #include <linux/freezer.h>
23 #include <linux/uaccess.h>
24 #include <linux/leds.h>
25 #include <linux/atomic.h>
26 #include <linux/acpi.h>
27 #include <linux/i8042.h>
28 #include <linux/serio.h>
29 #include "../../misc/lis3lv02d/lis3lv02d.h"
31 #define DRIVER_NAME "hp_accel"
32 #define ACPI_MDPS_CLASS "accelerometer"
34 /* Delayed LEDs infrastructure ------------------------------------ */
36 /* Special LED class that can defer work */
37 struct delayed_led_classdev
{
38 struct led_classdev led_classdev
;
39 struct work_struct work
;
40 enum led_brightness new_brightness
;
42 unsigned int led
; /* For driver */
43 void (*set_brightness
)(struct delayed_led_classdev
*data
, enum led_brightness value
);
46 static inline void delayed_set_status_worker(struct work_struct
*work
)
48 struct delayed_led_classdev
*data
=
49 container_of(work
, struct delayed_led_classdev
, work
);
51 data
->set_brightness(data
, data
->new_brightness
);
54 static inline void delayed_sysfs_set(struct led_classdev
*led_cdev
,
55 enum led_brightness brightness
)
57 struct delayed_led_classdev
*data
= container_of(led_cdev
,
58 struct delayed_led_classdev
, led_classdev
);
59 data
->new_brightness
= brightness
;
60 schedule_work(&data
->work
);
63 /* HP-specific accelerometer driver ------------------------------------ */
65 /* e0 25, e0 26, e0 27, e0 28 are scan codes that the accelerometer with acpi id
66 * HPQ6000 sends through the keyboard bus */
72 /* For automatic insertion of the module */
73 static const struct acpi_device_id lis3lv02d_device_ids
[] = {
74 {"HPQ0004", 0}, /* HP Mobile Data Protection System PNP */
75 {"HPQ6000", 0}, /* HP Mobile Data Protection System PNP */
76 {"HPQ6007", 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 static int lis3lv02d_acpi_init(struct lis3lv02d
*lis3
)
90 struct acpi_device
*dev
= lis3
->bus_priv
;
91 if (!lis3
->init_required
)
94 if (acpi_evaluate_object(dev
->handle
, METHOD_NAME__INI
,
102 * lis3lv02d_acpi_read - ACPI ALRD method: read a register
103 * @lis3: pointer to the device struct
104 * @reg: the register to read
105 * @ret: result of the operation
107 * Returns 0 on success.
109 static int lis3lv02d_acpi_read(struct lis3lv02d
*lis3
, int reg
, u8
*ret
)
111 struct acpi_device
*dev
= lis3
->bus_priv
;
112 union acpi_object arg0
= { ACPI_TYPE_INTEGER
};
113 struct acpi_object_list args
= { 1, &arg0
};
114 unsigned long long lret
;
117 arg0
.integer
.value
= reg
;
119 status
= acpi_evaluate_integer(dev
->handle
, "ALRD", &args
, &lret
);
120 if (ACPI_FAILURE(status
))
127 * lis3lv02d_acpi_write - ACPI ALWR method: write to a register
128 * @lis3: pointer to the device struct
129 * @reg: the register to write to
130 * @val: the value to write
132 * Returns 0 on success.
134 static int lis3lv02d_acpi_write(struct lis3lv02d
*lis3
, int reg
, u8 val
)
136 struct acpi_device
*dev
= lis3
->bus_priv
;
137 unsigned long long ret
; /* Not used when writting */
138 union acpi_object in_obj
[2];
139 struct acpi_object_list args
= { 2, in_obj
};
141 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
142 in_obj
[0].integer
.value
= reg
;
143 in_obj
[1].type
= ACPI_TYPE_INTEGER
;
144 in_obj
[1].integer
.value
= val
;
146 if (acpi_evaluate_integer(dev
->handle
, "ALWR", &args
, &ret
) != AE_OK
)
152 static int lis3lv02d_dmi_matched(const struct dmi_system_id
*dmi
)
154 lis3_dev
.ac
= *((union axis_conversion
*)dmi
->driver_data
);
155 pr_info("hardware type %s found\n", dmi
->ident
);
160 /* Represents, for each axis seen by userspace, the corresponding hw axis (+1).
161 * If the value is negative, the opposite of the hw value is used. */
162 #define DEFINE_CONV(name, x, y, z) \
163 static union axis_conversion lis3lv02d_axis_##name = \
164 { .as_array = { x, y, z } }
165 DEFINE_CONV(normal
, 1, 2, 3);
166 DEFINE_CONV(y_inverted
, 1, -2, 3);
167 DEFINE_CONV(x_inverted
, -1, 2, 3);
168 DEFINE_CONV(x_inverted_usd
, -1, 2, -3);
169 DEFINE_CONV(z_inverted
, 1, 2, -3);
170 DEFINE_CONV(xy_swap
, 2, 1, 3);
171 DEFINE_CONV(xy_rotated_left
, -2, 1, 3);
172 DEFINE_CONV(xy_rotated_left_usd
, -2, 1, -3);
173 DEFINE_CONV(xy_swap_inverted
, -2, -1, 3);
174 DEFINE_CONV(xy_rotated_right
, 2, -1, 3);
175 DEFINE_CONV(xy_swap_yz_inverted
, 2, -1, -3);
177 #define AXIS_DMI_MATCH(_ident, _name, _axis) { \
179 .callback = lis3lv02d_dmi_matched, \
181 DMI_MATCH(DMI_PRODUCT_NAME, _name) \
183 .driver_data = &lis3lv02d_axis_##_axis \
186 #define AXIS_DMI_MATCH2(_ident, _class1, _name1, \
190 .callback = lis3lv02d_dmi_matched, \
192 DMI_MATCH(DMI_##_class1, _name1), \
193 DMI_MATCH(DMI_##_class2, _name2), \
195 .driver_data = &lis3lv02d_axis_##_axis \
197 static const struct dmi_system_id lis3lv02d_dmi_ids
[] = {
198 /* product names are truncated to match all kinds of a same model */
199 AXIS_DMI_MATCH("NC64x0", "HP Compaq nc64", x_inverted
),
200 AXIS_DMI_MATCH("NC84x0", "HP Compaq nc84", z_inverted
),
201 AXIS_DMI_MATCH("NX9420", "HP Compaq nx9420", x_inverted
),
202 AXIS_DMI_MATCH("NW9440", "HP Compaq nw9440", x_inverted
),
203 AXIS_DMI_MATCH("NC2510", "HP Compaq 2510", y_inverted
),
204 AXIS_DMI_MATCH("NC2710", "HP Compaq 2710", xy_swap
),
205 AXIS_DMI_MATCH("NC8510", "HP Compaq 8510", xy_swap_inverted
),
206 AXIS_DMI_MATCH("HP2133", "HP 2133", xy_rotated_left
),
207 AXIS_DMI_MATCH("HP2140", "HP 2140", xy_swap_inverted
),
208 AXIS_DMI_MATCH("NC653x", "HP Compaq 653", xy_rotated_left_usd
),
209 AXIS_DMI_MATCH("NC6730b", "HP Compaq 6730b", xy_rotated_left_usd
),
210 AXIS_DMI_MATCH("NC6730s", "HP Compaq 6730s", xy_swap
),
211 AXIS_DMI_MATCH("NC651xx", "HP Compaq 651", xy_rotated_right
),
212 AXIS_DMI_MATCH("NC6710x", "HP Compaq 6710", xy_swap_yz_inverted
),
213 AXIS_DMI_MATCH("NC6715x", "HP Compaq 6715", y_inverted
),
214 AXIS_DMI_MATCH("NC693xx", "HP EliteBook 693", xy_rotated_right
),
215 AXIS_DMI_MATCH("NC693xx", "HP EliteBook 853", xy_swap
),
216 AXIS_DMI_MATCH("NC854xx", "HP EliteBook 854", y_inverted
),
217 AXIS_DMI_MATCH("NC273xx", "HP EliteBook 273", y_inverted
),
218 /* Intel-based HP Pavilion dv5 */
219 AXIS_DMI_MATCH2("HPDV5_I",
220 PRODUCT_NAME
, "HP Pavilion dv5",
223 /* AMD-based HP Pavilion dv5 */
224 AXIS_DMI_MATCH2("HPDV5_A",
225 PRODUCT_NAME
, "HP Pavilion dv5",
228 AXIS_DMI_MATCH("DV7", "HP Pavilion dv7", x_inverted
),
229 AXIS_DMI_MATCH("HP8710", "HP Compaq 8710", y_inverted
),
230 AXIS_DMI_MATCH("HDX18", "HP HDX 18", x_inverted
),
231 AXIS_DMI_MATCH("HPB432x", "HP ProBook 432", xy_rotated_left
),
232 AXIS_DMI_MATCH("HPB440G3", "HP ProBook 440 G3", x_inverted_usd
),
233 AXIS_DMI_MATCH("HPB440G4", "HP ProBook 440 G4", x_inverted
),
234 AXIS_DMI_MATCH("HPB442x", "HP ProBook 442", xy_rotated_left
),
235 AXIS_DMI_MATCH("HPB450G0", "HP ProBook 450 G0", x_inverted
),
236 AXIS_DMI_MATCH("HPB452x", "HP ProBook 452", y_inverted
),
237 AXIS_DMI_MATCH("HPB522x", "HP ProBook 522", xy_swap
),
238 AXIS_DMI_MATCH("HPB532x", "HP ProBook 532", y_inverted
),
239 AXIS_DMI_MATCH("HPB655x", "HP ProBook 655", xy_swap_inverted
),
240 AXIS_DMI_MATCH("Mini510x", "HP Mini 510", xy_rotated_left_usd
),
241 AXIS_DMI_MATCH("HPB63xx", "HP ProBook 63", xy_swap
),
242 AXIS_DMI_MATCH("HPB64xx", "HP ProBook 64", xy_swap
),
243 AXIS_DMI_MATCH("HPB64xx", "HP EliteBook 84", xy_swap
),
244 AXIS_DMI_MATCH("HPB65xx", "HP ProBook 65", x_inverted
),
245 AXIS_DMI_MATCH("HPZBook15", "HP ZBook 15", x_inverted
),
246 AXIS_DMI_MATCH("HPZBook17G5", "HP ZBook 17 G5", x_inverted
),
247 AXIS_DMI_MATCH("HPZBook17", "HP ZBook 17", xy_swap_yz_inverted
),
249 /* Laptop models without axis info (yet):
250 * "NC6910" "HP Compaq 6910"
251 * "NC2400" "HP Compaq nc2400"
252 * "NX74x0" "HP Compaq nx74"
253 * "NX6325" "HP Compaq nx6325"
254 * "NC4400" "HP Compaq nc4400"
258 static void hpled_set(struct delayed_led_classdev
*led_cdev
, enum led_brightness value
)
260 struct acpi_device
*dev
= lis3_dev
.bus_priv
;
261 unsigned long long ret
; /* Not used when writing */
262 union acpi_object in_obj
[1];
263 struct acpi_object_list args
= { 1, in_obj
};
265 in_obj
[0].type
= ACPI_TYPE_INTEGER
;
266 in_obj
[0].integer
.value
= !!value
;
268 acpi_evaluate_integer(dev
->handle
, "ALED", &args
, &ret
);
271 static struct delayed_led_classdev hpled_led
= {
273 .name
= "hp::hddprotect",
274 .default_trigger
= "none",
275 .brightness_set
= delayed_sysfs_set
,
276 .flags
= LED_CORE_SUSPENDRESUME
,
278 .set_brightness
= hpled_set
,
282 lis3lv02d_get_resource(struct acpi_resource
*resource
, void *context
)
284 if (resource
->type
== ACPI_RESOURCE_TYPE_EXTENDED_IRQ
) {
285 struct acpi_resource_extended_irq
*irq
;
286 u32
*device_irq
= context
;
288 irq
= &resource
->data
.extended_irq
;
289 *device_irq
= irq
->interrupts
[0];
295 static void lis3lv02d_enum_resources(struct acpi_device
*device
)
299 status
= acpi_walk_resources(device
->handle
, METHOD_NAME__CRS
,
300 lis3lv02d_get_resource
, &lis3_dev
.irq
);
301 if (ACPI_FAILURE(status
))
302 printk(KERN_DEBUG DRIVER_NAME
": Error getting resources\n");
305 static bool hp_accel_i8042_filter(unsigned char data
, unsigned char str
,
308 static bool extended
;
310 if (str
& I8042_STR_AUXDATA
)
316 } else if (unlikely(extended
)) {
326 serio_interrupt(port
, 0xe0, 0);
334 static int lis3lv02d_add(struct acpi_device
*device
)
341 lis3_dev
.bus_priv
= device
;
342 lis3_dev
.init
= lis3lv02d_acpi_init
;
343 lis3_dev
.read
= lis3lv02d_acpi_read
;
344 lis3_dev
.write
= lis3lv02d_acpi_write
;
345 strcpy(acpi_device_name(device
), DRIVER_NAME
);
346 strcpy(acpi_device_class(device
), ACPI_MDPS_CLASS
);
347 device
->driver_data
= &lis3_dev
;
349 /* obtain IRQ number of our device from ACPI */
350 lis3lv02d_enum_resources(device
);
352 /* If possible use a "standard" axes order */
353 if (lis3_dev
.ac
.x
&& lis3_dev
.ac
.y
&& lis3_dev
.ac
.z
) {
354 pr_info("Using custom axes %d,%d,%d\n",
355 lis3_dev
.ac
.x
, lis3_dev
.ac
.y
, lis3_dev
.ac
.z
);
356 } else if (dmi_check_system(lis3lv02d_dmi_ids
) == 0) {
357 pr_info("laptop model unknown, using default axes configuration\n");
358 lis3_dev
.ac
= lis3lv02d_axis_normal
;
361 /* call the core layer do its init */
362 lis3_dev
.init_required
= true;
363 ret
= lis3lv02d_init_device(&lis3_dev
);
367 /* filter to remove HPQ6000 accelerometer data
368 * from keyboard bus stream */
369 if (strstr(dev_name(&device
->dev
), "HPQ6000"))
370 i8042_install_filter(hp_accel_i8042_filter
);
372 INIT_WORK(&hpled_led
.work
, delayed_set_status_worker
);
373 ret
= led_classdev_register(NULL
, &hpled_led
.led_classdev
);
375 lis3lv02d_joystick_disable(&lis3_dev
);
376 lis3lv02d_poweroff(&lis3_dev
);
377 flush_work(&hpled_led
.work
);
384 static int lis3lv02d_remove(struct acpi_device
*device
)
389 i8042_remove_filter(hp_accel_i8042_filter
);
390 lis3lv02d_joystick_disable(&lis3_dev
);
391 lis3lv02d_poweroff(&lis3_dev
);
393 led_classdev_unregister(&hpled_led
.led_classdev
);
394 flush_work(&hpled_led
.work
);
396 return lis3lv02d_remove_fs(&lis3_dev
);
400 #ifdef CONFIG_PM_SLEEP
401 static int lis3lv02d_suspend(struct device
*dev
)
403 /* make sure the device is off when we suspend */
404 lis3lv02d_poweroff(&lis3_dev
);
408 static int lis3lv02d_resume(struct device
*dev
)
410 lis3_dev
.init_required
= false;
411 lis3lv02d_poweron(&lis3_dev
);
415 static int lis3lv02d_restore(struct device
*dev
)
417 lis3_dev
.init_required
= true;
418 lis3lv02d_poweron(&lis3_dev
);
422 static const struct dev_pm_ops hp_accel_pm
= {
423 .suspend
= lis3lv02d_suspend
,
424 .resume
= lis3lv02d_resume
,
425 .freeze
= lis3lv02d_suspend
,
426 .thaw
= lis3lv02d_resume
,
427 .poweroff
= lis3lv02d_suspend
,
428 .restore
= lis3lv02d_restore
,
431 #define HP_ACCEL_PM (&hp_accel_pm)
433 #define HP_ACCEL_PM NULL
436 /* For the HP MDPS aka 3D Driveguard */
437 static struct acpi_driver lis3lv02d_driver
= {
439 .class = ACPI_MDPS_CLASS
,
440 .ids
= lis3lv02d_device_ids
,
442 .add
= lis3lv02d_add
,
443 .remove
= lis3lv02d_remove
,
445 .drv
.pm
= HP_ACCEL_PM
,
447 module_acpi_driver(lis3lv02d_driver
);
449 MODULE_DESCRIPTION("Glue between LIS3LV02Dx and HP ACPI BIOS and support for disk protection LED.");
450 MODULE_AUTHOR("Yan Burman, Eric Piel, Pavel Machek");
451 MODULE_LICENSE("GPL");