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