1 /*
2  * Apple USB BCM5974 (Macbook Air and Penryn Macbook Pro) multitouch driver
3  *
4  * Copyright (C) 2008	   Henrik Rydberg (rydberg@euromail.se)
5  * Copyright (C) 2015      John Horan (knasher@gmail.com)
6  *
7  * The USB initialization and package decoding was made by
8  * Scott Shawcroft as part of the touchd user-space driver project:
9  * Copyright (C) 2008	   Scott Shawcroft (scott.shawcroft@gmail.com)
10  *
11  * The BCM5974 driver is based on the appletouch driver:
12  * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
13  * Copyright (C) 2005      Johannes Berg (johannes@sipsolutions.net)
14  * Copyright (C) 2005	   Stelian Pop (stelian@popies.net)
15  * Copyright (C) 2005	   Frank Arnold (frank@scirocco-5v-turbo.de)
16  * Copyright (C) 2005	   Peter Osterlund (petero2@telia.com)
17  * Copyright (C) 2005	   Michael Hanselmann (linux-kernel@hansmi.ch)
18  * Copyright (C) 2006	   Nicolas Boichat (nicolas@boichat.ch)
19  *
20  * This program is free software; you can redistribute it and/or modify
21  * it under the terms of the GNU General Public License as published by
22  * the Free Software Foundation; either version 2 of the License, or
23  * (at your option) any later version.
24  *
25  * This program is distributed in the hope that it will be useful,
26  * but WITHOUT ANY WARRANTY; without even the implied warranty of
27  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
28  * GNU General Public License for more details.
29  *
30  * You should have received a copy of the GNU General Public License
31  * along with this program; if not, write to the Free Software
32  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
33  *
34  */
35 
36 #include <linux/kernel.h>
37 #include <linux/errno.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 #include <linux/input/mt.h>
44 
45 #define USB_VENDOR_ID_APPLE		0x05ac
46 
47 /* MacbookAir, aka wellspring */
48 #define USB_DEVICE_ID_APPLE_WELLSPRING_ANSI	0x0223
49 #define USB_DEVICE_ID_APPLE_WELLSPRING_ISO	0x0224
50 #define USB_DEVICE_ID_APPLE_WELLSPRING_JIS	0x0225
51 /* MacbookProPenryn, aka wellspring2 */
52 #define USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI	0x0230
53 #define USB_DEVICE_ID_APPLE_WELLSPRING2_ISO	0x0231
54 #define USB_DEVICE_ID_APPLE_WELLSPRING2_JIS	0x0232
55 /* Macbook5,1 (unibody), aka wellspring3 */
56 #define USB_DEVICE_ID_APPLE_WELLSPRING3_ANSI	0x0236
57 #define USB_DEVICE_ID_APPLE_WELLSPRING3_ISO	0x0237
58 #define USB_DEVICE_ID_APPLE_WELLSPRING3_JIS	0x0238
59 /* MacbookAir3,2 (unibody), aka wellspring5 */
60 #define USB_DEVICE_ID_APPLE_WELLSPRING4_ANSI	0x023f
61 #define USB_DEVICE_ID_APPLE_WELLSPRING4_ISO	0x0240
62 #define USB_DEVICE_ID_APPLE_WELLSPRING4_JIS	0x0241
63 /* MacbookAir3,1 (unibody), aka wellspring4 */
64 #define USB_DEVICE_ID_APPLE_WELLSPRING4A_ANSI	0x0242
65 #define USB_DEVICE_ID_APPLE_WELLSPRING4A_ISO	0x0243
66 #define USB_DEVICE_ID_APPLE_WELLSPRING4A_JIS	0x0244
67 /* Macbook8 (unibody, March 2011) */
68 #define USB_DEVICE_ID_APPLE_WELLSPRING5_ANSI	0x0245
69 #define USB_DEVICE_ID_APPLE_WELLSPRING5_ISO	0x0246
70 #define USB_DEVICE_ID_APPLE_WELLSPRING5_JIS	0x0247
71 /* MacbookAir4,1 (unibody, July 2011) */
72 #define USB_DEVICE_ID_APPLE_WELLSPRING6A_ANSI	0x0249
73 #define USB_DEVICE_ID_APPLE_WELLSPRING6A_ISO	0x024a
74 #define USB_DEVICE_ID_APPLE_WELLSPRING6A_JIS	0x024b
75 /* MacbookAir4,2 (unibody, July 2011) */
76 #define USB_DEVICE_ID_APPLE_WELLSPRING6_ANSI	0x024c
77 #define USB_DEVICE_ID_APPLE_WELLSPRING6_ISO	0x024d
78 #define USB_DEVICE_ID_APPLE_WELLSPRING6_JIS	0x024e
79 /* Macbook8,2 (unibody) */
80 #define USB_DEVICE_ID_APPLE_WELLSPRING5A_ANSI	0x0252
81 #define USB_DEVICE_ID_APPLE_WELLSPRING5A_ISO	0x0253
82 #define USB_DEVICE_ID_APPLE_WELLSPRING5A_JIS	0x0254
83 /* MacbookPro10,1 (unibody, June 2012) */
84 #define USB_DEVICE_ID_APPLE_WELLSPRING7_ANSI	0x0262
85 #define USB_DEVICE_ID_APPLE_WELLSPRING7_ISO	0x0263
86 #define USB_DEVICE_ID_APPLE_WELLSPRING7_JIS	0x0264
87 /* MacbookPro10,2 (unibody, October 2012) */
88 #define USB_DEVICE_ID_APPLE_WELLSPRING7A_ANSI	0x0259
89 #define USB_DEVICE_ID_APPLE_WELLSPRING7A_ISO	0x025a
90 #define USB_DEVICE_ID_APPLE_WELLSPRING7A_JIS	0x025b
91 /* MacbookAir6,2 (unibody, June 2013) */
92 #define USB_DEVICE_ID_APPLE_WELLSPRING8_ANSI	0x0290
93 #define USB_DEVICE_ID_APPLE_WELLSPRING8_ISO	0x0291
94 #define USB_DEVICE_ID_APPLE_WELLSPRING8_JIS	0x0292
95 /* MacbookPro12,1 (2015) */
96 #define USB_DEVICE_ID_APPLE_WELLSPRING9_ANSI	0x0272
97 #define USB_DEVICE_ID_APPLE_WELLSPRING9_ISO	0x0273
98 #define USB_DEVICE_ID_APPLE_WELLSPRING9_JIS	0x0274
99 
100 #define BCM5974_DEVICE(prod) {					\
101 	.match_flags = (USB_DEVICE_ID_MATCH_DEVICE |		\
102 			USB_DEVICE_ID_MATCH_INT_CLASS |		\
103 			USB_DEVICE_ID_MATCH_INT_PROTOCOL),	\
104 	.idVendor = USB_VENDOR_ID_APPLE,			\
105 	.idProduct = (prod),					\
106 	.bInterfaceClass = USB_INTERFACE_CLASS_HID,		\
107 	.bInterfaceProtocol = USB_INTERFACE_PROTOCOL_MOUSE	\
108 }
109 
110 /* table of devices that work with this driver */
111 static const struct usb_device_id bcm5974_table[] = {
112 	/* MacbookAir1.1 */
113 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING_ANSI),
114 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING_ISO),
115 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING_JIS),
116 	/* MacbookProPenryn */
117 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI),
118 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING2_ISO),
119 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING2_JIS),
120 	/* Macbook5,1 */
121 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING3_ANSI),
122 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING3_ISO),
123 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING3_JIS),
124 	/* MacbookAir3,2 */
125 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING4_ANSI),
126 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING4_ISO),
127 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING4_JIS),
128 	/* MacbookAir3,1 */
129 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING4A_ANSI),
130 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING4A_ISO),
131 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING4A_JIS),
132 	/* MacbookPro8 */
133 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING5_ANSI),
134 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING5_ISO),
135 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING5_JIS),
136 	/* MacbookAir4,1 */
137 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING6A_ANSI),
138 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING6A_ISO),
139 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING6A_JIS),
140 	/* MacbookAir4,2 */
141 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING6_ANSI),
142 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING6_ISO),
143 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING6_JIS),
144 	/* MacbookPro8,2 */
145 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING5A_ANSI),
146 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING5A_ISO),
147 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING5A_JIS),
148 	/* MacbookPro10,1 */
149 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING7_ANSI),
150 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING7_ISO),
151 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING7_JIS),
152 	/* MacbookPro10,2 */
153 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING7A_ANSI),
154 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING7A_ISO),
155 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING7A_JIS),
156 	/* MacbookAir6,2 */
157 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING8_ANSI),
158 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING8_ISO),
159 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING8_JIS),
160 	/* MacbookPro12,1 */
161 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING9_ANSI),
162 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING9_ISO),
163 	BCM5974_DEVICE(USB_DEVICE_ID_APPLE_WELLSPRING9_JIS),
164 	/* Terminating entry */
165 	{}
166 };
167 MODULE_DEVICE_TABLE(usb, bcm5974_table);
168 
169 MODULE_AUTHOR("Henrik Rydberg");
170 MODULE_DESCRIPTION("Apple USB BCM5974 multitouch driver");
171 MODULE_LICENSE("GPL");
172 
173 #define dprintk(level, format, a...)\
174 	{ if (debug >= level) printk(KERN_DEBUG format, ##a); }
175 
176 static int debug = 1;
177 module_param(debug, int, 0644);
178 MODULE_PARM_DESC(debug, "Activate debugging output");
179 
180 /* button data structure */
181 struct bt_data {
182 	u8 unknown1;		/* constant */
183 	u8 button;		/* left button */
184 	u8 rel_x;		/* relative x coordinate */
185 	u8 rel_y;		/* relative y coordinate */
186 };
187 
188 /* trackpad header types */
189 enum tp_type {
190 	TYPE1,			/* plain trackpad */
191 	TYPE2,			/* button integrated in trackpad */
192 	TYPE3,			/* additional header fields since June 2013 */
193 	TYPE4			/* additional header field for pressure data */
194 };
195 
196 /* trackpad finger data offsets, le16-aligned */
197 #define HEADER_TYPE1		(13 * sizeof(__le16))
198 #define HEADER_TYPE2		(15 * sizeof(__le16))
199 #define HEADER_TYPE3		(19 * sizeof(__le16))
200 #define HEADER_TYPE4		(23 * sizeof(__le16))
201 
202 /* trackpad button data offsets */
203 #define BUTTON_TYPE1		0
204 #define BUTTON_TYPE2		15
205 #define BUTTON_TYPE3		23
206 #define BUTTON_TYPE4		31
207 
208 /* list of device capability bits */
209 #define HAS_INTEGRATED_BUTTON	1
210 
211 /* trackpad finger data block size */
212 #define FSIZE_TYPE1		(14 * sizeof(__le16))
213 #define FSIZE_TYPE2		(14 * sizeof(__le16))
214 #define FSIZE_TYPE3		(14 * sizeof(__le16))
215 #define FSIZE_TYPE4		(15 * sizeof(__le16))
216 
217 /* offset from header to finger struct */
218 #define DELTA_TYPE1		(0 * sizeof(__le16))
219 #define DELTA_TYPE2		(0 * sizeof(__le16))
220 #define DELTA_TYPE3		(0 * sizeof(__le16))
221 #define DELTA_TYPE4		(1 * sizeof(__le16))
222 
223 /* usb control message mode switch data */
224 #define USBMSG_TYPE1		8, 0x300, 0, 0, 0x1, 0x8
225 #define USBMSG_TYPE2		8, 0x300, 0, 0, 0x1, 0x8
226 #define USBMSG_TYPE3		8, 0x300, 0, 0, 0x1, 0x8
227 #define USBMSG_TYPE4		2, 0x302, 2, 1, 0x1, 0x0
228 
229 /* Wellspring initialization constants */
230 #define BCM5974_WELLSPRING_MODE_READ_REQUEST_ID		1
231 #define BCM5974_WELLSPRING_MODE_WRITE_REQUEST_ID	9
232 
233 /* trackpad finger structure, le16-aligned */
234 struct tp_finger {
235 	__le16 origin;		/* zero when switching track finger */
236 	__le16 abs_x;		/* absolute x coodinate */
237 	__le16 abs_y;		/* absolute y coodinate */
238 	__le16 rel_x;		/* relative x coodinate */
239 	__le16 rel_y;		/* relative y coodinate */
240 	__le16 tool_major;	/* tool area, major axis */
241 	__le16 tool_minor;	/* tool area, minor axis */
242 	__le16 orientation;	/* 16384 when point, else 15 bit angle */
243 	__le16 touch_major;	/* touch area, major axis */
244 	__le16 touch_minor;	/* touch area, minor axis */
245 	__le16 unused[2];	/* zeros */
246 	__le16 pressure;	/* pressure on forcetouch touchpad */
247 	__le16 multi;		/* one finger: varies, more fingers: constant */
248 } __attribute__((packed,aligned(2)));
249 
250 /* trackpad finger data size, empirically at least ten fingers */
251 #define MAX_FINGERS		16
252 #define MAX_FINGER_ORIENTATION	16384
253 
254 /* device-specific parameters */
255 struct bcm5974_param {
256 	int snratio;		/* signal-to-noise ratio */
257 	int min;		/* device minimum reading */
258 	int max;		/* device maximum reading */
259 };
260 
261 /* device-specific configuration */
262 struct bcm5974_config {
263 	int ansi, iso, jis;	/* the product id of this device */
264 	int caps;		/* device capability bitmask */
265 	int bt_ep;		/* the endpoint of the button interface */
266 	int bt_datalen;		/* data length of the button interface */
267 	int tp_ep;		/* the endpoint of the trackpad interface */
268 	enum tp_type tp_type;	/* type of trackpad interface */
269 	int tp_header;		/* bytes in header block */
270 	int tp_datalen;		/* data length of the trackpad interface */
271 	int tp_button;		/* offset to button data */
272 	int tp_fsize;		/* bytes in single finger block */
273 	int tp_delta;		/* offset from header to finger struct */
274 	int um_size;		/* usb control message length */
275 	int um_req_val;		/* usb control message value */
276 	int um_req_idx;		/* usb control message index */
277 	int um_switch_idx;	/* usb control message mode switch index */
278 	int um_switch_on;	/* usb control message mode switch on */
279 	int um_switch_off;	/* usb control message mode switch off */
280 	struct bcm5974_param p;	/* finger pressure limits */
281 	struct bcm5974_param w;	/* finger width limits */
282 	struct bcm5974_param x;	/* horizontal limits */
283 	struct bcm5974_param y;	/* vertical limits */
284 	struct bcm5974_param o;	/* orientation limits */
285 };
286 
287 /* logical device structure */
288 struct bcm5974 {
289 	char phys[64];
290 	struct usb_device *udev;	/* usb device */
291 	struct usb_interface *intf;	/* our interface */
292 	struct input_dev *input;	/* input dev */
293 	struct bcm5974_config cfg;	/* device configuration */
294 	struct mutex pm_mutex;		/* serialize access to open/suspend */
295 	int opened;			/* 1: opened, 0: closed */
296 	struct urb *bt_urb;		/* button usb request block */
297 	struct bt_data *bt_data;	/* button transferred data */
298 	struct urb *tp_urb;		/* trackpad usb request block */
299 	u8 *tp_data;			/* trackpad transferred data */
300 	const struct tp_finger *index[MAX_FINGERS];	/* finger index data */
301 	struct input_mt_pos pos[MAX_FINGERS];		/* position array */
302 	int slots[MAX_FINGERS];				/* slot assignments */
303 };
304 
305 /* trackpad finger block data, le16-aligned */
get_tp_finger(const struct bcm5974 * dev,int i)306 static const struct tp_finger *get_tp_finger(const struct bcm5974 *dev, int i)
307 {
308 	const struct bcm5974_config *c = &dev->cfg;
309 	u8 *f_base = dev->tp_data + c->tp_header + c->tp_delta;
310 
311 	return (const struct tp_finger *)(f_base + i * c->tp_fsize);
312 }
313 
314 #define DATAFORMAT(type)				\
315 	type,						\
316 	HEADER_##type,					\
317 	HEADER_##type + (MAX_FINGERS) * (FSIZE_##type),	\
318 	BUTTON_##type,					\
319 	FSIZE_##type,					\
320 	DELTA_##type,					\
321 	USBMSG_##type
322 
323 /* logical signal quality */
324 #define SN_PRESSURE	45		/* pressure signal-to-noise ratio */
325 #define SN_WIDTH	25		/* width signal-to-noise ratio */
326 #define SN_COORD	250		/* coordinate signal-to-noise ratio */
327 #define SN_ORIENT	10		/* orientation signal-to-noise ratio */
328 
329 /* device constants */
330 static const struct bcm5974_config bcm5974_config_table[] = {
331 	{
332 		USB_DEVICE_ID_APPLE_WELLSPRING_ANSI,
333 		USB_DEVICE_ID_APPLE_WELLSPRING_ISO,
334 		USB_DEVICE_ID_APPLE_WELLSPRING_JIS,
335 		0,
336 		0x84, sizeof(struct bt_data),
337 		0x81, DATAFORMAT(TYPE1),
338 		{ SN_PRESSURE, 0, 256 },
339 		{ SN_WIDTH, 0, 2048 },
340 		{ SN_COORD, -4824, 5342 },
341 		{ SN_COORD, -172, 5820 },
342 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
343 	},
344 	{
345 		USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI,
346 		USB_DEVICE_ID_APPLE_WELLSPRING2_ISO,
347 		USB_DEVICE_ID_APPLE_WELLSPRING2_JIS,
348 		0,
349 		0x84, sizeof(struct bt_data),
350 		0x81, DATAFORMAT(TYPE1),
351 		{ SN_PRESSURE, 0, 256 },
352 		{ SN_WIDTH, 0, 2048 },
353 		{ SN_COORD, -4824, 4824 },
354 		{ SN_COORD, -172, 4290 },
355 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
356 	},
357 	{
358 		USB_DEVICE_ID_APPLE_WELLSPRING3_ANSI,
359 		USB_DEVICE_ID_APPLE_WELLSPRING3_ISO,
360 		USB_DEVICE_ID_APPLE_WELLSPRING3_JIS,
361 		HAS_INTEGRATED_BUTTON,
362 		0x84, sizeof(struct bt_data),
363 		0x81, DATAFORMAT(TYPE2),
364 		{ SN_PRESSURE, 0, 300 },
365 		{ SN_WIDTH, 0, 2048 },
366 		{ SN_COORD, -4460, 5166 },
367 		{ SN_COORD, -75, 6700 },
368 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
369 	},
370 	{
371 		USB_DEVICE_ID_APPLE_WELLSPRING4_ANSI,
372 		USB_DEVICE_ID_APPLE_WELLSPRING4_ISO,
373 		USB_DEVICE_ID_APPLE_WELLSPRING4_JIS,
374 		HAS_INTEGRATED_BUTTON,
375 		0x84, sizeof(struct bt_data),
376 		0x81, DATAFORMAT(TYPE2),
377 		{ SN_PRESSURE, 0, 300 },
378 		{ SN_WIDTH, 0, 2048 },
379 		{ SN_COORD, -4620, 5140 },
380 		{ SN_COORD, -150, 6600 },
381 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
382 	},
383 	{
384 		USB_DEVICE_ID_APPLE_WELLSPRING4A_ANSI,
385 		USB_DEVICE_ID_APPLE_WELLSPRING4A_ISO,
386 		USB_DEVICE_ID_APPLE_WELLSPRING4A_JIS,
387 		HAS_INTEGRATED_BUTTON,
388 		0x84, sizeof(struct bt_data),
389 		0x81, DATAFORMAT(TYPE2),
390 		{ SN_PRESSURE, 0, 300 },
391 		{ SN_WIDTH, 0, 2048 },
392 		{ SN_COORD, -4616, 5112 },
393 		{ SN_COORD, -142, 5234 },
394 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
395 	},
396 	{
397 		USB_DEVICE_ID_APPLE_WELLSPRING5_ANSI,
398 		USB_DEVICE_ID_APPLE_WELLSPRING5_ISO,
399 		USB_DEVICE_ID_APPLE_WELLSPRING5_JIS,
400 		HAS_INTEGRATED_BUTTON,
401 		0x84, sizeof(struct bt_data),
402 		0x81, DATAFORMAT(TYPE2),
403 		{ SN_PRESSURE, 0, 300 },
404 		{ SN_WIDTH, 0, 2048 },
405 		{ SN_COORD, -4415, 5050 },
406 		{ SN_COORD, -55, 6680 },
407 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
408 	},
409 	{
410 		USB_DEVICE_ID_APPLE_WELLSPRING6_ANSI,
411 		USB_DEVICE_ID_APPLE_WELLSPRING6_ISO,
412 		USB_DEVICE_ID_APPLE_WELLSPRING6_JIS,
413 		HAS_INTEGRATED_BUTTON,
414 		0x84, sizeof(struct bt_data),
415 		0x81, DATAFORMAT(TYPE2),
416 		{ SN_PRESSURE, 0, 300 },
417 		{ SN_WIDTH, 0, 2048 },
418 		{ SN_COORD, -4620, 5140 },
419 		{ SN_COORD, -150, 6600 },
420 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
421 	},
422 	{
423 		USB_DEVICE_ID_APPLE_WELLSPRING5A_ANSI,
424 		USB_DEVICE_ID_APPLE_WELLSPRING5A_ISO,
425 		USB_DEVICE_ID_APPLE_WELLSPRING5A_JIS,
426 		HAS_INTEGRATED_BUTTON,
427 		0x84, sizeof(struct bt_data),
428 		0x81, DATAFORMAT(TYPE2),
429 		{ SN_PRESSURE, 0, 300 },
430 		{ SN_WIDTH, 0, 2048 },
431 		{ SN_COORD, -4750, 5280 },
432 		{ SN_COORD, -150, 6730 },
433 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
434 	},
435 	{
436 		USB_DEVICE_ID_APPLE_WELLSPRING6A_ANSI,
437 		USB_DEVICE_ID_APPLE_WELLSPRING6A_ISO,
438 		USB_DEVICE_ID_APPLE_WELLSPRING6A_JIS,
439 		HAS_INTEGRATED_BUTTON,
440 		0x84, sizeof(struct bt_data),
441 		0x81, DATAFORMAT(TYPE2),
442 		{ SN_PRESSURE, 0, 300 },
443 		{ SN_WIDTH, 0, 2048 },
444 		{ SN_COORD, -4620, 5140 },
445 		{ SN_COORD, -150, 6600 },
446 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
447 	},
448 	{
449 		USB_DEVICE_ID_APPLE_WELLSPRING7_ANSI,
450 		USB_DEVICE_ID_APPLE_WELLSPRING7_ISO,
451 		USB_DEVICE_ID_APPLE_WELLSPRING7_JIS,
452 		HAS_INTEGRATED_BUTTON,
453 		0x84, sizeof(struct bt_data),
454 		0x81, DATAFORMAT(TYPE2),
455 		{ SN_PRESSURE, 0, 300 },
456 		{ SN_WIDTH, 0, 2048 },
457 		{ SN_COORD, -4750, 5280 },
458 		{ SN_COORD, -150, 6730 },
459 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
460 	},
461 	{
462 		USB_DEVICE_ID_APPLE_WELLSPRING7A_ANSI,
463 		USB_DEVICE_ID_APPLE_WELLSPRING7A_ISO,
464 		USB_DEVICE_ID_APPLE_WELLSPRING7A_JIS,
465 		HAS_INTEGRATED_BUTTON,
466 		0x84, sizeof(struct bt_data),
467 		0x81, DATAFORMAT(TYPE2),
468 		{ SN_PRESSURE, 0, 300 },
469 		{ SN_WIDTH, 0, 2048 },
470 		{ SN_COORD, -4750, 5280 },
471 		{ SN_COORD, -150, 6730 },
472 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
473 	},
474 	{
475 		USB_DEVICE_ID_APPLE_WELLSPRING8_ANSI,
476 		USB_DEVICE_ID_APPLE_WELLSPRING8_ISO,
477 		USB_DEVICE_ID_APPLE_WELLSPRING8_JIS,
478 		HAS_INTEGRATED_BUTTON,
479 		0, sizeof(struct bt_data),
480 		0x83, DATAFORMAT(TYPE3),
481 		{ SN_PRESSURE, 0, 300 },
482 		{ SN_WIDTH, 0, 2048 },
483 		{ SN_COORD, -4620, 5140 },
484 		{ SN_COORD, -150, 6600 },
485 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
486 	},
487 	{
488 		USB_DEVICE_ID_APPLE_WELLSPRING9_ANSI,
489 		USB_DEVICE_ID_APPLE_WELLSPRING9_ISO,
490 		USB_DEVICE_ID_APPLE_WELLSPRING9_JIS,
491 		HAS_INTEGRATED_BUTTON,
492 		0, sizeof(struct bt_data),
493 		0x83, DATAFORMAT(TYPE4),
494 		{ SN_PRESSURE, 0, 300 },
495 		{ SN_WIDTH, 0, 2048 },
496 		{ SN_COORD, -4828, 5345 },
497 		{ SN_COORD, -203, 6803 },
498 		{ SN_ORIENT, -MAX_FINGER_ORIENTATION, MAX_FINGER_ORIENTATION }
499 	},
500 	{}
501 };
502 
503 /* return the device-specific configuration by device */
bcm5974_get_config(struct usb_device * udev)504 static const struct bcm5974_config *bcm5974_get_config(struct usb_device *udev)
505 {
506 	u16 id = le16_to_cpu(udev->descriptor.idProduct);
507 	const struct bcm5974_config *cfg;
508 
509 	for (cfg = bcm5974_config_table; cfg->ansi; ++cfg)
510 		if (cfg->ansi == id || cfg->iso == id || cfg->jis == id)
511 			return cfg;
512 
513 	return bcm5974_config_table;
514 }
515 
516 /* convert 16-bit little endian to signed integer */
raw2int(__le16 x)517 static inline int raw2int(__le16 x)
518 {
519 	return (signed short)le16_to_cpu(x);
520 }
521 
set_abs(struct input_dev * input,unsigned int code,const struct bcm5974_param * p)522 static void set_abs(struct input_dev *input, unsigned int code,
523 		    const struct bcm5974_param *p)
524 {
525 	int fuzz = p->snratio ? (p->max - p->min) / p->snratio : 0;
526 	input_set_abs_params(input, code, p->min, p->max, fuzz, 0);
527 }
528 
529 /* setup which logical events to report */
setup_events_to_report(struct input_dev * input_dev,const struct bcm5974_config * cfg)530 static void setup_events_to_report(struct input_dev *input_dev,
531 				   const struct bcm5974_config *cfg)
532 {
533 	__set_bit(EV_ABS, input_dev->evbit);
534 
535 	/* for synaptics only */
536 	input_set_abs_params(input_dev, ABS_PRESSURE, 0, 256, 5, 0);
537 	input_set_abs_params(input_dev, ABS_TOOL_WIDTH, 0, 16, 0, 0);
538 
539 	/* finger touch area */
540 	set_abs(input_dev, ABS_MT_TOUCH_MAJOR, &cfg->w);
541 	set_abs(input_dev, ABS_MT_TOUCH_MINOR, &cfg->w);
542 	/* finger approach area */
543 	set_abs(input_dev, ABS_MT_WIDTH_MAJOR, &cfg->w);
544 	set_abs(input_dev, ABS_MT_WIDTH_MINOR, &cfg->w);
545 	/* finger orientation */
546 	set_abs(input_dev, ABS_MT_ORIENTATION, &cfg->o);
547 	/* finger position */
548 	set_abs(input_dev, ABS_MT_POSITION_X, &cfg->x);
549 	set_abs(input_dev, ABS_MT_POSITION_Y, &cfg->y);
550 
551 	__set_bit(EV_KEY, input_dev->evbit);
552 	__set_bit(BTN_LEFT, input_dev->keybit);
553 
554 	if (cfg->caps & HAS_INTEGRATED_BUTTON)
555 		__set_bit(INPUT_PROP_BUTTONPAD, input_dev->propbit);
556 
557 	input_mt_init_slots(input_dev, MAX_FINGERS,
558 		INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED | INPUT_MT_TRACK);
559 }
560 
561 /* report button data as logical button state */
report_bt_state(struct bcm5974 * dev,int size)562 static int report_bt_state(struct bcm5974 *dev, int size)
563 {
564 	if (size != sizeof(struct bt_data))
565 		return -EIO;
566 
567 	dprintk(7,
568 		"bcm5974: button data: %x %x %x %x\n",
569 		dev->bt_data->unknown1, dev->bt_data->button,
570 		dev->bt_data->rel_x, dev->bt_data->rel_y);
571 
572 	input_report_key(dev->input, BTN_LEFT, dev->bt_data->button);
573 	input_sync(dev->input);
574 
575 	return 0;
576 }
577 
report_finger_data(struct input_dev * input,int slot,const struct input_mt_pos * pos,const struct tp_finger * f)578 static void report_finger_data(struct input_dev *input, int slot,
579 			       const struct input_mt_pos *pos,
580 			       const struct tp_finger *f)
581 {
582 	input_mt_slot(input, slot);
583 	input_mt_report_slot_state(input, MT_TOOL_FINGER, true);
584 
585 	input_report_abs(input, ABS_MT_TOUCH_MAJOR,
586 			 raw2int(f->touch_major) << 1);
587 	input_report_abs(input, ABS_MT_TOUCH_MINOR,
588 			 raw2int(f->touch_minor) << 1);
589 	input_report_abs(input, ABS_MT_WIDTH_MAJOR,
590 			 raw2int(f->tool_major) << 1);
591 	input_report_abs(input, ABS_MT_WIDTH_MINOR,
592 			 raw2int(f->tool_minor) << 1);
593 	input_report_abs(input, ABS_MT_ORIENTATION,
594 			 MAX_FINGER_ORIENTATION - raw2int(f->orientation));
595 	input_report_abs(input, ABS_MT_POSITION_X, pos->x);
596 	input_report_abs(input, ABS_MT_POSITION_Y, pos->y);
597 }
598 
report_synaptics_data(struct input_dev * input,const struct bcm5974_config * cfg,const struct tp_finger * f,int raw_n)599 static void report_synaptics_data(struct input_dev *input,
600 				  const struct bcm5974_config *cfg,
601 				  const struct tp_finger *f, int raw_n)
602 {
603 	int abs_p = 0, abs_w = 0;
604 
605 	if (raw_n) {
606 		int p = raw2int(f->touch_major);
607 		int w = raw2int(f->tool_major);
608 		if (p > 0 && raw2int(f->origin)) {
609 			abs_p = clamp_val(256 * p / cfg->p.max, 0, 255);
610 			abs_w = clamp_val(16 * w / cfg->w.max, 0, 15);
611 		}
612 	}
613 
614 	input_report_abs(input, ABS_PRESSURE, abs_p);
615 	input_report_abs(input, ABS_TOOL_WIDTH, abs_w);
616 }
617 
618 /* report trackpad data as logical trackpad state */
report_tp_state(struct bcm5974 * dev,int size)619 static int report_tp_state(struct bcm5974 *dev, int size)
620 {
621 	const struct bcm5974_config *c = &dev->cfg;
622 	const struct tp_finger *f;
623 	struct input_dev *input = dev->input;
624 	int raw_n, i, n = 0;
625 
626 	if (size < c->tp_header || (size - c->tp_header) % c->tp_fsize != 0)
627 		return -EIO;
628 
629 	raw_n = (size - c->tp_header) / c->tp_fsize;
630 
631 	for (i = 0; i < raw_n; i++) {
632 		f = get_tp_finger(dev, i);
633 		if (raw2int(f->touch_major) == 0)
634 			continue;
635 		dev->pos[n].x = raw2int(f->abs_x);
636 		dev->pos[n].y = c->y.min + c->y.max - raw2int(f->abs_y);
637 		dev->index[n++] = f;
638 	}
639 
640 	input_mt_assign_slots(input, dev->slots, dev->pos, n, 0);
641 
642 	for (i = 0; i < n; i++)
643 		report_finger_data(input, dev->slots[i],
644 				   &dev->pos[i], dev->index[i]);
645 
646 	input_mt_sync_frame(input);
647 
648 	report_synaptics_data(input, c, get_tp_finger(dev, 0), raw_n);
649 
650 	/* later types report button events via integrated button only */
651 	if (c->caps & HAS_INTEGRATED_BUTTON) {
652 		int ibt = raw2int(dev->tp_data[c->tp_button]);
653 		input_report_key(input, BTN_LEFT, ibt);
654 	}
655 
656 	input_sync(input);
657 
658 	return 0;
659 }
660 
bcm5974_wellspring_mode(struct bcm5974 * dev,bool on)661 static int bcm5974_wellspring_mode(struct bcm5974 *dev, bool on)
662 {
663 	const struct bcm5974_config *c = &dev->cfg;
664 	int retval = 0, size;
665 	char *data;
666 
667 	/* Type 3 does not require a mode switch */
668 	if (c->tp_type == TYPE3)
669 		return 0;
670 
671 	data = kmalloc(c->um_size, GFP_KERNEL);
672 	if (!data) {
673 		dev_err(&dev->intf->dev, "out of memory\n");
674 		retval = -ENOMEM;
675 		goto out;
676 	}
677 
678 	/* read configuration */
679 	size = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
680 			BCM5974_WELLSPRING_MODE_READ_REQUEST_ID,
681 			USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
682 			c->um_req_val, c->um_req_idx, data, c->um_size, 5000);
683 
684 	if (size != c->um_size) {
685 		dev_err(&dev->intf->dev, "could not read from device\n");
686 		retval = -EIO;
687 		goto out;
688 	}
689 
690 	/* apply the mode switch */
691 	data[c->um_switch_idx] = on ? c->um_switch_on : c->um_switch_off;
692 
693 	/* write configuration */
694 	size = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
695 			BCM5974_WELLSPRING_MODE_WRITE_REQUEST_ID,
696 			USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
697 			c->um_req_val, c->um_req_idx, data, c->um_size, 5000);
698 
699 	if (size != c->um_size) {
700 		dev_err(&dev->intf->dev, "could not write to device\n");
701 		retval = -EIO;
702 		goto out;
703 	}
704 
705 	dprintk(2, "bcm5974: switched to %s mode.\n",
706 		on ? "wellspring" : "normal");
707 
708  out:
709 	kfree(data);
710 	return retval;
711 }
712 
bcm5974_irq_button(struct urb * urb)713 static void bcm5974_irq_button(struct urb *urb)
714 {
715 	struct bcm5974 *dev = urb->context;
716 	struct usb_interface *intf = dev->intf;
717 	int error;
718 
719 	switch (urb->status) {
720 	case 0:
721 		break;
722 	case -EOVERFLOW:
723 	case -ECONNRESET:
724 	case -ENOENT:
725 	case -ESHUTDOWN:
726 		dev_dbg(&intf->dev, "button urb shutting down: %d\n",
727 			urb->status);
728 		return;
729 	default:
730 		dev_dbg(&intf->dev, "button urb status: %d\n", urb->status);
731 		goto exit;
732 	}
733 
734 	if (report_bt_state(dev, dev->bt_urb->actual_length))
735 		dprintk(1, "bcm5974: bad button package, length: %d\n",
736 			dev->bt_urb->actual_length);
737 
738 exit:
739 	error = usb_submit_urb(dev->bt_urb, GFP_ATOMIC);
740 	if (error)
741 		dev_err(&intf->dev, "button urb failed: %d\n", error);
742 }
743 
bcm5974_irq_trackpad(struct urb * urb)744 static void bcm5974_irq_trackpad(struct urb *urb)
745 {
746 	struct bcm5974 *dev = urb->context;
747 	struct usb_interface *intf = dev->intf;
748 	int error;
749 
750 	switch (urb->status) {
751 	case 0:
752 		break;
753 	case -EOVERFLOW:
754 	case -ECONNRESET:
755 	case -ENOENT:
756 	case -ESHUTDOWN:
757 		dev_dbg(&intf->dev, "trackpad urb shutting down: %d\n",
758 			urb->status);
759 		return;
760 	default:
761 		dev_dbg(&intf->dev, "trackpad urb status: %d\n", urb->status);
762 		goto exit;
763 	}
764 
765 	/* control response ignored */
766 	if (dev->tp_urb->actual_length == 2)
767 		goto exit;
768 
769 	if (report_tp_state(dev, dev->tp_urb->actual_length))
770 		dprintk(1, "bcm5974: bad trackpad package, length: %d\n",
771 			dev->tp_urb->actual_length);
772 
773 exit:
774 	error = usb_submit_urb(dev->tp_urb, GFP_ATOMIC);
775 	if (error)
776 		dev_err(&intf->dev, "trackpad urb failed: %d\n", error);
777 }
778 
779 /*
780  * The Wellspring trackpad, like many recent Apple trackpads, share
781  * the usb device with the keyboard. Since keyboards are usually
782  * handled by the HID system, the device ends up being handled by two
783  * modules. Setting up the device therefore becomes slightly
784  * complicated. To enable multitouch features, a mode switch is
785  * required, which is usually applied via the control interface of the
786  * device.  It can be argued where this switch should take place. In
787  * some drivers, like appletouch, the switch is made during
788  * probe. However, the hid module may also alter the state of the
789  * device, resulting in trackpad malfunction under certain
790  * circumstances. To get around this problem, there is at least one
791  * example that utilizes the USB_QUIRK_RESET_RESUME quirk in order to
792  * receive a reset_resume request rather than the normal resume.
793  * Since the implementation of reset_resume is equal to mode switch
794  * plus start_traffic, it seems easier to always do the switch when
795  * starting traffic on the device.
796  */
bcm5974_start_traffic(struct bcm5974 * dev)797 static int bcm5974_start_traffic(struct bcm5974 *dev)
798 {
799 	int error;
800 
801 	error = bcm5974_wellspring_mode(dev, true);
802 	if (error) {
803 		dprintk(1, "bcm5974: mode switch failed\n");
804 		goto err_out;
805 	}
806 
807 	if (dev->bt_urb) {
808 		error = usb_submit_urb(dev->bt_urb, GFP_KERNEL);
809 		if (error)
810 			goto err_reset_mode;
811 	}
812 
813 	error = usb_submit_urb(dev->tp_urb, GFP_KERNEL);
814 	if (error)
815 		goto err_kill_bt;
816 
817 	return 0;
818 
819 err_kill_bt:
820 	usb_kill_urb(dev->bt_urb);
821 err_reset_mode:
822 	bcm5974_wellspring_mode(dev, false);
823 err_out:
824 	return error;
825 }
826 
bcm5974_pause_traffic(struct bcm5974 * dev)827 static void bcm5974_pause_traffic(struct bcm5974 *dev)
828 {
829 	usb_kill_urb(dev->tp_urb);
830 	usb_kill_urb(dev->bt_urb);
831 	bcm5974_wellspring_mode(dev, false);
832 }
833 
834 /*
835  * The code below implements open/close and manual suspend/resume.
836  * All functions may be called in random order.
837  *
838  * Opening a suspended device fails with EACCES - permission denied.
839  *
840  * Failing a resume leaves the device resumed but closed.
841  */
bcm5974_open(struct input_dev * input)842 static int bcm5974_open(struct input_dev *input)
843 {
844 	struct bcm5974 *dev = input_get_drvdata(input);
845 	int error;
846 
847 	error = usb_autopm_get_interface(dev->intf);
848 	if (error)
849 		return error;
850 
851 	mutex_lock(&dev->pm_mutex);
852 
853 	error = bcm5974_start_traffic(dev);
854 	if (!error)
855 		dev->opened = 1;
856 
857 	mutex_unlock(&dev->pm_mutex);
858 
859 	if (error)
860 		usb_autopm_put_interface(dev->intf);
861 
862 	return error;
863 }
864 
bcm5974_close(struct input_dev * input)865 static void bcm5974_close(struct input_dev *input)
866 {
867 	struct bcm5974 *dev = input_get_drvdata(input);
868 
869 	mutex_lock(&dev->pm_mutex);
870 
871 	bcm5974_pause_traffic(dev);
872 	dev->opened = 0;
873 
874 	mutex_unlock(&dev->pm_mutex);
875 
876 	usb_autopm_put_interface(dev->intf);
877 }
878 
bcm5974_suspend(struct usb_interface * iface,pm_message_t message)879 static int bcm5974_suspend(struct usb_interface *iface, pm_message_t message)
880 {
881 	struct bcm5974 *dev = usb_get_intfdata(iface);
882 
883 	mutex_lock(&dev->pm_mutex);
884 
885 	if (dev->opened)
886 		bcm5974_pause_traffic(dev);
887 
888 	mutex_unlock(&dev->pm_mutex);
889 
890 	return 0;
891 }
892 
bcm5974_resume(struct usb_interface * iface)893 static int bcm5974_resume(struct usb_interface *iface)
894 {
895 	struct bcm5974 *dev = usb_get_intfdata(iface);
896 	int error = 0;
897 
898 	mutex_lock(&dev->pm_mutex);
899 
900 	if (dev->opened)
901 		error = bcm5974_start_traffic(dev);
902 
903 	mutex_unlock(&dev->pm_mutex);
904 
905 	return error;
906 }
907 
bcm5974_probe(struct usb_interface * iface,const struct usb_device_id * id)908 static int bcm5974_probe(struct usb_interface *iface,
909 			 const struct usb_device_id *id)
910 {
911 	struct usb_device *udev = interface_to_usbdev(iface);
912 	const struct bcm5974_config *cfg;
913 	struct bcm5974 *dev;
914 	struct input_dev *input_dev;
915 	int error = -ENOMEM;
916 
917 	/* find the product index */
918 	cfg = bcm5974_get_config(udev);
919 
920 	/* allocate memory for our device state and initialize it */
921 	dev = kzalloc(sizeof(struct bcm5974), GFP_KERNEL);
922 	input_dev = input_allocate_device();
923 	if (!dev || !input_dev) {
924 		dev_err(&iface->dev, "out of memory\n");
925 		goto err_free_devs;
926 	}
927 
928 	dev->udev = udev;
929 	dev->intf = iface;
930 	dev->input = input_dev;
931 	dev->cfg = *cfg;
932 	mutex_init(&dev->pm_mutex);
933 
934 	/* setup urbs */
935 	if (cfg->tp_type == TYPE1) {
936 		dev->bt_urb = usb_alloc_urb(0, GFP_KERNEL);
937 		if (!dev->bt_urb)
938 			goto err_free_devs;
939 	}
940 
941 	dev->tp_urb = usb_alloc_urb(0, GFP_KERNEL);
942 	if (!dev->tp_urb)
943 		goto err_free_bt_urb;
944 
945 	if (dev->bt_urb) {
946 		dev->bt_data = usb_alloc_coherent(dev->udev,
947 					  dev->cfg.bt_datalen, GFP_KERNEL,
948 					  &dev->bt_urb->transfer_dma);
949 		if (!dev->bt_data)
950 			goto err_free_urb;
951 	}
952 
953 	dev->tp_data = usb_alloc_coherent(dev->udev,
954 					  dev->cfg.tp_datalen, GFP_KERNEL,
955 					  &dev->tp_urb->transfer_dma);
956 	if (!dev->tp_data)
957 		goto err_free_bt_buffer;
958 
959 	if (dev->bt_urb)
960 		usb_fill_int_urb(dev->bt_urb, udev,
961 				 usb_rcvintpipe(udev, cfg->bt_ep),
962 				 dev->bt_data, dev->cfg.bt_datalen,
963 				 bcm5974_irq_button, dev, 1);
964 
965 	usb_fill_int_urb(dev->tp_urb, udev,
966 			 usb_rcvintpipe(udev, cfg->tp_ep),
967 			 dev->tp_data, dev->cfg.tp_datalen,
968 			 bcm5974_irq_trackpad, dev, 1);
969 
970 	/* create bcm5974 device */
971 	usb_make_path(udev, dev->phys, sizeof(dev->phys));
972 	strlcat(dev->phys, "/input0", sizeof(dev->phys));
973 
974 	input_dev->name = "bcm5974";
975 	input_dev->phys = dev->phys;
976 	usb_to_input_id(dev->udev, &input_dev->id);
977 	/* report driver capabilities via the version field */
978 	input_dev->id.version = cfg->caps;
979 	input_dev->dev.parent = &iface->dev;
980 
981 	input_set_drvdata(input_dev, dev);
982 
983 	input_dev->open = bcm5974_open;
984 	input_dev->close = bcm5974_close;
985 
986 	setup_events_to_report(input_dev, cfg);
987 
988 	error = input_register_device(dev->input);
989 	if (error)
990 		goto err_free_buffer;
991 
992 	/* save our data pointer in this interface device */
993 	usb_set_intfdata(iface, dev);
994 
995 	return 0;
996 
997 err_free_buffer:
998 	usb_free_coherent(dev->udev, dev->cfg.tp_datalen,
999 		dev->tp_data, dev->tp_urb->transfer_dma);
1000 err_free_bt_buffer:
1001 	if (dev->bt_urb)
1002 		usb_free_coherent(dev->udev, dev->cfg.bt_datalen,
1003 				  dev->bt_data, dev->bt_urb->transfer_dma);
1004 err_free_urb:
1005 	usb_free_urb(dev->tp_urb);
1006 err_free_bt_urb:
1007 	usb_free_urb(dev->bt_urb);
1008 err_free_devs:
1009 	usb_set_intfdata(iface, NULL);
1010 	input_free_device(input_dev);
1011 	kfree(dev);
1012 	return error;
1013 }
1014 
bcm5974_disconnect(struct usb_interface * iface)1015 static void bcm5974_disconnect(struct usb_interface *iface)
1016 {
1017 	struct bcm5974 *dev = usb_get_intfdata(iface);
1018 
1019 	usb_set_intfdata(iface, NULL);
1020 
1021 	input_unregister_device(dev->input);
1022 	usb_free_coherent(dev->udev, dev->cfg.tp_datalen,
1023 			  dev->tp_data, dev->tp_urb->transfer_dma);
1024 	if (dev->bt_urb)
1025 		usb_free_coherent(dev->udev, dev->cfg.bt_datalen,
1026 				  dev->bt_data, dev->bt_urb->transfer_dma);
1027 	usb_free_urb(dev->tp_urb);
1028 	usb_free_urb(dev->bt_urb);
1029 	kfree(dev);
1030 }
1031 
1032 static struct usb_driver bcm5974_driver = {
1033 	.name			= "bcm5974",
1034 	.probe			= bcm5974_probe,
1035 	.disconnect		= bcm5974_disconnect,
1036 	.suspend		= bcm5974_suspend,
1037 	.resume			= bcm5974_resume,
1038 	.id_table		= bcm5974_table,
1039 	.supports_autosuspend	= 1,
1040 };
1041 
1042 module_usb_driver(bcm5974_driver);
1043