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