xref: /openbmc/linux/drivers/input/mouse/bcm5974.c (revision baa7eb025ab14f3cba2e35c0a8648f9c9f01d24f)
1 /*
2  * Apple USB BCM5974 (Macbook Air and Penryn Macbook Pro) multitouch driver
3  *
4  * Copyright (C) 2008	   Henrik Rydberg (rydberg@euromail.se)
5  *
6  * The USB initialization and package decoding was made by
7  * Scott Shawcroft as part of the touchd user-space driver project:
8  * Copyright (C) 2008	   Scott Shawcroft (scott.shawcroft@gmail.com)
9  *
10  * The BCM5974 driver is based on the appletouch driver:
11  * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
12  * Copyright (C) 2005      Johannes Berg (johannes@sipsolutions.net)
13  * Copyright (C) 2005	   Stelian Pop (stelian@popies.net)
14  * Copyright (C) 2005	   Frank Arnold (frank@scirocco-5v-turbo.de)
15  * Copyright (C) 2005	   Peter Osterlund (petero2@telia.com)
16  * Copyright (C) 2005	   Michael Hanselmann (linux-kernel@hansmi.ch)
17  * Copyright (C) 2006	   Nicolas Boichat (nicolas@boichat.ch)
18  *
19  * This program is free software; you can redistribute it and/or modify
20  * it under the terms of the GNU General Public License as published by
21  * the Free Software Foundation; either version 2 of the License, or
22  * (at your option) any later version.
23  *
24  * This program is distributed in the hope that it will be useful,
25  * but WITHOUT ANY WARRANTY; without even the implied warranty of
26  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
27  * GNU General Public License for more details.
28  *
29  * You should have received a copy of the GNU General Public License
30  * along with this program; if not, write to the Free Software
31  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
32  *
33  */
34 
35 #include <linux/kernel.h>
36 #include <linux/errno.h>
37 #include <linux/init.h>
38 #include <linux/slab.h>
39 #include <linux/module.h>
40 #include <linux/usb/input.h>
41 #include <linux/hid.h>
42 #include <linux/mutex.h>
43 
44 #define USB_VENDOR_ID_APPLE		0x05ac
45 
46 /* MacbookAir, aka wellspring */
47 #define USB_DEVICE_ID_APPLE_WELLSPRING_ANSI	0x0223
48 #define USB_DEVICE_ID_APPLE_WELLSPRING_ISO	0x0224
49 #define USB_DEVICE_ID_APPLE_WELLSPRING_JIS	0x0225
50 /* MacbookProPenryn, aka wellspring2 */
51 #define USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI	0x0230
52 #define USB_DEVICE_ID_APPLE_WELLSPRING2_ISO	0x0231
53 #define USB_DEVICE_ID_APPLE_WELLSPRING2_JIS	0x0232
54 /* Macbook5,1 (unibody), aka wellspring3 */
55 #define USB_DEVICE_ID_APPLE_WELLSPRING3_ANSI	0x0236
56 #define USB_DEVICE_ID_APPLE_WELLSPRING3_ISO	0x0237
57 #define USB_DEVICE_ID_APPLE_WELLSPRING3_JIS	0x0238
58 
59 #define BCM5974_DEVICE(prod) {					\
60 	.match_flags = (USB_DEVICE_ID_MATCH_DEVICE |		\
61 			USB_DEVICE_ID_MATCH_INT_CLASS |		\
62 			USB_DEVICE_ID_MATCH_INT_PROTOCOL),	\
63 	.idVendor = USB_VENDOR_ID_APPLE,			\
64 	.idProduct = (prod),					\
65 	.bInterfaceClass = USB_INTERFACE_CLASS_HID,		\
66 	.bInterfaceProtocol = USB_INTERFACE_PROTOCOL_MOUSE	\
67 }
68 
69 /* table of devices that work with this driver */
70 static const struct usb_device_id bcm5974_table[] = {
71 	/* MacbookAir1.1 */
72 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING_ANSI),
73 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING_ISO),
74 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING_JIS),
75 	/* MacbookProPenryn */
76 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI),
77 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING2_ISO),
78 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING2_JIS),
79 	/* Macbook5,1 */
80 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING3_ANSI),
81 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING3_ISO),
82 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING3_JIS),
83 	/* Terminating entry */
84 	{}
85 };
86 MODULE_DEVICE_TABLE(usb, bcm5974_table);
87 
88 MODULE_AUTHOR("Henrik Rydberg");
89 MODULE_DESCRIPTION("Apple USB BCM5974 multitouch driver");
90 MODULE_LICENSE("GPL");
91 
92 #define dprintk(level, format, a...)\
93 	{ if (debug >= level) printk(KERN_DEBUG format, ##a); }
94 
95 static int debug = 1;
96 module_param(debug, int, 0644);
97 MODULE_PARM_DESC(debug, "Activate debugging output");
98 
99 /* button data structure */
100 struct bt_data {
101 	u8 unknown1;		/* constant */
102 	u8 button;		/* left button */
103 	u8 rel_x;		/* relative x coordinate */
104 	u8 rel_y;		/* relative y coordinate */
105 };
106 
107 /* trackpad header types */
108 enum tp_type {
109 	TYPE1,			/* plain trackpad */
110 	TYPE2			/* button integrated in trackpad */
111 };
112 
113 /* trackpad finger data offsets, le16-aligned */
114 #define FINGER_TYPE1		(13 * sizeof(__le16))
115 #define FINGER_TYPE2		(15 * sizeof(__le16))
116 
117 /* trackpad button data offsets */
118 #define BUTTON_TYPE2		15
119 
120 /* list of device capability bits */
121 #define HAS_INTEGRATED_BUTTON	1
122 
123 /* trackpad finger structure, le16-aligned */
124 struct tp_finger {
125 	__le16 origin;		/* zero when switching track finger */
126 	__le16 abs_x;		/* absolute x coodinate */
127 	__le16 abs_y;		/* absolute y coodinate */
128 	__le16 rel_x;		/* relative x coodinate */
129 	__le16 rel_y;		/* relative y coodinate */
130 	__le16 size_major;	/* finger size, major axis? */
131 	__le16 size_minor;	/* finger size, minor axis? */
132 	__le16 orientation;	/* 16384 when point, else 15 bit angle */
133 	__le16 force_major;	/* trackpad force, major axis? */
134 	__le16 force_minor;	/* trackpad force, minor axis? */
135 	__le16 unused[3];	/* zeros */
136 	__le16 multi;		/* one finger: varies, more fingers: constant */
137 } __attribute__((packed,aligned(2)));
138 
139 /* trackpad finger data size, empirically at least ten fingers */
140 #define SIZEOF_FINGER		sizeof(struct tp_finger)
141 #define SIZEOF_ALL_FINGERS	(16 * SIZEOF_FINGER)
142 #define MAX_FINGER_ORIENTATION	16384
143 
144 /* device-specific parameters */
145 struct bcm5974_param {
146 	int dim;		/* logical dimension */
147 	int fuzz;		/* logical noise value */
148 	int devmin;		/* device minimum reading */
149 	int devmax;		/* device maximum reading */
150 };
151 
152 /* device-specific configuration */
153 struct bcm5974_config {
154 	int ansi, iso, jis;	/* the product id of this device */
155 	int caps;		/* device capability bitmask */
156 	int bt_ep;		/* the endpoint of the button interface */
157 	int bt_datalen;		/* data length of the button interface */
158 	int tp_ep;		/* the endpoint of the trackpad interface */
159 	enum tp_type tp_type;	/* type of trackpad interface */
160 	int tp_offset;		/* offset to trackpad finger data */
161 	int tp_datalen;		/* data length of the trackpad interface */
162 	struct bcm5974_param p;	/* finger pressure limits */
163 	struct bcm5974_param w;	/* finger width limits */
164 	struct bcm5974_param x;	/* horizontal limits */
165 	struct bcm5974_param y;	/* vertical limits */
166 };
167 
168 /* logical device structure */
169 struct bcm5974 {
170 	char phys[64];
171 	struct usb_device *udev;	/* usb device */
172 	struct usb_interface *intf;	/* our interface */
173 	struct input_dev *input;	/* input dev */
174 	struct bcm5974_config cfg;	/* device configuration */
175 	struct mutex pm_mutex;		/* serialize access to open/suspend */
176 	int opened;			/* 1: opened, 0: closed */
177 	struct urb *bt_urb;		/* button usb request block */
178 	struct bt_data *bt_data;	/* button transferred data */
179 	struct urb *tp_urb;		/* trackpad usb request block */
180 	u8 *tp_data;			/* trackpad transferred data */
181 	int fingers;			/* number of fingers on trackpad */
182 };
183 
184 /* logical dimensions */
185 #define DIM_PRESSURE	256		/* maximum finger pressure */
186 #define DIM_WIDTH	16		/* maximum finger width */
187 #define DIM_X		1280		/* maximum trackpad x value */
188 #define DIM_Y		800		/* maximum trackpad y value */
189 
190 /* logical signal quality */
191 #define SN_PRESSURE	45		/* pressure signal-to-noise ratio */
192 #define SN_WIDTH	100		/* width signal-to-noise ratio */
193 #define SN_COORD	250		/* coordinate signal-to-noise ratio */
194 
195 /* pressure thresholds */
196 #define PRESSURE_LOW	(2 * DIM_PRESSURE / SN_PRESSURE)
197 #define PRESSURE_HIGH	(3 * PRESSURE_LOW)
198 
199 /* device constants */
200 static const struct bcm5974_config bcm5974_config_table[] = {
201 	{
202 		USB_DEVICE_ID_APPLE_WELLSPRING_ANSI,
203 		USB_DEVICE_ID_APPLE_WELLSPRING_ISO,
204 		USB_DEVICE_ID_APPLE_WELLSPRING_JIS,
205 		0,
206 		0x84, sizeof(struct bt_data),
207 		0x81, TYPE1, FINGER_TYPE1, FINGER_TYPE1 + SIZEOF_ALL_FINGERS,
208 		{ DIM_PRESSURE, DIM_PRESSURE / SN_PRESSURE, 0, 256 },
209 		{ DIM_WIDTH, DIM_WIDTH / SN_WIDTH, 0, 2048 },
210 		{ DIM_X, DIM_X / SN_COORD, -4824, 5342 },
211 		{ DIM_Y, DIM_Y / SN_COORD, -172, 5820 }
212 	},
213 	{
214 		USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI,
215 		USB_DEVICE_ID_APPLE_WELLSPRING2_ISO,
216 		USB_DEVICE_ID_APPLE_WELLSPRING2_JIS,
217 		0,
218 		0x84, sizeof(struct bt_data),
219 		0x81, TYPE1, FINGER_TYPE1, FINGER_TYPE1 + SIZEOF_ALL_FINGERS,
220 		{ DIM_PRESSURE, DIM_PRESSURE / SN_PRESSURE, 0, 256 },
221 		{ DIM_WIDTH, DIM_WIDTH / SN_WIDTH, 0, 2048 },
222 		{ DIM_X, DIM_X / SN_COORD, -4824, 4824 },
223 		{ DIM_Y, DIM_Y / SN_COORD, -172, 4290 }
224 	},
225 	{
226 		USB_DEVICE_ID_APPLE_WELLSPRING3_ANSI,
227 		USB_DEVICE_ID_APPLE_WELLSPRING3_ISO,
228 		USB_DEVICE_ID_APPLE_WELLSPRING3_JIS,
229 		HAS_INTEGRATED_BUTTON,
230 		0x84, sizeof(struct bt_data),
231 		0x81, TYPE2, FINGER_TYPE2, FINGER_TYPE2 + SIZEOF_ALL_FINGERS,
232 		{ DIM_PRESSURE, DIM_PRESSURE / SN_PRESSURE, 0, 300 },
233 		{ DIM_WIDTH, DIM_WIDTH / SN_WIDTH, 0, 2048 },
234 		{ DIM_X, DIM_X / SN_COORD, -4460, 5166 },
235 		{ DIM_Y, DIM_Y / SN_COORD, -75, 6700 }
236 	},
237 	{}
238 };
239 
240 /* return the device-specific configuration by device */
241 static const struct bcm5974_config *bcm5974_get_config(struct usb_device *udev)
242 {
243 	u16 id = le16_to_cpu(udev->descriptor.idProduct);
244 	const struct bcm5974_config *cfg;
245 
246 	for (cfg = bcm5974_config_table; cfg->ansi; ++cfg)
247 		if (cfg->ansi == id || cfg->iso == id || cfg->jis == id)
248 			return cfg;
249 
250 	return bcm5974_config_table;
251 }
252 
253 /* convert 16-bit little endian to signed integer */
254 static inline int raw2int(__le16 x)
255 {
256 	return (signed short)le16_to_cpu(x);
257 }
258 
259 /* scale device data to logical dimensions (asserts devmin < devmax) */
260 static inline int int2scale(const struct bcm5974_param *p, int x)
261 {
262 	return x * p->dim / (p->devmax - p->devmin);
263 }
264 
265 /* all logical value ranges are [0,dim). */
266 static inline int int2bound(const struct bcm5974_param *p, int x)
267 {
268 	int s = int2scale(p, x);
269 
270 	return clamp_val(s, 0, p->dim - 1);
271 }
272 
273 /* setup which logical events to report */
274 static void setup_events_to_report(struct input_dev *input_dev,
275 				   const struct bcm5974_config *cfg)
276 {
277 	__set_bit(EV_ABS, input_dev->evbit);
278 
279 	input_set_abs_params(input_dev, ABS_PRESSURE,
280 				0, cfg->p.dim, cfg->p.fuzz, 0);
281 	input_set_abs_params(input_dev, ABS_TOOL_WIDTH,
282 				0, cfg->w.dim, cfg->w.fuzz, 0);
283 	input_set_abs_params(input_dev, ABS_X,
284 				0, cfg->x.dim, cfg->x.fuzz, 0);
285 	input_set_abs_params(input_dev, ABS_Y,
286 				0, cfg->y.dim, cfg->y.fuzz, 0);
287 
288 	/* finger touch area */
289 	input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR,
290 			     cfg->w.devmin, cfg->w.devmax, 0, 0);
291 	input_set_abs_params(input_dev, ABS_MT_TOUCH_MINOR,
292 			     cfg->w.devmin, cfg->w.devmax, 0, 0);
293 	/* finger approach area */
294 	input_set_abs_params(input_dev, ABS_MT_WIDTH_MAJOR,
295 			     cfg->w.devmin, cfg->w.devmax, 0, 0);
296 	input_set_abs_params(input_dev, ABS_MT_WIDTH_MINOR,
297 			     cfg->w.devmin, cfg->w.devmax, 0, 0);
298 	/* finger orientation */
299 	input_set_abs_params(input_dev, ABS_MT_ORIENTATION,
300 			     -MAX_FINGER_ORIENTATION,
301 			     MAX_FINGER_ORIENTATION, 0, 0);
302 	/* finger position */
303 	input_set_abs_params(input_dev, ABS_MT_POSITION_X,
304 			     cfg->x.devmin, cfg->x.devmax, 0, 0);
305 	input_set_abs_params(input_dev, ABS_MT_POSITION_Y,
306 			     cfg->y.devmin, cfg->y.devmax, 0, 0);
307 
308 	__set_bit(EV_KEY, input_dev->evbit);
309 	__set_bit(BTN_TOUCH, input_dev->keybit);
310 	__set_bit(BTN_TOOL_FINGER, input_dev->keybit);
311 	__set_bit(BTN_TOOL_DOUBLETAP, input_dev->keybit);
312 	__set_bit(BTN_TOOL_TRIPLETAP, input_dev->keybit);
313 	__set_bit(BTN_TOOL_QUADTAP, input_dev->keybit);
314 	__set_bit(BTN_LEFT, input_dev->keybit);
315 
316 	input_set_events_per_packet(input_dev, 60);
317 }
318 
319 /* report button data as logical button state */
320 static int report_bt_state(struct bcm5974 *dev, int size)
321 {
322 	if (size != sizeof(struct bt_data))
323 		return -EIO;
324 
325 	dprintk(7,
326 		"bcm5974: button data: %x %x %x %x\n",
327 		dev->bt_data->unknown1, dev->bt_data->button,
328 		dev->bt_data->rel_x, dev->bt_data->rel_y);
329 
330 	input_report_key(dev->input, BTN_LEFT, dev->bt_data->button);
331 	input_sync(dev->input);
332 
333 	return 0;
334 }
335 
336 static void report_finger_data(struct input_dev *input,
337 			       const struct bcm5974_config *cfg,
338 			       const struct tp_finger *f)
339 {
340 	input_report_abs(input, ABS_MT_TOUCH_MAJOR,
341 			 raw2int(f->force_major) << 1);
342 	input_report_abs(input, ABS_MT_TOUCH_MINOR,
343 			 raw2int(f->force_minor) << 1);
344 	input_report_abs(input, ABS_MT_WIDTH_MAJOR,
345 			 raw2int(f->size_major) << 1);
346 	input_report_abs(input, ABS_MT_WIDTH_MINOR,
347 			 raw2int(f->size_minor) << 1);
348 	input_report_abs(input, ABS_MT_ORIENTATION,
349 			 MAX_FINGER_ORIENTATION - raw2int(f->orientation));
350 	input_report_abs(input, ABS_MT_POSITION_X, raw2int(f->abs_x));
351 	input_report_abs(input, ABS_MT_POSITION_Y,
352 			 cfg->y.devmin + cfg->y.devmax - raw2int(f->abs_y));
353 	input_mt_sync(input);
354 }
355 
356 /* report trackpad data as logical trackpad state */
357 static int report_tp_state(struct bcm5974 *dev, int size)
358 {
359 	const struct bcm5974_config *c = &dev->cfg;
360 	const struct tp_finger *f;
361 	struct input_dev *input = dev->input;
362 	int raw_p, raw_w, raw_x, raw_y, raw_n, i;
363 	int ptest, origin, ibt = 0, nmin = 0, nmax = 0;
364 	int abs_p = 0, abs_w = 0, abs_x = 0, abs_y = 0;
365 
366 	if (size < c->tp_offset || (size - c->tp_offset) % SIZEOF_FINGER != 0)
367 		return -EIO;
368 
369 	/* finger data, le16-aligned */
370 	f = (const struct tp_finger *)(dev->tp_data + c->tp_offset);
371 	raw_n = (size - c->tp_offset) / SIZEOF_FINGER;
372 
373 	/* always track the first finger; when detached, start over */
374 	if (raw_n) {
375 
376 		/* report raw trackpad data */
377 		for (i = 0; i < raw_n; i++)
378 			report_finger_data(input, c, &f[i]);
379 
380 		raw_p = raw2int(f->force_major);
381 		raw_w = raw2int(f->size_major);
382 		raw_x = raw2int(f->abs_x);
383 		raw_y = raw2int(f->abs_y);
384 
385 		dprintk(9,
386 			"bcm5974: "
387 			"raw: p: %+05d w: %+05d x: %+05d y: %+05d n: %d\n",
388 			raw_p, raw_w, raw_x, raw_y, raw_n);
389 
390 		ptest = int2bound(&c->p, raw_p);
391 		origin = raw2int(f->origin);
392 
393 		/* set the integrated button if applicable */
394 		if (c->tp_type == TYPE2)
395 			ibt = raw2int(dev->tp_data[BUTTON_TYPE2]);
396 
397 		/* while tracking finger still valid, count all fingers */
398 		if (ptest > PRESSURE_LOW && origin) {
399 			abs_p = ptest;
400 			abs_w = int2bound(&c->w, raw_w);
401 			abs_x = int2bound(&c->x, raw_x - c->x.devmin);
402 			abs_y = int2bound(&c->y, c->y.devmax - raw_y);
403 			while (raw_n--) {
404 				ptest = int2bound(&c->p,
405 						  raw2int(f->force_major));
406 				if (ptest > PRESSURE_LOW)
407 					nmax++;
408 				if (ptest > PRESSURE_HIGH)
409 					nmin++;
410 				f++;
411 			}
412 		}
413 	}
414 
415 	if (dev->fingers < nmin)
416 		dev->fingers = nmin;
417 	if (dev->fingers > nmax)
418 		dev->fingers = nmax;
419 
420 	input_report_key(input, BTN_TOUCH, dev->fingers > 0);
421 	input_report_key(input, BTN_TOOL_FINGER, dev->fingers == 1);
422 	input_report_key(input, BTN_TOOL_DOUBLETAP, dev->fingers == 2);
423 	input_report_key(input, BTN_TOOL_TRIPLETAP, dev->fingers == 3);
424 	input_report_key(input, BTN_TOOL_QUADTAP, dev->fingers > 3);
425 
426 	input_report_abs(input, ABS_PRESSURE, abs_p);
427 	input_report_abs(input, ABS_TOOL_WIDTH, abs_w);
428 
429 	if (abs_p) {
430 		input_report_abs(input, ABS_X, abs_x);
431 		input_report_abs(input, ABS_Y, abs_y);
432 
433 		dprintk(8,
434 			"bcm5974: abs: p: %+05d w: %+05d x: %+05d y: %+05d "
435 			"nmin: %d nmax: %d n: %d ibt: %d\n", abs_p, abs_w,
436 			abs_x, abs_y, nmin, nmax, dev->fingers, ibt);
437 
438 	}
439 
440 	/* type 2 reports button events via ibt only */
441 	if (c->tp_type == TYPE2)
442 		input_report_key(input, BTN_LEFT, ibt);
443 
444 	input_sync(input);
445 
446 	return 0;
447 }
448 
449 /* Wellspring initialization constants */
450 #define BCM5974_WELLSPRING_MODE_READ_REQUEST_ID		1
451 #define BCM5974_WELLSPRING_MODE_WRITE_REQUEST_ID	9
452 #define BCM5974_WELLSPRING_MODE_REQUEST_VALUE		0x300
453 #define BCM5974_WELLSPRING_MODE_REQUEST_INDEX		0
454 #define BCM5974_WELLSPRING_MODE_VENDOR_VALUE		0x01
455 #define BCM5974_WELLSPRING_MODE_NORMAL_VALUE		0x08
456 
457 static int bcm5974_wellspring_mode(struct bcm5974 *dev, bool on)
458 {
459 	char *data = kmalloc(8, GFP_KERNEL);
460 	int retval = 0, size;
461 
462 	if (!data) {
463 		err("bcm5974: out of memory");
464 		retval = -ENOMEM;
465 		goto out;
466 	}
467 
468 	/* read configuration */
469 	size = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
470 			BCM5974_WELLSPRING_MODE_READ_REQUEST_ID,
471 			USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
472 			BCM5974_WELLSPRING_MODE_REQUEST_VALUE,
473 			BCM5974_WELLSPRING_MODE_REQUEST_INDEX, data, 8, 5000);
474 
475 	if (size != 8) {
476 		err("bcm5974: could not read from device");
477 		retval = -EIO;
478 		goto out;
479 	}
480 
481 	/* apply the mode switch */
482 	data[0] = on ?
483 		BCM5974_WELLSPRING_MODE_VENDOR_VALUE :
484 		BCM5974_WELLSPRING_MODE_NORMAL_VALUE;
485 
486 	/* write configuration */
487 	size = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
488 			BCM5974_WELLSPRING_MODE_WRITE_REQUEST_ID,
489 			USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
490 			BCM5974_WELLSPRING_MODE_REQUEST_VALUE,
491 			BCM5974_WELLSPRING_MODE_REQUEST_INDEX, data, 8, 5000);
492 
493 	if (size != 8) {
494 		err("bcm5974: could not write to device");
495 		retval = -EIO;
496 		goto out;
497 	}
498 
499 	dprintk(2, "bcm5974: switched to %s mode.\n",
500 		on ? "wellspring" : "normal");
501 
502  out:
503 	kfree(data);
504 	return retval;
505 }
506 
507 static void bcm5974_irq_button(struct urb *urb)
508 {
509 	struct bcm5974 *dev = urb->context;
510 	int error;
511 
512 	switch (urb->status) {
513 	case 0:
514 		break;
515 	case -EOVERFLOW:
516 	case -ECONNRESET:
517 	case -ENOENT:
518 	case -ESHUTDOWN:
519 		dbg("bcm5974: button urb shutting down: %d", urb->status);
520 		return;
521 	default:
522 		dbg("bcm5974: button urb status: %d", urb->status);
523 		goto exit;
524 	}
525 
526 	if (report_bt_state(dev, dev->bt_urb->actual_length))
527 		dprintk(1, "bcm5974: bad button package, length: %d\n",
528 			dev->bt_urb->actual_length);
529 
530 exit:
531 	error = usb_submit_urb(dev->bt_urb, GFP_ATOMIC);
532 	if (error)
533 		err("bcm5974: button urb failed: %d", error);
534 }
535 
536 static void bcm5974_irq_trackpad(struct urb *urb)
537 {
538 	struct bcm5974 *dev = urb->context;
539 	int error;
540 
541 	switch (urb->status) {
542 	case 0:
543 		break;
544 	case -EOVERFLOW:
545 	case -ECONNRESET:
546 	case -ENOENT:
547 	case -ESHUTDOWN:
548 		dbg("bcm5974: trackpad urb shutting down: %d", urb->status);
549 		return;
550 	default:
551 		dbg("bcm5974: trackpad urb status: %d", urb->status);
552 		goto exit;
553 	}
554 
555 	/* control response ignored */
556 	if (dev->tp_urb->actual_length == 2)
557 		goto exit;
558 
559 	if (report_tp_state(dev, dev->tp_urb->actual_length))
560 		dprintk(1, "bcm5974: bad trackpad package, length: %d\n",
561 			dev->tp_urb->actual_length);
562 
563 exit:
564 	error = usb_submit_urb(dev->tp_urb, GFP_ATOMIC);
565 	if (error)
566 		err("bcm5974: trackpad urb failed: %d", error);
567 }
568 
569 /*
570  * The Wellspring trackpad, like many recent Apple trackpads, share
571  * the usb device with the keyboard. Since keyboards are usually
572  * handled by the HID system, the device ends up being handled by two
573  * modules. Setting up the device therefore becomes slightly
574  * complicated. To enable multitouch features, a mode switch is
575  * required, which is usually applied via the control interface of the
576  * device.  It can be argued where this switch should take place. In
577  * some drivers, like appletouch, the switch is made during
578  * probe. However, the hid module may also alter the state of the
579  * device, resulting in trackpad malfunction under certain
580  * circumstances. To get around this problem, there is at least one
581  * example that utilizes the USB_QUIRK_RESET_RESUME quirk in order to
582  * recieve a reset_resume request rather than the normal resume.
583  * Since the implementation of reset_resume is equal to mode switch
584  * plus start_traffic, it seems easier to always do the switch when
585  * starting traffic on the device.
586  */
587 static int bcm5974_start_traffic(struct bcm5974 *dev)
588 {
589 	int error;
590 
591 	error = bcm5974_wellspring_mode(dev, true);
592 	if (error) {
593 		dprintk(1, "bcm5974: mode switch failed\n");
594 		goto err_out;
595 	}
596 
597 	error = usb_submit_urb(dev->bt_urb, GFP_KERNEL);
598 	if (error)
599 		goto err_reset_mode;
600 
601 	error = usb_submit_urb(dev->tp_urb, GFP_KERNEL);
602 	if (error)
603 		goto err_kill_bt;
604 
605 	return 0;
606 
607 err_kill_bt:
608 	usb_kill_urb(dev->bt_urb);
609 err_reset_mode:
610 	bcm5974_wellspring_mode(dev, false);
611 err_out:
612 	return error;
613 }
614 
615 static void bcm5974_pause_traffic(struct bcm5974 *dev)
616 {
617 	usb_kill_urb(dev->tp_urb);
618 	usb_kill_urb(dev->bt_urb);
619 	bcm5974_wellspring_mode(dev, false);
620 }
621 
622 /*
623  * The code below implements open/close and manual suspend/resume.
624  * All functions may be called in random order.
625  *
626  * Opening a suspended device fails with EACCES - permission denied.
627  *
628  * Failing a resume leaves the device resumed but closed.
629  */
630 static int bcm5974_open(struct input_dev *input)
631 {
632 	struct bcm5974 *dev = input_get_drvdata(input);
633 	int error;
634 
635 	error = usb_autopm_get_interface(dev->intf);
636 	if (error)
637 		return error;
638 
639 	mutex_lock(&dev->pm_mutex);
640 
641 	error = bcm5974_start_traffic(dev);
642 	if (!error)
643 		dev->opened = 1;
644 
645 	mutex_unlock(&dev->pm_mutex);
646 
647 	if (error)
648 		usb_autopm_put_interface(dev->intf);
649 
650 	return error;
651 }
652 
653 static void bcm5974_close(struct input_dev *input)
654 {
655 	struct bcm5974 *dev = input_get_drvdata(input);
656 
657 	mutex_lock(&dev->pm_mutex);
658 
659 	bcm5974_pause_traffic(dev);
660 	dev->opened = 0;
661 
662 	mutex_unlock(&dev->pm_mutex);
663 
664 	usb_autopm_put_interface(dev->intf);
665 }
666 
667 static int bcm5974_suspend(struct usb_interface *iface, pm_message_t message)
668 {
669 	struct bcm5974 *dev = usb_get_intfdata(iface);
670 
671 	mutex_lock(&dev->pm_mutex);
672 
673 	if (dev->opened)
674 		bcm5974_pause_traffic(dev);
675 
676 	mutex_unlock(&dev->pm_mutex);
677 
678 	return 0;
679 }
680 
681 static int bcm5974_resume(struct usb_interface *iface)
682 {
683 	struct bcm5974 *dev = usb_get_intfdata(iface);
684 	int error = 0;
685 
686 	mutex_lock(&dev->pm_mutex);
687 
688 	if (dev->opened)
689 		error = bcm5974_start_traffic(dev);
690 
691 	mutex_unlock(&dev->pm_mutex);
692 
693 	return error;
694 }
695 
696 static int bcm5974_probe(struct usb_interface *iface,
697 			 const struct usb_device_id *id)
698 {
699 	struct usb_device *udev = interface_to_usbdev(iface);
700 	const struct bcm5974_config *cfg;
701 	struct bcm5974 *dev;
702 	struct input_dev *input_dev;
703 	int error = -ENOMEM;
704 
705 	/* find the product index */
706 	cfg = bcm5974_get_config(udev);
707 
708 	/* allocate memory for our device state and initialize it */
709 	dev = kzalloc(sizeof(struct bcm5974), GFP_KERNEL);
710 	input_dev = input_allocate_device();
711 	if (!dev || !input_dev) {
712 		err("bcm5974: out of memory");
713 		goto err_free_devs;
714 	}
715 
716 	dev->udev = udev;
717 	dev->intf = iface;
718 	dev->input = input_dev;
719 	dev->cfg = *cfg;
720 	mutex_init(&dev->pm_mutex);
721 
722 	/* setup urbs */
723 	dev->bt_urb = usb_alloc_urb(0, GFP_KERNEL);
724 	if (!dev->bt_urb)
725 		goto err_free_devs;
726 
727 	dev->tp_urb = usb_alloc_urb(0, GFP_KERNEL);
728 	if (!dev->tp_urb)
729 		goto err_free_bt_urb;
730 
731 	dev->bt_data = usb_alloc_coherent(dev->udev,
732 					  dev->cfg.bt_datalen, GFP_KERNEL,
733 					  &dev->bt_urb->transfer_dma);
734 	if (!dev->bt_data)
735 		goto err_free_urb;
736 
737 	dev->tp_data = usb_alloc_coherent(dev->udev,
738 					  dev->cfg.tp_datalen, GFP_KERNEL,
739 					  &dev->tp_urb->transfer_dma);
740 	if (!dev->tp_data)
741 		goto err_free_bt_buffer;
742 
743 	usb_fill_int_urb(dev->bt_urb, udev,
744 			 usb_rcvintpipe(udev, cfg->bt_ep),
745 			 dev->bt_data, dev->cfg.bt_datalen,
746 			 bcm5974_irq_button, dev, 1);
747 
748 	usb_fill_int_urb(dev->tp_urb, udev,
749 			 usb_rcvintpipe(udev, cfg->tp_ep),
750 			 dev->tp_data, dev->cfg.tp_datalen,
751 			 bcm5974_irq_trackpad, dev, 1);
752 
753 	/* create bcm5974 device */
754 	usb_make_path(udev, dev->phys, sizeof(dev->phys));
755 	strlcat(dev->phys, "/input0", sizeof(dev->phys));
756 
757 	input_dev->name = "bcm5974";
758 	input_dev->phys = dev->phys;
759 	usb_to_input_id(dev->udev, &input_dev->id);
760 	/* report driver capabilities via the version field */
761 	input_dev->id.version = cfg->caps;
762 	input_dev->dev.parent = &iface->dev;
763 
764 	input_set_drvdata(input_dev, dev);
765 
766 	input_dev->open = bcm5974_open;
767 	input_dev->close = bcm5974_close;
768 
769 	setup_events_to_report(input_dev, cfg);
770 
771 	error = input_register_device(dev->input);
772 	if (error)
773 		goto err_free_buffer;
774 
775 	/* save our data pointer in this interface device */
776 	usb_set_intfdata(iface, dev);
777 
778 	return 0;
779 
780 err_free_buffer:
781 	usb_free_coherent(dev->udev, dev->cfg.tp_datalen,
782 		dev->tp_data, dev->tp_urb->transfer_dma);
783 err_free_bt_buffer:
784 	usb_free_coherent(dev->udev, dev->cfg.bt_datalen,
785 		dev->bt_data, dev->bt_urb->transfer_dma);
786 err_free_urb:
787 	usb_free_urb(dev->tp_urb);
788 err_free_bt_urb:
789 	usb_free_urb(dev->bt_urb);
790 err_free_devs:
791 	usb_set_intfdata(iface, NULL);
792 	input_free_device(input_dev);
793 	kfree(dev);
794 	return error;
795 }
796 
797 static void bcm5974_disconnect(struct usb_interface *iface)
798 {
799 	struct bcm5974 *dev = usb_get_intfdata(iface);
800 
801 	usb_set_intfdata(iface, NULL);
802 
803 	input_unregister_device(dev->input);
804 	usb_free_coherent(dev->udev, dev->cfg.tp_datalen,
805 			  dev->tp_data, dev->tp_urb->transfer_dma);
806 	usb_free_coherent(dev->udev, dev->cfg.bt_datalen,
807 			  dev->bt_data, dev->bt_urb->transfer_dma);
808 	usb_free_urb(dev->tp_urb);
809 	usb_free_urb(dev->bt_urb);
810 	kfree(dev);
811 }
812 
813 static struct usb_driver bcm5974_driver = {
814 	.name			= "bcm5974",
815 	.probe			= bcm5974_probe,
816 	.disconnect		= bcm5974_disconnect,
817 	.suspend		= bcm5974_suspend,
818 	.resume			= bcm5974_resume,
819 	.id_table		= bcm5974_table,
820 	.supports_autosuspend	= 1,
821 };
822 
823 static int __init bcm5974_init(void)
824 {
825 	return usb_register(&bcm5974_driver);
826 }
827 
828 static void __exit bcm5974_exit(void)
829 {
830 	usb_deregister(&bcm5974_driver);
831 }
832 
833 module_init(bcm5974_init);
834 module_exit(bcm5974_exit);
835 
836