Linux Audio

Check our new training course

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