Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 1 | /* |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 2 | * Apple USB Touchpad (for post-February 2005 PowerBooks and MacBooks) driver |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 3 | * |
| 4 | * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com) |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 5 | * Copyright (C) 2005-2008 Johannes Berg (johannes@sipsolutions.net) |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 6 | * Copyright (C) 2005-2008 Stelian Pop (stelian@popies.net) |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 7 | * Copyright (C) 2005 Frank Arnold (frank@scirocco-5v-turbo.de) |
| 8 | * Copyright (C) 2005 Peter Osterlund (petero2@telia.com) |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 9 | * Copyright (C) 2005 Michael Hanselmann (linux-kernel@hansmi.ch) |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 10 | * Copyright (C) 2006 Nicolas Boichat (nicolas@boichat.ch) |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 11 | * Copyright (C) 2007-2008 Sven Anders (anders@anduras.de) |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 12 | * |
| 13 | * Thanks to Alex Harper <basilisk@foobox.net> for his inputs. |
| 14 | * |
| 15 | * This program is free software; you can redistribute it and/or modify |
| 16 | * it under the terms of the GNU General Public License as published by |
| 17 | * the Free Software Foundation; either version 2 of the License, or |
| 18 | * (at your option) any later version. |
| 19 | * |
| 20 | * This program is distributed in the hope that it will be useful, |
| 21 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 22 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 23 | * GNU General Public License for more details. |
| 24 | * |
| 25 | * You should have received a copy of the GNU General Public License |
| 26 | * along with this program; if not, write to the Free Software |
| 27 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 28 | * |
| 29 | */ |
| 30 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 31 | #include <linux/kernel.h> |
| 32 | #include <linux/errno.h> |
| 33 | #include <linux/init.h> |
| 34 | #include <linux/slab.h> |
| 35 | #include <linux/module.h> |
David Brownell | ae0dadc | 2006-06-13 10:04:34 -0700 | [diff] [blame] | 36 | #include <linux/usb/input.h> |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 37 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 38 | /* |
| 39 | * Note: We try to keep the touchpad aspect ratio while still doing only |
| 40 | * simple arithmetics: |
| 41 | * 0 <= x <= (xsensors - 1) * xfact |
| 42 | * 0 <= y <= (ysensors - 1) * yfact |
| 43 | */ |
| 44 | struct atp_info { |
| 45 | int xsensors; /* number of X sensors */ |
| 46 | int xsensors_17; /* 17" models have more sensors */ |
| 47 | int ysensors; /* number of Y sensors */ |
| 48 | int xfact; /* X multiplication factor */ |
| 49 | int yfact; /* Y multiplication factor */ |
| 50 | int datalen; /* size of USB transfers */ |
| 51 | void (*callback)(struct urb *); /* callback function */ |
Sven Anders | e9542df | 2008-05-05 23:57:10 -0400 | [diff] [blame] | 52 | }; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 53 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 54 | static void atp_complete_geyser_1_2(struct urb *urb); |
| 55 | static void atp_complete_geyser_3_4(struct urb *urb); |
| 56 | |
| 57 | static const struct atp_info fountain_info = { |
| 58 | .xsensors = 16, |
| 59 | .xsensors_17 = 26, |
| 60 | .ysensors = 16, |
| 61 | .xfact = 64, |
| 62 | .yfact = 43, |
| 63 | .datalen = 81, |
| 64 | .callback = atp_complete_geyser_1_2, |
| 65 | }; |
| 66 | |
| 67 | static const struct atp_info geyser1_info = { |
| 68 | .xsensors = 16, |
| 69 | .xsensors_17 = 26, |
| 70 | .ysensors = 16, |
| 71 | .xfact = 64, |
| 72 | .yfact = 43, |
| 73 | .datalen = 81, |
| 74 | .callback = atp_complete_geyser_1_2, |
| 75 | }; |
| 76 | |
| 77 | static const struct atp_info geyser2_info = { |
| 78 | .xsensors = 15, |
| 79 | .xsensors_17 = 20, |
| 80 | .ysensors = 9, |
| 81 | .xfact = 64, |
| 82 | .yfact = 43, |
| 83 | .datalen = 64, |
| 84 | .callback = atp_complete_geyser_1_2, |
| 85 | }; |
| 86 | |
| 87 | static const struct atp_info geyser3_info = { |
| 88 | .xsensors = 20, |
| 89 | .ysensors = 10, |
| 90 | .xfact = 64, |
| 91 | .yfact = 64, |
| 92 | .datalen = 64, |
| 93 | .callback = atp_complete_geyser_3_4, |
| 94 | }; |
| 95 | |
| 96 | static const struct atp_info geyser4_info = { |
| 97 | .xsensors = 20, |
| 98 | .ysensors = 10, |
| 99 | .xfact = 64, |
| 100 | .yfact = 64, |
| 101 | .datalen = 64, |
| 102 | .callback = atp_complete_geyser_3_4, |
| 103 | }; |
| 104 | |
| 105 | #define ATP_DEVICE(prod, info) \ |
Sven Anders | e9542df | 2008-05-05 23:57:10 -0400 | [diff] [blame] | 106 | { \ |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 107 | .match_flags = USB_DEVICE_ID_MATCH_DEVICE | \ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 108 | USB_DEVICE_ID_MATCH_INT_CLASS | \ |
| 109 | USB_DEVICE_ID_MATCH_INT_PROTOCOL, \ |
Sven Anders | e9542df | 2008-05-05 23:57:10 -0400 | [diff] [blame] | 110 | .idVendor = 0x05ac, /* Apple */ \ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 111 | .idProduct = (prod), \ |
| 112 | .bInterfaceClass = 0x03, \ |
Sven Anders | e9542df | 2008-05-05 23:57:10 -0400 | [diff] [blame] | 113 | .bInterfaceProtocol = 0x02, \ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 114 | .driver_info = (unsigned long) &info, \ |
Sven Anders | e9542df | 2008-05-05 23:57:10 -0400 | [diff] [blame] | 115 | } |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 116 | |
Sven Anders | e9542df | 2008-05-05 23:57:10 -0400 | [diff] [blame] | 117 | /* |
| 118 | * Table of devices (Product IDs) that work with this driver. |
| 119 | * (The names come from Info.plist in AppleUSBTrackpad.kext, |
| 120 | * According to Info.plist Geyser IV is the same as Geyser III.) |
| 121 | */ |
| 122 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 123 | static struct usb_device_id atp_table[] = { |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 124 | /* PowerBooks Feb 2005, iBooks G4 */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 125 | ATP_DEVICE(0x020e, fountain_info), /* FOUNTAIN ANSI */ |
| 126 | ATP_DEVICE(0x020f, fountain_info), /* FOUNTAIN ISO */ |
| 127 | ATP_DEVICE(0x030a, fountain_info), /* FOUNTAIN TP ONLY */ |
| 128 | ATP_DEVICE(0x030b, geyser1_info), /* GEYSER 1 TP ONLY */ |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 129 | |
| 130 | /* PowerBooks Oct 2005 */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 131 | ATP_DEVICE(0x0214, geyser2_info), /* GEYSER 2 ANSI */ |
| 132 | ATP_DEVICE(0x0215, geyser2_info), /* GEYSER 2 ISO */ |
| 133 | ATP_DEVICE(0x0216, geyser2_info), /* GEYSER 2 JIS */ |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 134 | |
Julien BLACHE | 009ad0e | 2006-11-17 01:06:13 -0500 | [diff] [blame] | 135 | /* Core Duo MacBook & MacBook Pro */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 136 | ATP_DEVICE(0x0217, geyser3_info), /* GEYSER 3 ANSI */ |
| 137 | ATP_DEVICE(0x0218, geyser3_info), /* GEYSER 3 ISO */ |
| 138 | ATP_DEVICE(0x0219, geyser3_info), /* GEYSER 3 JIS */ |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 139 | |
Julien BLACHE | 009ad0e | 2006-11-17 01:06:13 -0500 | [diff] [blame] | 140 | /* Core2 Duo MacBook & MacBook Pro */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 141 | ATP_DEVICE(0x021a, geyser4_info), /* GEYSER 4 ANSI */ |
| 142 | ATP_DEVICE(0x021b, geyser4_info), /* GEYSER 4 ISO */ |
| 143 | ATP_DEVICE(0x021c, geyser4_info), /* GEYSER 4 JIS */ |
Julien BLACHE | 009ad0e | 2006-11-17 01:06:13 -0500 | [diff] [blame] | 144 | |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 145 | /* Core2 Duo MacBook3,1 */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 146 | ATP_DEVICE(0x0229, geyser4_info), /* GEYSER 4 HF ANSI */ |
| 147 | ATP_DEVICE(0x022a, geyser4_info), /* GEYSER 4 HF ISO */ |
| 148 | ATP_DEVICE(0x022b, geyser4_info), /* GEYSER 4 HF JIS */ |
Tobias Mueller | 0035a1d | 2008-04-02 10:02:06 -0400 | [diff] [blame] | 149 | |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 150 | /* Terminating entry */ |
| 151 | { } |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 152 | }; |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 153 | MODULE_DEVICE_TABLE(usb, atp_table); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 154 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 155 | /* maximum number of sensors */ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 156 | #define ATP_XSENSORS 26 |
| 157 | #define ATP_YSENSORS 16 |
| 158 | |
| 159 | /* amount of fuzz this touchpad generates */ |
| 160 | #define ATP_FUZZ 16 |
| 161 | |
| 162 | /* maximum pressure this driver will report */ |
| 163 | #define ATP_PRESSURE 300 |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 164 | |
| 165 | /* |
| 166 | * Threshold for the touchpad sensors. Any change less than ATP_THRESHOLD is |
| 167 | * ignored. |
| 168 | */ |
| 169 | #define ATP_THRESHOLD 5 |
| 170 | |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 171 | /* Geyser initialization constants */ |
| 172 | #define ATP_GEYSER_MODE_READ_REQUEST_ID 1 |
| 173 | #define ATP_GEYSER_MODE_WRITE_REQUEST_ID 9 |
| 174 | #define ATP_GEYSER_MODE_REQUEST_VALUE 0x300 |
| 175 | #define ATP_GEYSER_MODE_REQUEST_INDEX 0 |
| 176 | #define ATP_GEYSER_MODE_VENDOR_VALUE 0x04 |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 177 | |
Sven Anders | 82a196f | 2008-08-08 16:31:33 -0400 | [diff] [blame] | 178 | /** |
| 179 | * enum atp_status_bits - status bit meanings |
| 180 | * |
| 181 | * These constants represent the meaning of the status bits. |
| 182 | * (only Geyser 3/4) |
| 183 | * |
| 184 | * @ATP_STATUS_BUTTON: The button was pressed |
| 185 | * @ATP_STATUS_BASE_UPDATE: Update of the base values (untouched pad) |
| 186 | * @ATP_STATUS_FROM_RESET: Reset previously performed |
| 187 | */ |
| 188 | enum atp_status_bits { |
| 189 | ATP_STATUS_BUTTON = BIT(0), |
| 190 | ATP_STATUS_BASE_UPDATE = BIT(2), |
| 191 | ATP_STATUS_FROM_RESET = BIT(4), |
| 192 | }; |
| 193 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 194 | /* Structure to hold all of our device specific stuff */ |
| 195 | struct atp { |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 196 | char phys[64]; |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 197 | struct usb_device *udev; /* usb device */ |
| 198 | struct urb *urb; /* usb request block */ |
Sven Anders | 82a196f | 2008-08-08 16:31:33 -0400 | [diff] [blame] | 199 | u8 *data; /* transferred data */ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 200 | struct input_dev *input; /* input dev */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 201 | const struct atp_info *info; /* touchpad model */ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 202 | bool open; |
| 203 | bool valid; /* are the samples valid? */ |
| 204 | bool size_detect_done; |
| 205 | bool overflow_warned; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 206 | int x_old; /* last reported x/y, */ |
| 207 | int y_old; /* used for smoothing */ |
Benjamin Herrenschmidt | 6e49c1a | 2010-08-09 13:48:08 +1000 | [diff] [blame] | 208 | signed char xy_cur[ATP_XSENSORS + ATP_YSENSORS]; |
| 209 | signed char xy_old[ATP_XSENSORS + ATP_YSENSORS]; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 210 | int xy_acc[ATP_XSENSORS + ATP_YSENSORS]; |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 211 | int idlecount; /* number of empty packets */ |
| 212 | struct work_struct work; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 213 | }; |
| 214 | |
| 215 | #define dbg_dump(msg, tab) \ |
| 216 | if (debug > 1) { \ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 217 | int __i; \ |
| 218 | printk(KERN_DEBUG "appletouch: %s", msg); \ |
| 219 | for (__i = 0; __i < ATP_XSENSORS + ATP_YSENSORS; __i++) \ |
| 220 | printk(" %02x", tab[__i]); \ |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 221 | printk("\n"); \ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 222 | } |
| 223 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 224 | #define dprintk(format, a...) \ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 225 | do { \ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 226 | if (debug) \ |
| 227 | printk(KERN_DEBUG format, ##a); \ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 228 | } while (0) |
| 229 | |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 230 | MODULE_AUTHOR("Johannes Berg"); |
| 231 | MODULE_AUTHOR("Stelian Pop"); |
| 232 | MODULE_AUTHOR("Frank Arnold"); |
| 233 | MODULE_AUTHOR("Michael Hanselmann"); |
| 234 | MODULE_AUTHOR("Sven Anders"); |
| 235 | MODULE_DESCRIPTION("Apple PowerBook and MacBook USB touchpad driver"); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 236 | MODULE_LICENSE("GPL"); |
| 237 | |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 238 | /* |
| 239 | * Make the threshold a module parameter |
| 240 | */ |
| 241 | static int threshold = ATP_THRESHOLD; |
| 242 | module_param(threshold, int, 0644); |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 243 | MODULE_PARM_DESC(threshold, "Discard any change in data from a sensor" |
| 244 | " (the trackpad has many of these sensors)" |
| 245 | " less than this value."); |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 246 | |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 247 | static int debug; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 248 | module_param(debug, int, 0644); |
| 249 | MODULE_PARM_DESC(debug, "Activate debugging output"); |
| 250 | |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 251 | /* |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 252 | * By default newer Geyser devices send standard USB HID mouse |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 253 | * packets (Report ID 2). This code changes device mode, so it |
| 254 | * sends raw sensor reports (Report ID 5). |
| 255 | */ |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 256 | static int atp_geyser_init(struct atp *dev) |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 257 | { |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 258 | struct usb_device *udev = dev->udev; |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 259 | char *data; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 260 | int size; |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 261 | int i; |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 262 | int ret; |
| 263 | |
| 264 | data = kmalloc(8, GFP_KERNEL); |
| 265 | if (!data) { |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 266 | dev_err(&dev->input->dev, "Out of memory\n"); |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 267 | return -ENOMEM; |
| 268 | } |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 269 | |
| 270 | size = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 271 | ATP_GEYSER_MODE_READ_REQUEST_ID, |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 272 | USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE, |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 273 | ATP_GEYSER_MODE_REQUEST_VALUE, |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 274 | ATP_GEYSER_MODE_REQUEST_INDEX, data, 8, 5000); |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 275 | |
| 276 | if (size != 8) { |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 277 | dprintk("atp_geyser_init: read error\n"); |
| 278 | for (i = 0; i < 8; i++) |
| 279 | dprintk("appletouch[%d]: %d\n", i, data[i]); |
| 280 | |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 281 | dev_err(&dev->input->dev, "Failed to read mode from device.\n"); |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 282 | ret = -EIO; |
| 283 | goto out_free; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 284 | } |
| 285 | |
| 286 | /* Apply the mode switch */ |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 287 | data[0] = ATP_GEYSER_MODE_VENDOR_VALUE; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 288 | |
| 289 | size = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 290 | ATP_GEYSER_MODE_WRITE_REQUEST_ID, |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 291 | USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE, |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 292 | ATP_GEYSER_MODE_REQUEST_VALUE, |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 293 | ATP_GEYSER_MODE_REQUEST_INDEX, data, 8, 5000); |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 294 | |
| 295 | if (size != 8) { |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 296 | dprintk("atp_geyser_init: write error\n"); |
| 297 | for (i = 0; i < 8; i++) |
| 298 | dprintk("appletouch[%d]: %d\n", i, data[i]); |
| 299 | |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 300 | dev_err(&dev->input->dev, "Failed to request geyser raw mode\n"); |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 301 | ret = -EIO; |
| 302 | goto out_free; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 303 | } |
Bob Copeland | 0385c5e | 2009-04-28 07:49:53 -0700 | [diff] [blame] | 304 | ret = 0; |
| 305 | out_free: |
| 306 | kfree(data); |
| 307 | return ret; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 308 | } |
| 309 | |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 310 | /* |
| 311 | * Reinitialise the device. This usually stops stream of empty packets |
| 312 | * coming from it. |
| 313 | */ |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 314 | static void atp_reinit(struct work_struct *work) |
| 315 | { |
| 316 | struct atp *dev = container_of(work, struct atp, work); |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 317 | int retval; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 318 | |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 319 | dprintk("appletouch: putting appletouch to sleep (reinit)\n"); |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 320 | atp_geyser_init(dev); |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 321 | |
| 322 | retval = usb_submit_urb(dev->urb, GFP_ATOMIC); |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 323 | if (retval) |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 324 | dev_err(&dev->input->dev, |
Greg Kroah-Hartman | 9c113dc | 2012-04-25 14:48:31 -0700 | [diff] [blame] | 325 | "atp_reinit: usb_submit_urb failed with error %d\n", |
| 326 | retval); |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 327 | } |
| 328 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 329 | static int atp_calculate_abs(int *xy_sensors, int nb_sensors, int fact, |
| 330 | int *z, int *fingers) |
| 331 | { |
| 332 | int i; |
| 333 | /* values to calculate mean */ |
| 334 | int pcum = 0, psum = 0; |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 335 | int is_increasing = 0; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 336 | |
| 337 | *fingers = 0; |
| 338 | |
| 339 | for (i = 0; i < nb_sensors; i++) { |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 340 | if (xy_sensors[i] < threshold) { |
| 341 | if (is_increasing) |
| 342 | is_increasing = 0; |
| 343 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 344 | continue; |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 345 | } |
| 346 | |
| 347 | /* |
| 348 | * Makes the finger detection more versatile. For example, |
| 349 | * two fingers with no gap will be detected. Also, my |
| 350 | * tests show it less likely to have intermittent loss |
| 351 | * of multiple finger readings while moving around (scrolling). |
| 352 | * |
| 353 | * Changes the multiple finger detection to counting humps on |
| 354 | * sensors (transitions from nonincreasing to increasing) |
| 355 | * instead of counting transitions from low sensors (no |
| 356 | * finger reading) to high sensors (finger above |
| 357 | * sensor) |
| 358 | * |
| 359 | * - Jason Parekh <jasonparekh@gmail.com> |
| 360 | */ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 361 | if (i < 1 || |
| 362 | (!is_increasing && xy_sensors[i - 1] < xy_sensors[i])) { |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 363 | (*fingers)++; |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 364 | is_increasing = 1; |
Jeremy Huddleston | 05e882f | 2009-06-03 07:29:39 -0700 | [diff] [blame] | 365 | } else if (i > 0 && (xy_sensors[i - 1] - xy_sensors[i] > threshold)) { |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 366 | is_increasing = 0; |
| 367 | } |
| 368 | |
| 369 | /* |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 370 | * Subtracts threshold so a high sensor that just passes the |
| 371 | * threshold won't skew the calculated absolute coordinate. |
| 372 | * Fixes an issue where slowly moving the mouse would |
| 373 | * occasionally jump a number of pixels (slowly moving the |
| 374 | * finger makes this issue most apparent.) |
Jason Parekh | 00081d3 | 2006-11-17 01:05:58 -0500 | [diff] [blame] | 375 | */ |
| 376 | pcum += (xy_sensors[i] - threshold) * i; |
| 377 | psum += (xy_sensors[i] - threshold); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 378 | } |
| 379 | |
| 380 | if (psum > 0) { |
| 381 | *z = psum; |
| 382 | return pcum * fact / psum; |
| 383 | } |
| 384 | |
| 385 | return 0; |
| 386 | } |
| 387 | |
| 388 | static inline void atp_report_fingers(struct input_dev *input, int fingers) |
| 389 | { |
| 390 | input_report_key(input, BTN_TOOL_FINGER, fingers == 1); |
| 391 | input_report_key(input, BTN_TOOL_DOUBLETAP, fingers == 2); |
| 392 | input_report_key(input, BTN_TOOL_TRIPLETAP, fingers > 2); |
| 393 | } |
| 394 | |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 395 | /* Check URB status and for correct length of data package */ |
| 396 | |
| 397 | #define ATP_URB_STATUS_SUCCESS 0 |
| 398 | #define ATP_URB_STATUS_ERROR 1 |
| 399 | #define ATP_URB_STATUS_ERROR_FATAL 2 |
| 400 | |
| 401 | static int atp_status_check(struct urb *urb) |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 402 | { |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 403 | struct atp *dev = urb->context; |
Greg Kroah-Hartman | 67946d1 | 2012-05-01 21:33:04 -0700 | [diff] [blame^] | 404 | struct input_dev *idev = dev->input; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 405 | |
| 406 | switch (urb->status) { |
| 407 | case 0: |
| 408 | /* success */ |
| 409 | break; |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 410 | case -EOVERFLOW: |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 411 | if (!dev->overflow_warned) { |
Greg Kroah-Hartman | 67946d1 | 2012-05-01 21:33:04 -0700 | [diff] [blame^] | 412 | dev_warn(&idev->dev, |
| 413 | "appletouch: OVERFLOW with data length %d, actual length is %d\n", |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 414 | dev->info->datalen, dev->urb->actual_length); |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 415 | dev->overflow_warned = true; |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 416 | } |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 417 | case -ECONNRESET: |
| 418 | case -ENOENT: |
| 419 | case -ESHUTDOWN: |
| 420 | /* This urb is terminated, clean up */ |
Greg Kroah-Hartman | 67946d1 | 2012-05-01 21:33:04 -0700 | [diff] [blame^] | 421 | dev_dbg(&idev->dev, |
| 422 | "atp_complete: urb shutting down with status: %d\n", |
| 423 | urb->status); |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 424 | return ATP_URB_STATUS_ERROR_FATAL; |
| 425 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 426 | default: |
Greg Kroah-Hartman | 67946d1 | 2012-05-01 21:33:04 -0700 | [diff] [blame^] | 427 | dev_dbg(&idev->dev, |
| 428 | "atp_complete: nonzero urb status received: %d\n", |
| 429 | urb->status); |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 430 | return ATP_URB_STATUS_ERROR; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 431 | } |
| 432 | |
| 433 | /* drop incomplete datasets */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 434 | if (dev->urb->actual_length != dev->info->datalen) { |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 435 | dprintk("appletouch: incomplete data package" |
| 436 | " (first byte: %d, length: %d).\n", |
| 437 | dev->data[0], dev->urb->actual_length); |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 438 | return ATP_URB_STATUS_ERROR; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 439 | } |
| 440 | |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 441 | return ATP_URB_STATUS_SUCCESS; |
| 442 | } |
| 443 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 444 | static void atp_detect_size(struct atp *dev) |
| 445 | { |
| 446 | int i; |
| 447 | |
| 448 | /* 17" Powerbooks have extra X sensors */ |
| 449 | for (i = dev->info->xsensors; i < ATP_XSENSORS; i++) { |
| 450 | if (dev->xy_cur[i]) { |
| 451 | |
Greg Kroah-Hartman | 67946d1 | 2012-05-01 21:33:04 -0700 | [diff] [blame^] | 452 | dev_info(&dev->input->dev, |
| 453 | "appletouch: 17\" model detected.\n"); |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 454 | |
| 455 | input_set_abs_params(dev->input, ABS_X, 0, |
| 456 | (dev->info->xsensors_17 - 1) * |
| 457 | dev->info->xfact - 1, |
| 458 | ATP_FUZZ, 0); |
| 459 | break; |
| 460 | } |
| 461 | } |
| 462 | } |
| 463 | |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 464 | /* |
| 465 | * USB interrupt callback functions |
| 466 | */ |
| 467 | |
| 468 | /* Interrupt function for older touchpads: FOUNTAIN/GEYSER1/GEYSER2 */ |
| 469 | |
| 470 | static void atp_complete_geyser_1_2(struct urb *urb) |
| 471 | { |
| 472 | int x, y, x_z, y_z, x_f, y_f; |
| 473 | int retval, i, j; |
| 474 | int key; |
| 475 | struct atp *dev = urb->context; |
| 476 | int status = atp_status_check(urb); |
| 477 | |
| 478 | if (status == ATP_URB_STATUS_ERROR_FATAL) |
| 479 | return; |
| 480 | else if (status == ATP_URB_STATUS_ERROR) |
| 481 | goto exit; |
| 482 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 483 | /* reorder the sensors values */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 484 | if (dev->info == &geyser2_info) { |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 485 | memset(dev->xy_cur, 0, sizeof(dev->xy_cur)); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 486 | |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 487 | /* |
| 488 | * The values are laid out like this: |
| 489 | * Y1, Y2, -, Y3, Y4, -, ..., X1, X2, -, X3, X4, -, ... |
| 490 | * '-' is an unused value. |
| 491 | */ |
| 492 | |
| 493 | /* read X values */ |
| 494 | for (i = 0, j = 19; i < 20; i += 2, j += 3) { |
| 495 | dev->xy_cur[i] = dev->data[j]; |
| 496 | dev->xy_cur[i + 1] = dev->data[j + 1]; |
| 497 | } |
| 498 | |
| 499 | /* read Y values */ |
| 500 | for (i = 0, j = 1; i < 9; i += 2, j += 3) { |
| 501 | dev->xy_cur[ATP_XSENSORS + i] = dev->data[j]; |
| 502 | dev->xy_cur[ATP_XSENSORS + i + 1] = dev->data[j + 1]; |
| 503 | } |
| 504 | } else { |
| 505 | for (i = 0; i < 8; i++) { |
| 506 | /* X values */ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 507 | dev->xy_cur[i + 0] = dev->data[5 * i + 2]; |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 508 | dev->xy_cur[i + 8] = dev->data[5 * i + 4]; |
| 509 | dev->xy_cur[i + 16] = dev->data[5 * i + 42]; |
| 510 | if (i < 2) |
| 511 | dev->xy_cur[i + 24] = dev->data[5 * i + 44]; |
| 512 | |
| 513 | /* Y values */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 514 | dev->xy_cur[ATP_XSENSORS + i] = dev->data[5 * i + 1]; |
| 515 | dev->xy_cur[ATP_XSENSORS + i + 8] = dev->data[5 * i + 3]; |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 516 | } |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 517 | } |
| 518 | |
| 519 | dbg_dump("sample", dev->xy_cur); |
| 520 | |
| 521 | if (!dev->valid) { |
| 522 | /* first sample */ |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 523 | dev->valid = true; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 524 | dev->x_old = dev->y_old = -1; |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 525 | |
| 526 | /* Store first sample */ |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 527 | memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old)); |
| 528 | |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 529 | /* Perform size detection, if not done already */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 530 | if (unlikely(!dev->size_detect_done)) { |
| 531 | atp_detect_size(dev); |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 532 | dev->size_detect_done = 1; |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 533 | goto exit; |
Michael Hanselmann | e1e02c9 | 2005-12-21 00:50:23 -0500 | [diff] [blame] | 534 | } |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 535 | } |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 536 | |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 537 | for (i = 0; i < ATP_XSENSORS + ATP_YSENSORS; i++) { |
| 538 | /* accumulate the change */ |
Benjamin Herrenschmidt | 6e49c1a | 2010-08-09 13:48:08 +1000 | [diff] [blame] | 539 | signed char change = dev->xy_old[i] - dev->xy_cur[i]; |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 540 | dev->xy_acc[i] -= change; |
| 541 | |
| 542 | /* prevent down drifting */ |
| 543 | if (dev->xy_acc[i] < 0) |
| 544 | dev->xy_acc[i] = 0; |
| 545 | } |
| 546 | |
| 547 | memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old)); |
| 548 | |
| 549 | dbg_dump("accumulator", dev->xy_acc); |
| 550 | |
| 551 | x = atp_calculate_abs(dev->xy_acc, ATP_XSENSORS, |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 552 | dev->info->xfact, &x_z, &x_f); |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 553 | y = atp_calculate_abs(dev->xy_acc + ATP_XSENSORS, ATP_YSENSORS, |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 554 | dev->info->yfact, &y_z, &y_f); |
| 555 | key = dev->data[dev->info->datalen - 1] & ATP_STATUS_BUTTON; |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 556 | |
| 557 | if (x && y) { |
| 558 | if (dev->x_old != -1) { |
| 559 | x = (dev->x_old * 3 + x) >> 2; |
| 560 | y = (dev->y_old * 3 + y) >> 2; |
| 561 | dev->x_old = x; |
| 562 | dev->y_old = y; |
| 563 | |
| 564 | if (debug > 1) |
| 565 | printk(KERN_DEBUG "appletouch: " |
| 566 | "X: %3d Y: %3d Xz: %3d Yz: %3d\n", |
| 567 | x, y, x_z, y_z); |
| 568 | |
| 569 | input_report_key(dev->input, BTN_TOUCH, 1); |
| 570 | input_report_abs(dev->input, ABS_X, x); |
| 571 | input_report_abs(dev->input, ABS_Y, y); |
| 572 | input_report_abs(dev->input, ABS_PRESSURE, |
| 573 | min(ATP_PRESSURE, x_z + y_z)); |
| 574 | atp_report_fingers(dev->input, max(x_f, y_f)); |
| 575 | } |
| 576 | dev->x_old = x; |
| 577 | dev->y_old = y; |
| 578 | |
| 579 | } else if (!x && !y) { |
| 580 | |
| 581 | dev->x_old = dev->y_old = -1; |
| 582 | input_report_key(dev->input, BTN_TOUCH, 0); |
| 583 | input_report_abs(dev->input, ABS_PRESSURE, 0); |
| 584 | atp_report_fingers(dev->input, 0); |
| 585 | |
| 586 | /* reset the accumulator on release */ |
| 587 | memset(dev->xy_acc, 0, sizeof(dev->xy_acc)); |
| 588 | } |
| 589 | |
| 590 | input_report_key(dev->input, BTN_LEFT, key); |
| 591 | input_sync(dev->input); |
| 592 | |
| 593 | exit: |
| 594 | retval = usb_submit_urb(dev->urb, GFP_ATOMIC); |
| 595 | if (retval) |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 596 | dev_err(&dev->input->dev, |
Greg Kroah-Hartman | 9c113dc | 2012-04-25 14:48:31 -0700 | [diff] [blame] | 597 | "atp_complete: usb_submit_urb failed with result %d\n", |
| 598 | retval); |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 599 | } |
| 600 | |
| 601 | /* Interrupt function for older touchpads: GEYSER3/GEYSER4 */ |
| 602 | |
| 603 | static void atp_complete_geyser_3_4(struct urb *urb) |
| 604 | { |
| 605 | int x, y, x_z, y_z, x_f, y_f; |
| 606 | int retval, i, j; |
| 607 | int key; |
| 608 | struct atp *dev = urb->context; |
| 609 | int status = atp_status_check(urb); |
| 610 | |
| 611 | if (status == ATP_URB_STATUS_ERROR_FATAL) |
| 612 | return; |
| 613 | else if (status == ATP_URB_STATUS_ERROR) |
| 614 | goto exit; |
| 615 | |
| 616 | /* Reorder the sensors values: |
| 617 | * |
| 618 | * The values are laid out like this: |
| 619 | * -, Y1, Y2, -, Y3, Y4, -, ..., -, X1, X2, -, X3, X4, ... |
| 620 | * '-' is an unused value. |
| 621 | */ |
| 622 | |
| 623 | /* read X values */ |
| 624 | for (i = 0, j = 19; i < 20; i += 2, j += 3) { |
| 625 | dev->xy_cur[i] = dev->data[j + 1]; |
| 626 | dev->xy_cur[i + 1] = dev->data[j + 2]; |
| 627 | } |
| 628 | /* read Y values */ |
| 629 | for (i = 0, j = 1; i < 9; i += 2, j += 3) { |
| 630 | dev->xy_cur[ATP_XSENSORS + i] = dev->data[j + 1]; |
| 631 | dev->xy_cur[ATP_XSENSORS + i + 1] = dev->data[j + 2]; |
| 632 | } |
| 633 | |
| 634 | dbg_dump("sample", dev->xy_cur); |
| 635 | |
Sven Anders | 82a196f | 2008-08-08 16:31:33 -0400 | [diff] [blame] | 636 | /* Just update the base values (i.e. touchpad in untouched state) */ |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 637 | if (dev->data[dev->info->datalen - 1] & ATP_STATUS_BASE_UPDATE) { |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 638 | |
Joe Perches | d745b53 | 2010-10-30 17:19:49 -0700 | [diff] [blame] | 639 | dprintk("appletouch: updated base values\n"); |
Sven Anders | 82a196f | 2008-08-08 16:31:33 -0400 | [diff] [blame] | 640 | |
| 641 | memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old)); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 642 | goto exit; |
| 643 | } |
| 644 | |
| 645 | for (i = 0; i < ATP_XSENSORS + ATP_YSENSORS; i++) { |
Sven Anders | 82a196f | 2008-08-08 16:31:33 -0400 | [diff] [blame] | 646 | /* calculate the change */ |
| 647 | dev->xy_acc[i] = dev->xy_cur[i] - dev->xy_old[i]; |
| 648 | |
| 649 | /* this is a round-robin value, so couple with that */ |
| 650 | if (dev->xy_acc[i] > 127) |
| 651 | dev->xy_acc[i] -= 256; |
| 652 | |
| 653 | if (dev->xy_acc[i] < -127) |
| 654 | dev->xy_acc[i] += 256; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 655 | |
| 656 | /* prevent down drifting */ |
| 657 | if (dev->xy_acc[i] < 0) |
| 658 | dev->xy_acc[i] = 0; |
| 659 | } |
| 660 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 661 | dbg_dump("accumulator", dev->xy_acc); |
| 662 | |
| 663 | x = atp_calculate_abs(dev->xy_acc, ATP_XSENSORS, |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 664 | dev->info->xfact, &x_z, &x_f); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 665 | y = atp_calculate_abs(dev->xy_acc + ATP_XSENSORS, ATP_YSENSORS, |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 666 | dev->info->yfact, &y_z, &y_f); |
| 667 | key = dev->data[dev->info->datalen - 1] & ATP_STATUS_BUTTON; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 668 | |
| 669 | if (x && y) { |
| 670 | if (dev->x_old != -1) { |
| 671 | x = (dev->x_old * 3 + x) >> 2; |
| 672 | y = (dev->y_old * 3 + y) >> 2; |
| 673 | dev->x_old = x; |
| 674 | dev->y_old = y; |
| 675 | |
| 676 | if (debug > 1) |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 677 | printk(KERN_DEBUG "appletouch: X: %3d Y: %3d " |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 678 | "Xz: %3d Yz: %3d\n", |
| 679 | x, y, x_z, y_z); |
| 680 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 681 | input_report_key(dev->input, BTN_TOUCH, 1); |
| 682 | input_report_abs(dev->input, ABS_X, x); |
| 683 | input_report_abs(dev->input, ABS_Y, y); |
| 684 | input_report_abs(dev->input, ABS_PRESSURE, |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 685 | min(ATP_PRESSURE, x_z + y_z)); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 686 | atp_report_fingers(dev->input, max(x_f, y_f)); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 687 | } |
| 688 | dev->x_old = x; |
| 689 | dev->y_old = y; |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 690 | |
| 691 | } else if (!x && !y) { |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 692 | |
| 693 | dev->x_old = dev->y_old = -1; |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 694 | input_report_key(dev->input, BTN_TOUCH, 0); |
| 695 | input_report_abs(dev->input, ABS_PRESSURE, 0); |
| 696 | atp_report_fingers(dev->input, 0); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 697 | |
| 698 | /* reset the accumulator on release */ |
| 699 | memset(dev->xy_acc, 0, sizeof(dev->xy_acc)); |
Soeren Sonnenburg | 937ad5c | 2007-10-13 00:31:15 -0400 | [diff] [blame] | 700 | } |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 701 | |
Anton Ekblad | 46249ea | 2007-10-22 00:59:59 -0400 | [diff] [blame] | 702 | input_report_key(dev->input, BTN_LEFT, key); |
| 703 | input_sync(dev->input); |
| 704 | |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 705 | /* |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 706 | * Geysers 3/4 will continue to send packets continually after |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 707 | * the first touch unless reinitialised. Do so if it's been |
| 708 | * idle for a while in order to avoid waking the kernel up |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 709 | * several hundred times a second. |
Dmitry Torokhov | 2a3e480 | 2007-11-01 22:13:32 -0400 | [diff] [blame] | 710 | */ |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 711 | |
| 712 | /* |
| 713 | * Button must not be pressed when entering suspend, |
| 714 | * otherwise we will never release the button. |
| 715 | */ |
| 716 | if (!x && !y && !key) { |
| 717 | dev->idlecount++; |
| 718 | if (dev->idlecount == 10) { |
Sven Anders | 82a196f | 2008-08-08 16:31:33 -0400 | [diff] [blame] | 719 | dev->x_old = dev->y_old = -1; |
| 720 | dev->idlecount = 0; |
Sven Anders | d83d213 | 2008-08-08 16:31:31 -0400 | [diff] [blame] | 721 | schedule_work(&dev->work); |
| 722 | /* Don't resubmit urb here, wait for reinit */ |
| 723 | return; |
| 724 | } |
| 725 | } else |
| 726 | dev->idlecount = 0; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 727 | |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 728 | exit: |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 729 | retval = usb_submit_urb(dev->urb, GFP_ATOMIC); |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 730 | if (retval) |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 731 | dev_err(&dev->input->dev, |
Greg Kroah-Hartman | 9c113dc | 2012-04-25 14:48:31 -0700 | [diff] [blame] | 732 | "atp_complete: usb_submit_urb failed with result %d\n", |
| 733 | retval); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 734 | } |
| 735 | |
| 736 | static int atp_open(struct input_dev *input) |
| 737 | { |
Dmitry Torokhov | 7791bda | 2007-04-12 01:34:39 -0400 | [diff] [blame] | 738 | struct atp *dev = input_get_drvdata(input); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 739 | |
| 740 | if (usb_submit_urb(dev->urb, GFP_ATOMIC)) |
| 741 | return -EIO; |
| 742 | |
| 743 | dev->open = 1; |
| 744 | return 0; |
| 745 | } |
| 746 | |
| 747 | static void atp_close(struct input_dev *input) |
| 748 | { |
Dmitry Torokhov | 7791bda | 2007-04-12 01:34:39 -0400 | [diff] [blame] | 749 | struct atp *dev = input_get_drvdata(input); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 750 | |
| 751 | usb_kill_urb(dev->urb); |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 752 | cancel_work_sync(&dev->work); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 753 | dev->open = 0; |
| 754 | } |
| 755 | |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 756 | static int atp_handle_geyser(struct atp *dev) |
| 757 | { |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 758 | if (dev->info != &fountain_info) { |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 759 | /* switch to raw sensor mode */ |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 760 | if (atp_geyser_init(dev)) |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 761 | return -EIO; |
| 762 | |
Greg Kroah-Hartman | 80f8594 | 2012-05-01 20:56:47 -0400 | [diff] [blame] | 763 | dev_info(&dev->input->dev, "Geyser mode initialized.\n"); |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 764 | } |
| 765 | |
| 766 | return 0; |
| 767 | } |
| 768 | |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 769 | static int atp_probe(struct usb_interface *iface, |
| 770 | const struct usb_device_id *id) |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 771 | { |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 772 | struct atp *dev; |
| 773 | struct input_dev *input_dev; |
| 774 | struct usb_device *udev = interface_to_usbdev(iface); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 775 | struct usb_host_interface *iface_desc; |
| 776 | struct usb_endpoint_descriptor *endpoint; |
| 777 | int int_in_endpointAddr = 0; |
Dmitry Torokhov | 5014186 | 2007-04-12 01:33:39 -0400 | [diff] [blame] | 778 | int i, error = -ENOMEM; |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 779 | const struct atp_info *info = (const struct atp_info *)id->driver_info; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 780 | |
| 781 | /* set up the endpoint information */ |
| 782 | /* use only the first interrupt-in endpoint */ |
| 783 | iface_desc = iface->cur_altsetting; |
| 784 | for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) { |
| 785 | endpoint = &iface_desc->endpoint[i].desc; |
Luiz Fernando N. Capitulino | 97b107c | 2006-09-27 11:58:53 -0700 | [diff] [blame] | 786 | if (!int_in_endpointAddr && usb_endpoint_is_int_in(endpoint)) { |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 787 | /* we found an interrupt in endpoint */ |
| 788 | int_in_endpointAddr = endpoint->bEndpointAddress; |
| 789 | break; |
| 790 | } |
| 791 | } |
| 792 | if (!int_in_endpointAddr) { |
Greg Kroah-Hartman | 9c113dc | 2012-04-25 14:48:31 -0700 | [diff] [blame] | 793 | dev_err(&iface->dev, "Could not find int-in endpoint\n"); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 794 | return -EIO; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 795 | } |
| 796 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 797 | /* allocate memory for our device state and initialize it */ |
| 798 | dev = kzalloc(sizeof(struct atp), GFP_KERNEL); |
| 799 | input_dev = input_allocate_device(); |
| 800 | if (!dev || !input_dev) { |
Greg Kroah-Hartman | 9c113dc | 2012-04-25 14:48:31 -0700 | [diff] [blame] | 801 | dev_err(&iface->dev, "Out of memory\n"); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 802 | goto err_free_devs; |
| 803 | } |
| 804 | |
| 805 | dev->udev = udev; |
| 806 | dev->input = input_dev; |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 807 | dev->info = info; |
Johannes Berg | 7dce869 | 2008-05-05 23:56:55 -0400 | [diff] [blame] | 808 | dev->overflow_warned = false; |
Nicolas Boichat | 9effa97 | 2006-04-19 23:36:40 +0200 | [diff] [blame] | 809 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 810 | dev->urb = usb_alloc_urb(0, GFP_KERNEL); |
Dmitry Torokhov | 5014186 | 2007-04-12 01:33:39 -0400 | [diff] [blame] | 811 | if (!dev->urb) |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 812 | goto err_free_devs; |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 813 | |
Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 814 | dev->data = usb_alloc_coherent(dev->udev, dev->info->datalen, GFP_KERNEL, |
| 815 | &dev->urb->transfer_dma); |
Dmitry Torokhov | 5014186 | 2007-04-12 01:33:39 -0400 | [diff] [blame] | 816 | if (!dev->data) |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 817 | goto err_free_urb; |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 818 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 819 | usb_fill_int_urb(dev->urb, udev, |
| 820 | usb_rcvintpipe(udev, int_in_endpointAddr), |
| 821 | dev->data, dev->info->datalen, |
| 822 | dev->info->callback, dev, 1); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 823 | |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 824 | error = atp_handle_geyser(dev); |
| 825 | if (error) |
| 826 | goto err_free_buffer; |
| 827 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 828 | usb_make_path(udev, dev->phys, sizeof(dev->phys)); |
| 829 | strlcat(dev->phys, "/input0", sizeof(dev->phys)); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 830 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 831 | input_dev->name = "appletouch"; |
| 832 | input_dev->phys = dev->phys; |
| 833 | usb_to_input_id(dev->udev, &input_dev->id); |
Dmitry Torokhov | c0f82d5 | 2007-04-12 01:35:03 -0400 | [diff] [blame] | 834 | input_dev->dev.parent = &iface->dev; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 835 | |
Dmitry Torokhov | 7791bda | 2007-04-12 01:34:39 -0400 | [diff] [blame] | 836 | input_set_drvdata(input_dev, dev); |
| 837 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 838 | input_dev->open = atp_open; |
| 839 | input_dev->close = atp_close; |
| 840 | |
| 841 | set_bit(EV_ABS, input_dev->evbit); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 842 | |
Stelian Pop | 0977967 | 2008-10-28 23:20:46 -0400 | [diff] [blame] | 843 | input_set_abs_params(input_dev, ABS_X, 0, |
| 844 | (dev->info->xsensors - 1) * dev->info->xfact - 1, |
| 845 | ATP_FUZZ, 0); |
| 846 | input_set_abs_params(input_dev, ABS_Y, 0, |
| 847 | (dev->info->ysensors - 1) * dev->info->yfact - 1, |
| 848 | ATP_FUZZ, 0); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 849 | input_set_abs_params(input_dev, ABS_PRESSURE, 0, ATP_PRESSURE, 0, 0); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 850 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 851 | set_bit(EV_KEY, input_dev->evbit); |
| 852 | set_bit(BTN_TOUCH, input_dev->keybit); |
| 853 | set_bit(BTN_TOOL_FINGER, input_dev->keybit); |
| 854 | set_bit(BTN_TOOL_DOUBLETAP, input_dev->keybit); |
| 855 | set_bit(BTN_TOOL_TRIPLETAP, input_dev->keybit); |
| 856 | set_bit(BTN_LEFT, input_dev->keybit); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 857 | |
Dmitry Torokhov | 5014186 | 2007-04-12 01:33:39 -0400 | [diff] [blame] | 858 | error = input_register_device(dev->input); |
| 859 | if (error) |
| 860 | goto err_free_buffer; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 861 | |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 862 | /* save our data pointer in this interface device */ |
| 863 | usb_set_intfdata(iface, dev); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 864 | |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 865 | INIT_WORK(&dev->work, atp_reinit); |
| 866 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 867 | return 0; |
| 868 | |
Dmitry Torokhov | 5014186 | 2007-04-12 01:33:39 -0400 | [diff] [blame] | 869 | err_free_buffer: |
Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 870 | usb_free_coherent(dev->udev, dev->info->datalen, |
| 871 | dev->data, dev->urb->transfer_dma); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 872 | err_free_urb: |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 873 | usb_free_urb(dev->urb); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 874 | err_free_devs: |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 875 | usb_set_intfdata(iface, NULL); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 876 | kfree(dev); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 877 | input_free_device(input_dev); |
Dmitry Torokhov | 5014186 | 2007-04-12 01:33:39 -0400 | [diff] [blame] | 878 | return error; |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 879 | } |
| 880 | |
| 881 | static void atp_disconnect(struct usb_interface *iface) |
| 882 | { |
| 883 | struct atp *dev = usb_get_intfdata(iface); |
| 884 | |
| 885 | usb_set_intfdata(iface, NULL); |
| 886 | if (dev) { |
| 887 | usb_kill_urb(dev->urb); |
Dmitry Torokhov | c5b7c7c | 2005-09-15 02:01:47 -0500 | [diff] [blame] | 888 | input_unregister_device(dev->input); |
Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 889 | usb_free_coherent(dev->udev, dev->info->datalen, |
| 890 | dev->data, dev->urb->transfer_dma); |
Johannes Berg | 7af569a | 2006-07-19 15:39:46 +0200 | [diff] [blame] | 891 | usb_free_urb(dev->urb); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 892 | kfree(dev); |
| 893 | } |
| 894 | printk(KERN_INFO "input: appletouch disconnected\n"); |
| 895 | } |
| 896 | |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 897 | static int atp_recover(struct atp *dev) |
| 898 | { |
| 899 | int error; |
| 900 | |
| 901 | error = atp_handle_geyser(dev); |
| 902 | if (error) |
| 903 | return error; |
| 904 | |
| 905 | if (dev->open && usb_submit_urb(dev->urb, GFP_ATOMIC)) |
| 906 | return -EIO; |
| 907 | |
| 908 | return 0; |
| 909 | } |
| 910 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 911 | static int atp_suspend(struct usb_interface *iface, pm_message_t message) |
| 912 | { |
| 913 | struct atp *dev = usb_get_intfdata(iface); |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 914 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 915 | usb_kill_urb(dev->urb); |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 916 | return 0; |
| 917 | } |
| 918 | |
| 919 | static int atp_resume(struct usb_interface *iface) |
| 920 | { |
| 921 | struct atp *dev = usb_get_intfdata(iface); |
Soeren Sonnenburg | 5a6eb67 | 2007-07-20 00:29:32 -0400 | [diff] [blame] | 922 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 923 | if (dev->open && usb_submit_urb(dev->urb, GFP_ATOMIC)) |
| 924 | return -EIO; |
| 925 | |
| 926 | return 0; |
| 927 | } |
| 928 | |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 929 | static int atp_reset_resume(struct usb_interface *iface) |
| 930 | { |
| 931 | struct atp *dev = usb_get_intfdata(iface); |
| 932 | |
| 933 | return atp_recover(dev); |
| 934 | } |
| 935 | |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 936 | static struct usb_driver atp_driver = { |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 937 | .name = "appletouch", |
| 938 | .probe = atp_probe, |
| 939 | .disconnect = atp_disconnect, |
| 940 | .suspend = atp_suspend, |
| 941 | .resume = atp_resume, |
Oliver Neukum | 90d95ef | 2008-06-17 11:56:55 -0400 | [diff] [blame] | 942 | .reset_resume = atp_reset_resume, |
Stelian Pop | f7214ff | 2005-09-08 10:19:48 +0200 | [diff] [blame] | 943 | .id_table = atp_table, |
| 944 | }; |
| 945 | |
Greg Kroah-Hartman | 08642e7 | 2011-11-18 09:48:31 -0800 | [diff] [blame] | 946 | module_usb_driver(atp_driver); |