linux/drivers/input/mouse/appletouch.c
<<
>>
Prefs
   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 urb              *urb;           /* usb request block */
 199        u8                      *data;          /* transferred data */
 200        struct input_dev        *input;         /* input dev */
 201        const struct atp_info   *info;          /* touchpad model */
 202        bool                    open;
 203        bool                    valid;          /* are the samples valid? */
 204        bool                    size_detect_done;
 205        bool                    overflow_warned;
 206        int                     x_old;          /* last reported x/y, */
 207        int                     y_old;          /* used for smoothing */
 208        signed char             xy_cur[ATP_XSENSORS + ATP_YSENSORS];
 209        signed char             xy_old[ATP_XSENSORS + ATP_YSENSORS];
 210        int                     xy_acc[ATP_XSENSORS + ATP_YSENSORS];
 211        int                     idlecount;      /* number of empty packets */
 212        struct work_struct      work;
 213};
 214
 215#define dbg_dump(msg, tab) \
 216        if (debug > 1) {                                                \
 217                int __i;                                                \
 218                printk(KERN_DEBUG "appletouch: %s", msg);               \
 219                for (__i = 0; __i < ATP_XSENSORS + ATP_YSENSORS; __i++) \
 220                        printk(" %02x", tab[__i]);                      \
 221                printk("\n");                                           \
 222        }
 223
 224#define dprintk(format, a...)                                           \
 225        do {                                                            \
 226                if (debug)                                              \
 227                        printk(KERN_DEBUG format, ##a);                 \
 228        } while (0)
 229
 230MODULE_AUTHOR("Johannes Berg");
 231MODULE_AUTHOR("Stelian Pop");
 232MODULE_AUTHOR("Frank Arnold");
 233MODULE_AUTHOR("Michael Hanselmann");
 234MODULE_AUTHOR("Sven Anders");
 235MODULE_DESCRIPTION("Apple PowerBook and MacBook USB touchpad driver");
 236MODULE_LICENSE("GPL");
 237
 238/*
 239 * Make the threshold a module parameter
 240 */
 241static int threshold = ATP_THRESHOLD;
 242module_param(threshold, int, 0644);
 243MODULE_PARM_DESC(threshold, "Discard any change in data from a sensor"
 244                            " (the trackpad has many of these sensors)"
 245                            " less than this value.");
 246
 247static int debug;
 248module_param(debug, int, 0644);
 249MODULE_PARM_DESC(debug, "Activate debugging output");
 250
 251/*
 252 * By default newer Geyser devices send standard USB HID mouse
 253 * packets (Report ID 2). This code changes device mode, so it
 254 * sends raw sensor reports (Report ID 5).
 255 */
 256static int atp_geyser_init(struct usb_device *udev)
 257{
 258        char *data;
 259        int size;
 260        int i;
 261        int ret;
 262
 263        data = kmalloc(8, GFP_KERNEL);
 264        if (!data) {
 265                err("Out of memory");
 266                return -ENOMEM;
 267        }
 268
 269        size = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
 270                        ATP_GEYSER_MODE_READ_REQUEST_ID,
 271                        USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
 272                        ATP_GEYSER_MODE_REQUEST_VALUE,
 273                        ATP_GEYSER_MODE_REQUEST_INDEX, data, 8, 5000);
 274
 275        if (size != 8) {
 276                dprintk("atp_geyser_init: read error\n");
 277                for (i = 0; i < 8; i++)
 278                        dprintk("appletouch[%d]: %d\n", i, data[i]);
 279
 280                err("Failed to read mode from device.");
 281                ret = -EIO;
 282                goto out_free;
 283        }
 284
 285        /* Apply the mode switch */
 286        data[0] = ATP_GEYSER_MODE_VENDOR_VALUE;
 287
 288        size = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
 289                        ATP_GEYSER_MODE_WRITE_REQUEST_ID,
 290                        USB_DIR_OUT | 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: write error\n");
 296                for (i = 0; i < 8; i++)
 297                        dprintk("appletouch[%d]: %d\n", i, data[i]);
 298
 299                err("Failed to request geyser raw mode");
 300                ret = -EIO;
 301                goto out_free;
 302        }
 303        ret = 0;
 304out_free:
 305        kfree(data);
 306        return ret;
 307}
 308
 309/*
 310 * Reinitialise the device. This usually stops stream of empty packets
 311 * coming from it.
 312 */
 313static void atp_reinit(struct work_struct *work)
 314{
 315        struct atp *dev = container_of(work, struct atp, work);
 316        struct usb_device *udev = dev->udev;
 317        int retval;
 318
 319        dprintk("appletouch: putting appletouch to sleep (reinit)\n");
 320        atp_geyser_init(udev);
 321
 322        retval = usb_submit_urb(dev->urb, GFP_ATOMIC);
 323        if (retval)
 324                err("atp_reinit: usb_submit_urb failed with error %d",
 325                    retval);
 326}
 327
 328static int atp_calculate_abs(int *xy_sensors, int nb_sensors, int fact,
 329                             int *z, int *fingers)
 330{
 331        int i;
 332        /* values to calculate mean */
 333        int pcum = 0, psum = 0;
 334        int is_increasing = 0;
 335
 336        *fingers = 0;
 337
 338        for (i = 0; i < nb_sensors; i++) {
 339                if (xy_sensors[i] < threshold) {
 340                        if (is_increasing)
 341                                is_increasing = 0;
 342
 343                        continue;
 344                }
 345
 346                /*
 347                 * Makes the finger detection more versatile.  For example,
 348                 * two fingers with no gap will be detected.  Also, my
 349                 * tests show it less likely to have intermittent loss
 350                 * of multiple finger readings while moving around (scrolling).
 351                 *
 352                 * Changes the multiple finger detection to counting humps on
 353                 * sensors (transitions from nonincreasing to increasing)
 354                 * instead of counting transitions from low sensors (no
 355                 * finger reading) to high sensors (finger above
 356                 * sensor)
 357                 *
 358                 * - Jason Parekh <jasonparekh@gmail.com>
 359                 */
 360                if (i < 1 ||
 361                    (!is_increasing && xy_sensors[i - 1] < xy_sensors[i])) {
 362                        (*fingers)++;
 363                        is_increasing = 1;
 364                } else if (i > 0 && xy_sensors[i - 1] >= xy_sensors[i]) {
 365                        is_increasing = 0;
 366                }
 367
 368                /*
 369                 * Subtracts threshold so a high sensor that just passes the
 370                 * threshold won't skew the calculated absolute coordinate.
 371                 * Fixes an issue where slowly moving the mouse would
 372                 * occasionally jump a number of pixels (slowly moving the
 373                 * finger makes this issue most apparent.)
 374                 */
 375                pcum += (xy_sensors[i] - threshold) * i;
 376                psum += (xy_sensors[i] - threshold);
 377        }
 378
 379        if (psum > 0) {
 380                *z = psum;
 381                return pcum * fact / psum;
 382        }
 383
 384        return 0;
 385}
 386
 387static inline void atp_report_fingers(struct input_dev *input, int fingers)
 388{
 389        input_report_key(input, BTN_TOOL_FINGER, fingers == 1);
 390        input_report_key(input, BTN_TOOL_DOUBLETAP, fingers == 2);
 391        input_report_key(input, BTN_TOOL_TRIPLETAP, fingers > 2);
 392}
 393
 394/* Check URB status and for correct length of data package */
 395
 396#define ATP_URB_STATUS_SUCCESS          0
 397#define ATP_URB_STATUS_ERROR            1
 398#define ATP_URB_STATUS_ERROR_FATAL      2
 399
 400static int atp_status_check(struct urb *urb)
 401{
 402        struct atp *dev = urb->context;
 403
 404        switch (urb->status) {
 405        case 0:
 406                /* success */
 407                break;
 408        case -EOVERFLOW:
 409                if (!dev->overflow_warned) {
 410                        printk(KERN_WARNING "appletouch: OVERFLOW with data "
 411                                "length %d, actual length is %d\n",
 412                                dev->info->datalen, dev->urb->actual_length);
 413                        dev->overflow_warned = true;
 414                }
 415        case -ECONNRESET:
 416        case -ENOENT:
 417        case -ESHUTDOWN:
 418                /* This urb is terminated, clean up */
 419                dbg("atp_complete: urb shutting down with status: %d",
 420                    urb->status);
 421                return ATP_URB_STATUS_ERROR_FATAL;
 422
 423        default:
 424                dbg("atp_complete: nonzero urb status received: %d",
 425                    urb->status);
 426                return ATP_URB_STATUS_ERROR;
 427        }
 428
 429        /* drop incomplete datasets */
 430        if (dev->urb->actual_length != dev->info->datalen) {
 431                dprintk("appletouch: incomplete data package"
 432                        " (first byte: %d, length: %d).\n",
 433                        dev->data[0], dev->urb->actual_length);
 434                return ATP_URB_STATUS_ERROR;
 435        }
 436
 437        return ATP_URB_STATUS_SUCCESS;
 438}
 439
 440static void atp_detect_size(struct atp *dev)
 441{
 442        int i;
 443
 444        /* 17" Powerbooks have extra X sensors */
 445        for (i = dev->info->xsensors; i < ATP_XSENSORS; i++) {
 446                if (dev->xy_cur[i]) {
 447
 448                        printk(KERN_INFO "appletouch: 17\" model detected.\n");
 449
 450                        input_set_abs_params(dev->input, ABS_X, 0,
 451                                             (dev->info->xsensors_17 - 1) *
 452                                                        dev->info->xfact - 1,
 453                                             ATP_FUZZ, 0);
 454                        break;
 455                }
 456        }
 457}
 458
 459/*
 460 * USB interrupt callback functions
 461 */
 462
 463/* Interrupt function for older touchpads: FOUNTAIN/GEYSER1/GEYSER2 */
 464
 465static void atp_complete_geyser_1_2(struct urb *urb)
 466{
 467        int x, y, x_z, y_z, x_f, y_f;
 468        int retval, i, j;
 469        int key;
 470        struct atp *dev = urb->context;
 471        int status = atp_status_check(urb);
 472
 473        if (status == ATP_URB_STATUS_ERROR_FATAL)
 474                return;
 475        else if (status == ATP_URB_STATUS_ERROR)
 476                goto exit;
 477
 478        /* reorder the sensors values */
 479        if (dev->info == &geyser2_info) {
 480                memset(dev->xy_cur, 0, sizeof(dev->xy_cur));
 481
 482                /*
 483                 * The values are laid out like this:
 484                 * Y1, Y2, -, Y3, Y4, -, ..., X1, X2, -, X3, X4, -, ...
 485                 * '-' is an unused value.
 486                 */
 487
 488                /* read X values */
 489                for (i = 0, j = 19; i < 20; i += 2, j += 3) {
 490                        dev->xy_cur[i] = dev->data[j];
 491                        dev->xy_cur[i + 1] = dev->data[j + 1];
 492                }
 493
 494                /* read Y values */
 495                for (i = 0, j = 1; i < 9; i += 2, j += 3) {
 496                        dev->xy_cur[ATP_XSENSORS + i] = dev->data[j];
 497                        dev->xy_cur[ATP_XSENSORS + i + 1] = dev->data[j + 1];
 498                }
 499        } else {
 500                for (i = 0; i < 8; i++) {
 501                        /* X values */
 502                        dev->xy_cur[i +  0] = dev->data[5 * i +  2];
 503                        dev->xy_cur[i +  8] = dev->data[5 * i +  4];
 504                        dev->xy_cur[i + 16] = dev->data[5 * i + 42];
 505                        if (i < 2)
 506                                dev->xy_cur[i + 24] = dev->data[5 * i + 44];
 507
 508                        /* Y values */
 509                        dev->xy_cur[ATP_XSENSORS + i] = dev->data[5 * i +  1];
 510                        dev->xy_cur[ATP_XSENSORS + i + 8] = dev->data[5 * i + 3];
 511                }
 512        }
 513
 514        dbg_dump("sample", dev->xy_cur);
 515
 516        if (!dev->valid) {
 517                /* first sample */
 518                dev->valid = true;
 519                dev->x_old = dev->y_old = -1;
 520
 521                /* Store first sample */
 522                memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old));
 523
 524                /* Perform size detection, if not done already */
 525                if (unlikely(!dev->size_detect_done)) {
 526                        atp_detect_size(dev);
 527                        dev->size_detect_done = 1;
 528                        goto exit;
 529                }
 530        }
 531
 532        for (i = 0; i < ATP_XSENSORS + ATP_YSENSORS; i++) {
 533                /* accumulate the change */
 534                signed char change = dev->xy_old[i] - dev->xy_cur[i];
 535                dev->xy_acc[i] -= change;
 536
 537                /* prevent down drifting */
 538                if (dev->xy_acc[i] < 0)
 539                        dev->xy_acc[i] = 0;
 540        }
 541
 542        memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old));
 543
 544        dbg_dump("accumulator", dev->xy_acc);
 545
 546        x = atp_calculate_abs(dev->xy_acc, ATP_XSENSORS,
 547                              dev->info->xfact, &x_z, &x_f);
 548        y = atp_calculate_abs(dev->xy_acc + ATP_XSENSORS, ATP_YSENSORS,
 549                              dev->info->yfact, &y_z, &y_f);
 550        key = dev->data[dev->info->datalen - 1] & ATP_STATUS_BUTTON;
 551
 552        if (x && y) {
 553                if (dev->x_old != -1) {
 554                        x = (dev->x_old * 3 + x) >> 2;
 555                        y = (dev->y_old * 3 + y) >> 2;
 556                        dev->x_old = x;
 557                        dev->y_old = y;
 558
 559                        if (debug > 1)
 560                                printk(KERN_DEBUG "appletouch: "
 561                                        "X: %3d Y: %3d Xz: %3d Yz: %3d\n",
 562                                        x, y, x_z, y_z);
 563
 564                        input_report_key(dev->input, BTN_TOUCH, 1);
 565                        input_report_abs(dev->input, ABS_X, x);
 566                        input_report_abs(dev->input, ABS_Y, y);
 567                        input_report_abs(dev->input, ABS_PRESSURE,
 568                                         min(ATP_PRESSURE, x_z + y_z));
 569                        atp_report_fingers(dev->input, max(x_f, y_f));
 570                }
 571                dev->x_old = x;
 572                dev->y_old = y;
 573
 574        } else if (!x && !y) {
 575
 576                dev->x_old = dev->y_old = -1;
 577                input_report_key(dev->input, BTN_TOUCH, 0);
 578                input_report_abs(dev->input, ABS_PRESSURE, 0);
 579                atp_report_fingers(dev->input, 0);
 580
 581                /* reset the accumulator on release */
 582                memset(dev->xy_acc, 0, sizeof(dev->xy_acc));
 583        }
 584
 585        input_report_key(dev->input, BTN_LEFT, key);
 586        input_sync(dev->input);
 587
 588 exit:
 589        retval = usb_submit_urb(dev->urb, GFP_ATOMIC);
 590        if (retval)
 591                err("atp_complete: usb_submit_urb failed with result %d",
 592                    retval);
 593}
 594
 595/* Interrupt function for older touchpads: GEYSER3/GEYSER4 */
 596
 597static void atp_complete_geyser_3_4(struct urb *urb)
 598{
 599        int x, y, x_z, y_z, x_f, y_f;
 600        int retval, i, j;
 601        int key;
 602        struct atp *dev = urb->context;
 603        int status = atp_status_check(urb);
 604
 605        if (status == ATP_URB_STATUS_ERROR_FATAL)
 606                return;
 607        else if (status == ATP_URB_STATUS_ERROR)
 608                goto exit;
 609
 610        /* Reorder the sensors values:
 611         *
 612         * The values are laid out like this:
 613         * -, Y1, Y2, -, Y3, Y4, -, ..., -, X1, X2, -, X3, X4, ...
 614         * '-' is an unused value.
 615         */
 616
 617        /* read X values */
 618        for (i = 0, j = 19; i < 20; i += 2, j += 3) {
 619                dev->xy_cur[i] = dev->data[j + 1];
 620                dev->xy_cur[i + 1] = dev->data[j + 2];
 621        }
 622        /* read Y values */
 623        for (i = 0, j = 1; i < 9; i += 2, j += 3) {
 624                dev->xy_cur[ATP_XSENSORS + i] = dev->data[j + 1];
 625                dev->xy_cur[ATP_XSENSORS + i + 1] = dev->data[j + 2];
 626        }
 627
 628        dbg_dump("sample", dev->xy_cur);
 629
 630        /* Just update the base values (i.e. touchpad in untouched state) */
 631        if (dev->data[dev->info->datalen - 1] & ATP_STATUS_BASE_UPDATE) {
 632
 633                dprintk(KERN_DEBUG "appletouch: updated base values\n");
 634
 635                memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old));
 636                goto exit;
 637        }
 638
 639        for (i = 0; i < ATP_XSENSORS + ATP_YSENSORS; i++) {
 640                /* calculate the change */
 641                dev->xy_acc[i] = dev->xy_cur[i] - dev->xy_old[i];
 642
 643                /* this is a round-robin value, so couple with that */
 644                if (dev->xy_acc[i] > 127)
 645                        dev->xy_acc[i] -= 256;
 646
 647                if (dev->xy_acc[i] < -127)
 648                        dev->xy_acc[i] += 256;
 649
 650                /* prevent down drifting */
 651                if (dev->xy_acc[i] < 0)
 652                        dev->xy_acc[i] = 0;
 653        }
 654
 655        dbg_dump("accumulator", dev->xy_acc);
 656
 657        x = atp_calculate_abs(dev->xy_acc, ATP_XSENSORS,
 658                              dev->info->xfact, &x_z, &x_f);
 659        y = atp_calculate_abs(dev->xy_acc + ATP_XSENSORS, ATP_YSENSORS,
 660                              dev->info->yfact, &y_z, &y_f);
 661        key = dev->data[dev->info->datalen - 1] & ATP_STATUS_BUTTON;
 662
 663        if (x && y) {
 664                if (dev->x_old != -1) {
 665                        x = (dev->x_old * 3 + x) >> 2;
 666                        y = (dev->y_old * 3 + y) >> 2;
 667                        dev->x_old = x;
 668                        dev->y_old = y;
 669
 670                        if (debug > 1)
 671                                printk(KERN_DEBUG "appletouch: X: %3d Y: %3d "
 672                                       "Xz: %3d Yz: %3d\n",
 673                                       x, y, x_z, y_z);
 674
 675                        input_report_key(dev->input, BTN_TOUCH, 1);
 676                        input_report_abs(dev->input, ABS_X, x);
 677                        input_report_abs(dev->input, ABS_Y, y);
 678                        input_report_abs(dev->input, ABS_PRESSURE,
 679                                         min(ATP_PRESSURE, x_z + y_z));
 680                        atp_report_fingers(dev->input, max(x_f, y_f));
 681                }
 682                dev->x_old = x;
 683                dev->y_old = y;
 684
 685        } else if (!x && !y) {
 686
 687                dev->x_old = dev->y_old = -1;
 688                input_report_key(dev->input, BTN_TOUCH, 0);
 689                input_report_abs(dev->input, ABS_PRESSURE, 0);
 690                atp_report_fingers(dev->input, 0);
 691
 692                /* reset the accumulator on release */
 693                memset(dev->xy_acc, 0, sizeof(dev->xy_acc));
 694        }
 695
 696        input_report_key(dev->input, BTN_LEFT, key);
 697        input_sync(dev->input);
 698
 699        /*
 700         * Geysers 3/4 will continue to send packets continually after
 701         * the first touch unless reinitialised. Do so if it's been
 702         * idle for a while in order to avoid waking the kernel up
 703         * several hundred times a second.
 704         */
 705
 706        /*
 707         * Button must not be pressed when entering suspend,
 708         * otherwise we will never release the button.
 709         */
 710        if (!x && !y && !key) {
 711                dev->idlecount++;
 712                if (dev->idlecount == 10) {
 713                        dev->x_old = dev->y_old = -1;
 714                        dev->idlecount = 0;
 715                        schedule_work(&dev->work);
 716                        /* Don't resubmit urb here, wait for reinit */
 717                        return;
 718                }
 719        } else
 720                dev->idlecount = 0;
 721
 722 exit:
 723        retval = usb_submit_urb(dev->urb, GFP_ATOMIC);
 724        if (retval)
 725                err("atp_complete: usb_submit_urb failed with result %d",
 726                    retval);
 727}
 728
 729static int atp_open(struct input_dev *input)
 730{
 731        struct atp *dev = input_get_drvdata(input);
 732
 733        if (usb_submit_urb(dev->urb, GFP_ATOMIC))
 734                return -EIO;
 735
 736        dev->open = 1;
 737        return 0;
 738}
 739
 740static void atp_close(struct input_dev *input)
 741{
 742        struct atp *dev = input_get_drvdata(input);
 743
 744        usb_kill_urb(dev->urb);
 745        cancel_work_sync(&dev->work);
 746        dev->open = 0;
 747}
 748
 749static int atp_handle_geyser(struct atp *dev)
 750{
 751        struct usb_device *udev = dev->udev;
 752
 753        if (dev->info != &fountain_info) {
 754                /* switch to raw sensor mode */
 755                if (atp_geyser_init(udev))
 756                        return -EIO;
 757
 758                printk(KERN_INFO "appletouch: Geyser mode initialized.\n");
 759        }
 760
 761        return 0;
 762}
 763
 764static int atp_probe(struct usb_interface *iface,
 765                     const struct usb_device_id *id)
 766{
 767        struct atp *dev;
 768        struct input_dev *input_dev;
 769        struct usb_device *udev = interface_to_usbdev(iface);
 770        struct usb_host_interface *iface_desc;
 771        struct usb_endpoint_descriptor *endpoint;
 772        int int_in_endpointAddr = 0;
 773        int i, error = -ENOMEM;
 774        const struct atp_info *info = (const struct atp_info *)id->driver_info;
 775
 776        /* set up the endpoint information */
 777        /* use only the first interrupt-in endpoint */
 778        iface_desc = iface->cur_altsetting;
 779        for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) {
 780                endpoint = &iface_desc->endpoint[i].desc;
 781                if (!int_in_endpointAddr && usb_endpoint_is_int_in(endpoint)) {
 782                        /* we found an interrupt in endpoint */
 783                        int_in_endpointAddr = endpoint->bEndpointAddress;
 784                        break;
 785                }
 786        }
 787        if (!int_in_endpointAddr) {
 788                err("Could not find int-in endpoint");
 789                return -EIO;
 790        }
 791
 792        /* allocate memory for our device state and initialize it */
 793        dev = kzalloc(sizeof(struct atp), GFP_KERNEL);
 794        input_dev = input_allocate_device();
 795        if (!dev || !input_dev) {
 796                err("Out of memory");
 797                goto err_free_devs;
 798        }
 799
 800        dev->udev = udev;
 801        dev->input = input_dev;
 802        dev->info = info;
 803        dev->overflow_warned = false;
 804
 805        dev->urb = usb_alloc_urb(0, GFP_KERNEL);
 806        if (!dev->urb)
 807                goto err_free_devs;
 808
 809        dev->data = usb_buffer_alloc(dev->udev, dev->info->datalen, GFP_KERNEL,
 810                                     &dev->urb->transfer_dma);
 811        if (!dev->data)
 812                goto err_free_urb;
 813
 814        usb_fill_int_urb(dev->urb, udev,
 815                         usb_rcvintpipe(udev, int_in_endpointAddr),
 816                         dev->data, dev->info->datalen,
 817                         dev->info->callback, dev, 1);
 818
 819        error = atp_handle_geyser(dev);
 820        if (error)
 821                goto err_free_buffer;
 822
 823        usb_make_path(udev, dev->phys, sizeof(dev->phys));
 824        strlcat(dev->phys, "/input0", sizeof(dev->phys));
 825
 826        input_dev->name = "appletouch";
 827        input_dev->phys = dev->phys;
 828        usb_to_input_id(dev->udev, &input_dev->id);
 829        input_dev->dev.parent = &iface->dev;
 830
 831        input_set_drvdata(input_dev, dev);
 832
 833        input_dev->open = atp_open;
 834        input_dev->close = atp_close;
 835
 836        set_bit(EV_ABS, input_dev->evbit);
 837
 838        input_set_abs_params(input_dev, ABS_X, 0,
 839                             (dev->info->xsensors - 1) * dev->info->xfact - 1,
 840                             ATP_FUZZ, 0);
 841        input_set_abs_params(input_dev, ABS_Y, 0,
 842                             (dev->info->ysensors - 1) * dev->info->yfact - 1,
 843                             ATP_FUZZ, 0);
 844        input_set_abs_params(input_dev, ABS_PRESSURE, 0, ATP_PRESSURE, 0, 0);
 845
 846        set_bit(EV_KEY, input_dev->evbit);
 847        set_bit(BTN_TOUCH, input_dev->keybit);
 848        set_bit(BTN_TOOL_FINGER, input_dev->keybit);
 849        set_bit(BTN_TOOL_DOUBLETAP, input_dev->keybit);
 850        set_bit(BTN_TOOL_TRIPLETAP, input_dev->keybit);
 851        set_bit(BTN_LEFT, input_dev->keybit);
 852
 853        error = input_register_device(dev->input);
 854        if (error)
 855                goto err_free_buffer;
 856
 857        /* save our data pointer in this interface device */
 858        usb_set_intfdata(iface, dev);
 859
 860        INIT_WORK(&dev->work, atp_reinit);
 861
 862        return 0;
 863
 864 err_free_buffer:
 865        usb_buffer_free(dev->udev, dev->info->datalen,
 866                        dev->data, dev->urb->transfer_dma);
 867 err_free_urb:
 868        usb_free_urb(dev->urb);
 869 err_free_devs:
 870        usb_set_intfdata(iface, NULL);
 871        kfree(dev);
 872        input_free_device(input_dev);
 873        return error;
 874}
 875
 876static void atp_disconnect(struct usb_interface *iface)
 877{
 878        struct atp *dev = usb_get_intfdata(iface);
 879
 880        usb_set_intfdata(iface, NULL);
 881        if (dev) {
 882                usb_kill_urb(dev->urb);
 883                input_unregister_device(dev->input);
 884                usb_buffer_free(dev->udev, dev->info->datalen,
 885                                dev->data, dev->urb->transfer_dma);
 886                usb_free_urb(dev->urb);
 887                kfree(dev);
 888        }
 889        printk(KERN_INFO "input: appletouch disconnected\n");
 890}
 891
 892static int atp_recover(struct atp *dev)
 893{
 894        int error;
 895
 896        error = atp_handle_geyser(dev);
 897        if (error)
 898                return error;
 899
 900        if (dev->open && usb_submit_urb(dev->urb, GFP_ATOMIC))
 901                return -EIO;
 902
 903        return 0;
 904}
 905
 906static int atp_suspend(struct usb_interface *iface, pm_message_t message)
 907{
 908        struct atp *dev = usb_get_intfdata(iface);
 909
 910        usb_kill_urb(dev->urb);
 911        return 0;
 912}
 913
 914static int atp_resume(struct usb_interface *iface)
 915{
 916        struct atp *dev = usb_get_intfdata(iface);
 917
 918        if (dev->open && usb_submit_urb(dev->urb, GFP_ATOMIC))
 919                return -EIO;
 920
 921        return 0;
 922}
 923
 924static int atp_reset_resume(struct usb_interface *iface)
 925{
 926        struct atp *dev = usb_get_intfdata(iface);
 927
 928        return atp_recover(dev);
 929}
 930
 931static struct usb_driver atp_driver = {
 932        .name           = "appletouch",
 933        .probe          = atp_probe,
 934        .disconnect     = atp_disconnect,
 935        .suspend        = atp_suspend,
 936        .resume         = atp_resume,
 937        .reset_resume   = atp_reset_resume,
 938        .id_table       = atp_table,
 939};
 940
 941static int __init atp_init(void)
 942{
 943        return usb_register(&atp_driver);
 944}
 945
 946static void __exit atp_exit(void)
 947{
 948        usb_deregister(&atp_driver);
 949}
 950
 951module_init(atp_init);
 952module_exit(atp_exit);
 953