^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * hdaps.c - driver for IBM's Hard Drive Active Protection System
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2005 Robert Love <rml@novell.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2005 Jesper Juhl <jj@chaosbits.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * The HardDisk Active Protection System (hdaps) is present in IBM ThinkPads
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * starting with the R40, T41, and X40. It provides a basic two-axis
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * accelerometer and other data, such as the device's temperature.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * This driver is based on the document by Mark A. Smith available at
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * http://www.almaden.ibm.com/cs/people/marksmith/tpaps.html and a lot of trial
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * and error.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/timer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/dmi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/jiffies.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define HDAPS_LOW_PORT 0x1600 /* first port used by hdaps */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define HDAPS_NR_PORTS 0x30 /* number of ports: 0x1600 - 0x162f */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define HDAPS_PORT_STATE 0x1611 /* device state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define HDAPS_PORT_YPOS 0x1612 /* y-axis position */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define HDAPS_PORT_XPOS 0x1614 /* x-axis position */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define HDAPS_PORT_TEMP1 0x1616 /* device temperature, in Celsius */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define HDAPS_PORT_YVAR 0x1617 /* y-axis variance (what is this?) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define HDAPS_PORT_XVAR 0x1619 /* x-axis variance (what is this?) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define HDAPS_PORT_TEMP2 0x161b /* device temperature (again?) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define HDAPS_PORT_UNKNOWN 0x161c /* what is this? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define HDAPS_PORT_KMACT 0x161d /* keyboard or mouse activity */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define STATE_FRESH 0x50 /* accelerometer data is fresh */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define KEYBD_MASK 0x20 /* set if keyboard activity */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define MOUSE_MASK 0x40 /* set if mouse activity */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define KEYBD_ISSET(n) (!! (n & KEYBD_MASK)) /* keyboard used? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define MOUSE_ISSET(n) (!! (n & MOUSE_MASK)) /* mouse used? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #define INIT_TIMEOUT_MSECS 4000 /* wait up to 4s for device init ... */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define INIT_WAIT_MSECS 200 /* ... in 200ms increments */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) #define HDAPS_POLL_INTERVAL 50 /* poll for input every 1/20s (50 ms)*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) #define HDAPS_INPUT_FUZZ 4 /* input event threshold */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) #define HDAPS_INPUT_FLAT 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) #define HDAPS_X_AXIS (1 << 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) #define HDAPS_Y_AXIS (1 << 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) #define HDAPS_BOTH_AXES (HDAPS_X_AXIS | HDAPS_Y_AXIS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) static struct platform_device *pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) static struct input_dev *hdaps_idev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) static unsigned int hdaps_invert;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static u8 km_activity;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) static int rest_x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) static int rest_y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static DEFINE_MUTEX(hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) * __get_latch - Get the value from a given port. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) static inline u8 __get_latch(u16 port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return inb(port) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * __check_latch - Check a port latch for a given value. Returns zero if the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) * port contains the given value. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static inline int __check_latch(u16 port, u8 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if (__get_latch(port) == val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) * __wait_latch - Wait up to 100us for a port latch to get a certain value,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) * returning zero if the value is obtained. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) static int __wait_latch(u16 port, u8 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) for (i = 0; i < 20; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) if (!__check_latch(port, val))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) udelay(5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) * __device_refresh - request a refresh from the accelerometer. Does not wait
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) * for refresh to complete. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) static void __device_refresh(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) udelay(200);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) if (inb(0x1604) != STATE_FRESH) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) outb(0x11, 0x1610);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) outb(0x01, 0x161f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) * __device_refresh_sync - request a synchronous refresh from the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) * accelerometer. We wait for the refresh to complete. Returns zero if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) * successful and nonzero on error. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) static int __device_refresh_sync(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) __device_refresh();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) return __wait_latch(0x1604, STATE_FRESH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) * __device_complete - indicate to the accelerometer that we are done reading
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) * data, and then initiate an async refresh. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) static inline void __device_complete(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) inb(0x161f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) inb(0x1604);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) __device_refresh();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) * hdaps_readb_one - reads a byte from a single I/O port, placing the value in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) * the given pointer. Returns zero on success or a negative error on failure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) * Can sleep.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static int hdaps_readb_one(unsigned int port, u8 *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) mutex_lock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) /* do a sync refresh -- we need to be sure that we read fresh data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) ret = __device_refresh_sync();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) *val = inb(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) __device_complete();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) mutex_unlock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* __hdaps_read_pair - internal lockless helper for hdaps_read_pair(). */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) static int __hdaps_read_pair(unsigned int port1, unsigned int port2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) int *x, int *y)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) /* do a sync refresh -- we need to be sure that we read fresh data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (__device_refresh_sync())
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) *y = inw(port2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) *x = inw(port1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) km_activity = inb(HDAPS_PORT_KMACT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) __device_complete();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) /* hdaps_invert is a bitvector to negate the axes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) if (hdaps_invert & HDAPS_X_AXIS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) *x = -*x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) if (hdaps_invert & HDAPS_Y_AXIS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) *y = -*y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) * hdaps_read_pair - reads the values from a pair of ports, placing the values
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) * in the given pointers. Returns zero on success. Can sleep.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) static int hdaps_read_pair(unsigned int port1, unsigned int port2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) int *val1, int *val2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) mutex_lock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) ret = __hdaps_read_pair(port1, port2, val1, val2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) mutex_unlock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) * hdaps_device_init - initialize the accelerometer. Returns zero on success
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) * and negative error code on failure. Can sleep.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) static int hdaps_device_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) int total, ret = -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) mutex_lock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) outb(0x13, 0x1610);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) outb(0x01, 0x161f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) if (__wait_latch(0x161f, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) * Most ThinkPads return 0x01.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) * Others--namely the R50p, T41p, and T42p--return 0x03. These laptops
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) * have "inverted" axises.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) * The 0x02 value occurs when the chip has been previously initialized.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) if (__check_latch(0x1611, 0x03) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) __check_latch(0x1611, 0x02) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) __check_latch(0x1611, 0x01))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) printk(KERN_DEBUG "hdaps: initial latch check good (0x%02x)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) __get_latch(0x1611));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) outb(0x17, 0x1610);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) outb(0x81, 0x1611);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) outb(0x01, 0x161f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if (__wait_latch(0x161f, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) if (__wait_latch(0x1611, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) if (__wait_latch(0x1612, 0x60))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (__wait_latch(0x1613, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) outb(0x14, 0x1610);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) outb(0x01, 0x1611);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) outb(0x01, 0x161f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) if (__wait_latch(0x161f, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) outb(0x10, 0x1610);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) outb(0xc8, 0x1611);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) outb(0x00, 0x1612);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) outb(0x02, 0x1613);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) outb(0x01, 0x161f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) if (__wait_latch(0x161f, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) if (__device_refresh_sync())
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) if (__wait_latch(0x1611, 0x00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) /* we have done our dance, now let's wait for the applause */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) for (total = INIT_TIMEOUT_MSECS; total > 0; total -= INIT_WAIT_MSECS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) int x, y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) /* a read of the device helps push it into action */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) __hdaps_read_pair(HDAPS_PORT_XPOS, HDAPS_PORT_YPOS, &x, &y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) if (!__wait_latch(0x1611, 0x02)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) msleep(INIT_WAIT_MSECS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) mutex_unlock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) /* Device model stuff */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) static int hdaps_probe(struct platform_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) ret = hdaps_device_init();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) pr_info("device successfully initialized\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) #ifdef CONFIG_PM_SLEEP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static int hdaps_resume(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) return hdaps_device_init();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) static SIMPLE_DEV_PM_OPS(hdaps_pm, NULL, hdaps_resume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) static struct platform_driver hdaps_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) .probe = hdaps_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) .name = "hdaps",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) .pm = &hdaps_pm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) * hdaps_calibrate - Set our "resting" values. Callers must hold hdaps_mtx.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) static void hdaps_calibrate(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) __hdaps_read_pair(HDAPS_PORT_XPOS, HDAPS_PORT_YPOS, &rest_x, &rest_y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) static void hdaps_mousedev_poll(struct input_dev *input_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) int x, y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) mutex_lock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) if (__hdaps_read_pair(HDAPS_PORT_XPOS, HDAPS_PORT_YPOS, &x, &y))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) input_report_abs(input_dev, ABS_X, x - rest_x);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) input_report_abs(input_dev, ABS_Y, y - rest_y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) input_sync(input_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) mutex_unlock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /* Sysfs Files */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) static ssize_t hdaps_position_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) int ret, x, y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) ret = hdaps_read_pair(HDAPS_PORT_XPOS, HDAPS_PORT_YPOS, &x, &y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) return sprintf(buf, "(%d,%d)\n", x, y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) static ssize_t hdaps_variance_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) int ret, x, y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) ret = hdaps_read_pair(HDAPS_PORT_XVAR, HDAPS_PORT_YVAR, &x, &y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) return sprintf(buf, "(%d,%d)\n", x, y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) static ssize_t hdaps_temp1_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) u8 temp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) ret = hdaps_readb_one(HDAPS_PORT_TEMP1, &temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) return sprintf(buf, "%u\n", temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) static ssize_t hdaps_temp2_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) u8 temp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) ret = hdaps_readb_one(HDAPS_PORT_TEMP2, &temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) return sprintf(buf, "%u\n", temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) static ssize_t hdaps_keyboard_activity_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) return sprintf(buf, "%u\n", KEYBD_ISSET(km_activity));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) static ssize_t hdaps_mouse_activity_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) return sprintf(buf, "%u\n", MOUSE_ISSET(km_activity));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) static ssize_t hdaps_calibrate_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return sprintf(buf, "(%d,%d)\n", rest_x, rest_y);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) static ssize_t hdaps_calibrate_store(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) const char *buf, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) mutex_lock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) hdaps_calibrate();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) mutex_unlock(&hdaps_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) return count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) static ssize_t hdaps_invert_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) return sprintf(buf, "%u\n", hdaps_invert);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) static ssize_t hdaps_invert_store(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) const char *buf, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) int invert;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) if (sscanf(buf, "%d", &invert) != 1 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) invert < 0 || invert > HDAPS_BOTH_AXES)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) hdaps_invert = invert;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) hdaps_calibrate();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) return count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) static DEVICE_ATTR(position, 0444, hdaps_position_show, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) static DEVICE_ATTR(variance, 0444, hdaps_variance_show, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) static DEVICE_ATTR(temp1, 0444, hdaps_temp1_show, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) static DEVICE_ATTR(temp2, 0444, hdaps_temp2_show, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) static DEVICE_ATTR(keyboard_activity, 0444, hdaps_keyboard_activity_show, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) static DEVICE_ATTR(mouse_activity, 0444, hdaps_mouse_activity_show, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) static DEVICE_ATTR(calibrate, 0644, hdaps_calibrate_show,hdaps_calibrate_store);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) static DEVICE_ATTR(invert, 0644, hdaps_invert_show, hdaps_invert_store);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) static struct attribute *hdaps_attributes[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) &dev_attr_position.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) &dev_attr_variance.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) &dev_attr_temp1.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) &dev_attr_temp2.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) &dev_attr_keyboard_activity.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) &dev_attr_mouse_activity.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) &dev_attr_calibrate.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) &dev_attr_invert.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) static struct attribute_group hdaps_attribute_group = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) .attrs = hdaps_attributes,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) /* Module stuff */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) /* hdaps_dmi_match - found a match. return one, short-circuiting the hunt. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static int __init hdaps_dmi_match(const struct dmi_system_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) pr_info("%s detected\n", id->ident);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) /* hdaps_dmi_match_invert - found an inverted match. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) static int __init hdaps_dmi_match_invert(const struct dmi_system_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) hdaps_invert = (unsigned long)id->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) pr_info("inverting axis (%u) readings\n", hdaps_invert);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) return hdaps_dmi_match(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) #define HDAPS_DMI_MATCH_INVERT(vendor, model, axes) { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) .ident = vendor " " model, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) .callback = hdaps_dmi_match_invert, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) .driver_data = (void *)axes, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) .matches = { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) DMI_MATCH(DMI_BOARD_VENDOR, vendor), \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) DMI_MATCH(DMI_PRODUCT_VERSION, model) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) } \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) #define HDAPS_DMI_MATCH_NORMAL(vendor, model) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) HDAPS_DMI_MATCH_INVERT(vendor, model, 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) /* Note that HDAPS_DMI_MATCH_NORMAL("ThinkPad T42") would match
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) "ThinkPad T42p", so the order of the entries matters.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) If your ThinkPad is not recognized, please update to latest
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) BIOS. This is especially the case for some R52 ThinkPads. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) static const struct dmi_system_id hdaps_whitelist[] __initconst = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) HDAPS_DMI_MATCH_INVERT("IBM", "ThinkPad R50p", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad R50"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad R51"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad R52"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad R61i", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad R61", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) HDAPS_DMI_MATCH_INVERT("IBM", "ThinkPad T41p", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad T41"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) HDAPS_DMI_MATCH_INVERT("IBM", "ThinkPad T42p", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad T42"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad T43"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad T400", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad T60", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad T61p", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad T61", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad X40"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) HDAPS_DMI_MATCH_INVERT("IBM", "ThinkPad X41", HDAPS_Y_AXIS),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad X60", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad X61s", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad X61", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) HDAPS_DMI_MATCH_NORMAL("IBM", "ThinkPad Z60m"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad Z61m", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) HDAPS_DMI_MATCH_INVERT("LENOVO", "ThinkPad Z61p", HDAPS_BOTH_AXES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) { .ident = NULL }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) static int __init hdaps_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) if (!dmi_check_system(hdaps_whitelist)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) pr_warn("supported laptop not found!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) ret = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) if (!request_region(HDAPS_LOW_PORT, HDAPS_NR_PORTS, "hdaps")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) ret = -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) ret = platform_driver_register(&hdaps_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) goto out_region;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) pdev = platform_device_register_simple("hdaps", -1, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) if (IS_ERR(pdev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) ret = PTR_ERR(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) goto out_driver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) ret = sysfs_create_group(&pdev->dev.kobj, &hdaps_attribute_group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) goto out_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) hdaps_idev = input_allocate_device();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) if (!hdaps_idev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) goto out_group;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) /* initial calibrate for the input device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) hdaps_calibrate();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) /* initialize the input class */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) hdaps_idev->name = "hdaps";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) hdaps_idev->phys = "isa1600/input0";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) hdaps_idev->id.bustype = BUS_ISA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) hdaps_idev->dev.parent = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) input_set_abs_params(hdaps_idev, ABS_X,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) -256, 256, HDAPS_INPUT_FUZZ, HDAPS_INPUT_FLAT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) input_set_abs_params(hdaps_idev, ABS_Y,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) -256, 256, HDAPS_INPUT_FUZZ, HDAPS_INPUT_FLAT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) ret = input_setup_polling(hdaps_idev, hdaps_mousedev_poll);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) goto out_idev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) input_set_poll_interval(hdaps_idev, HDAPS_POLL_INTERVAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) ret = input_register_device(hdaps_idev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) goto out_idev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) pr_info("driver successfully loaded\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) out_idev:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) input_free_device(hdaps_idev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) out_group:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) sysfs_remove_group(&pdev->dev.kobj, &hdaps_attribute_group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) out_device:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) platform_device_unregister(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) out_driver:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) platform_driver_unregister(&hdaps_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) out_region:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) release_region(HDAPS_LOW_PORT, HDAPS_NR_PORTS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) pr_warn("driver init failed (ret=%d)!\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) static void __exit hdaps_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) input_unregister_device(hdaps_idev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) sysfs_remove_group(&pdev->dev.kobj, &hdaps_attribute_group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) platform_device_unregister(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) platform_driver_unregister(&hdaps_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) release_region(HDAPS_LOW_PORT, HDAPS_NR_PORTS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) pr_info("driver unloaded\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) module_init(hdaps_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) module_exit(hdaps_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) module_param_named(invert, hdaps_invert, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) MODULE_PARM_DESC(invert, "invert data along each axis. 1 invert x-axis, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) "2 invert y-axis, 3 invert both axes.");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) MODULE_AUTHOR("Robert Love");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) MODULE_DESCRIPTION("IBM Hard Drive Active Protection System (HDAPS) driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags