drivers/input/touchscreen/atmel_mxt_ts.c

   1 /*
   2  * Atmel maXTouch Touchscreen driver
   3  *
   4  * Copyright (C) 2010 Samsung Electronics Co.Ltd
   5  * Copyright (C) 2011-2014 Atmel Corporation
   6  * Copyright (C) 2012 Google, Inc.
   7  * Copyright (C) 2016 Zodiac Inflight Innovations
   8  *
   9  * Author: Joonyoung Shim <jy0922.shim@samsung.com>
  10  *
  11  * This program is free software; you can redistribute  it and/or modify it
  12  * under  the terms of  the GNU General  Public License as published by the
  13  * Free Software Foundation;  either version 2 of the  License, or (at your
  14  * option) any later version.
  15  *
  16  */
  17
  18 #include <linux/acpi.h>
  19 #include <linux/dmi.h>
  20 #include <linux/module.h>
  21 #include <linux/init.h>
  22 #include <linux/completion.h>
  23 #include <linux/delay.h>
  24 #include <linux/firmware.h>
  25 #include <linux/i2c.h>
  26 #include <linux/input/mt.h>
  27 #include <linux/interrupt.h>
  28 #include <linux/of.h>
  29 #include <linux/property.h>
  30 #include <linux/slab.h>
  31 #include <linux/gpio/consumer.h>
  32 #include <asm/unaligned.h>
  33 #include <media/v4l2-device.h>
  34 #include <media/v4l2-ioctl.h>
  35 #include <media/videobuf2-v4l2.h>
  36 #include <media/videobuf2-vmalloc.h>
  37
  38 /* Firmware files */
  39 #define MXT_FW_NAME             "maxtouch.fw"
  40 #define MXT_CFG_NAME            "maxtouch.cfg"
  41 #define MXT_CFG_MAGIC           "OBP_RAW V1"
  42
  43 /* Registers */
  44 #define MXT_OBJECT_START        0x07
  45 #define MXT_OBJECT_SIZE         6
  46 #define MXT_INFO_CHECKSUM_SIZE  3
  47 #define MXT_MAX_BLOCK_WRITE     256
  48
  49 /* Object types */
  50 #define MXT_DEBUG_DIAGNOSTIC_T37        37
  51 #define MXT_GEN_MESSAGE_T5              5
  52 #define MXT_GEN_COMMAND_T6              6
  53 #define MXT_GEN_POWER_T7                7
  54 #define MXT_GEN_ACQUIRE_T8              8
  55 #define MXT_GEN_DATASOURCE_T53          53
  56 #define MXT_TOUCH_MULTI_T9              9
  57 #define MXT_TOUCH_KEYARRAY_T15          15
  58 #define MXT_TOUCH_PROXIMITY_T23         23
  59 #define MXT_TOUCH_PROXKEY_T52           52
  60 #define MXT_PROCI_GRIPFACE_T20          20
  61 #define MXT_PROCG_NOISE_T22             22
  62 #define MXT_PROCI_ONETOUCH_T24          24
  63 #define MXT_PROCI_TWOTOUCH_T27          27
  64 #define MXT_PROCI_GRIP_T40              40
  65 #define MXT_PROCI_PALM_T41              41
  66 #define MXT_PROCI_TOUCHSUPPRESSION_T42  42
  67 #define MXT_PROCI_STYLUS_T47            47
  68 #define MXT_PROCG_NOISESUPPRESSION_T48  48
  69 #define MXT_SPT_COMMSCONFIG_T18         18
  70 #define MXT_SPT_GPIOPWM_T19             19
  71 #define MXT_SPT_SELFTEST_T25            25
  72 #define MXT_SPT_CTECONFIG_T28           28
  73 #define MXT_SPT_USERDATA_T38            38
  74 #define MXT_SPT_DIGITIZER_T43           43
  75 #define MXT_SPT_MESSAGECOUNT_T44        44
  76 #define MXT_SPT_CTECONFIG_T46           46
  77 #define MXT_SPT_DYNAMICCONFIGURATIONCONTAINER_T71 71
  78 #define MXT_TOUCH_MULTITOUCHSCREEN_T100 100
  79
  80 /* MXT_GEN_MESSAGE_T5 object */
  81 #define MXT_RPTID_NOMSG         0xff
  82
  83 /* MXT_GEN_COMMAND_T6 field */
  84 #define MXT_COMMAND_RESET       0
  85 #define MXT_COMMAND_BACKUPNV    1
  86 #define MXT_COMMAND_CALIBRATE   2
  87 #define MXT_COMMAND_REPORTALL   3
  88 #define MXT_COMMAND_DIAGNOSTIC  5
  89
  90 /* Define for T6 status byte */
  91 #define MXT_T6_STATUS_RESET     BIT(7)
  92 #define MXT_T6_STATUS_OFL       BIT(6)
  93 #define MXT_T6_STATUS_SIGERR    BIT(5)
  94 #define MXT_T6_STATUS_CAL       BIT(4)
  95 #define MXT_T6_STATUS_CFGERR    BIT(3)
  96 #define MXT_T6_STATUS_COMSERR   BIT(2)
  97
  98 /* MXT_GEN_POWER_T7 field */
  99 struct t7_config {
 100         u8 idle;
 101         u8 active;
 102 } __packed;
 103
 104 #define MXT_POWER_CFG_RUN               0
 105 #define MXT_POWER_CFG_DEEPSLEEP         1
 106
 107 /* MXT_TOUCH_MULTI_T9 field */
 108 #define MXT_T9_CTRL             0
 109 #define MXT_T9_XSIZE            3
 110 #define MXT_T9_YSIZE            4
 111 #define MXT_T9_ORIENT           9
 112 #define MXT_T9_RANGE            18
 113
 114 /* MXT_TOUCH_MULTI_T9 status */
 115 #define MXT_T9_UNGRIP           BIT(0)
 116 #define MXT_T9_SUPPRESS         BIT(1)
 117 #define MXT_T9_AMP              BIT(2)
 118 #define MXT_T9_VECTOR           BIT(3)
 119 #define MXT_T9_MOVE             BIT(4)
 120 #define MXT_T9_RELEASE          BIT(5)
 121 #define MXT_T9_PRESS            BIT(6)
 122 #define MXT_T9_DETECT           BIT(7)
 123
 124 struct t9_range {
 125         __le16 x;
 126         __le16 y;
 127 } __packed;
 128
 129 /* MXT_TOUCH_MULTI_T9 orient */
 130 #define MXT_T9_ORIENT_SWITCH    BIT(0)
 131 #define MXT_T9_ORIENT_INVERTX   BIT(1)
 132 #define MXT_T9_ORIENT_INVERTY   BIT(2)
 133
 134 /* MXT_SPT_COMMSCONFIG_T18 */
 135 #define MXT_COMMS_CTRL          0
 136 #define MXT_COMMS_CMD           1
 137
 138 /* MXT_DEBUG_DIAGNOSTIC_T37 */
 139 #define MXT_DIAGNOSTIC_PAGEUP   0x01
 140 #define MXT_DIAGNOSTIC_DELTAS   0x10
 141 #define MXT_DIAGNOSTIC_REFS     0x11
 142 #define MXT_DIAGNOSTIC_SIZE     128
 143
 144 #define MXT_FAMILY_1386                 160
 145 #define MXT1386_COLUMNS                 3
 146 #define MXT1386_PAGES_PER_COLUMN        8
 147
 148 struct t37_debug {
 149 #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
 150         u8 mode;
 151         u8 page;
 152         u8 data[MXT_DIAGNOSTIC_SIZE];
 153 #endif
 154 };
 155
 156 /* Define for MXT_GEN_COMMAND_T6 */
 157 #define MXT_BOOT_VALUE          0xa5
 158 #define MXT_RESET_VALUE         0x01
 159 #define MXT_BACKUP_VALUE        0x55
 160
 161 /* T100 Multiple Touch Touchscreen */
 162 #define MXT_T100_CTRL           0
 163 #define MXT_T100_CFG1           1
 164 #define MXT_T100_TCHAUX         3
 165 #define MXT_T100_XSIZE          9
 166 #define MXT_T100_XRANGE         13
 167 #define MXT_T100_YSIZE          20
 168 #define MXT_T100_YRANGE         24
 169
 170 #define MXT_T100_CFG_SWITCHXY   BIT(5)
 171 #define MXT_T100_CFG_INVERTY    BIT(6)
 172 #define MXT_T100_CFG_INVERTX    BIT(7)
 173
 174 #define MXT_T100_TCHAUX_VECT    BIT(0)
 175 #define MXT_T100_TCHAUX_AMPL    BIT(1)
 176 #define MXT_T100_TCHAUX_AREA    BIT(2)
 177
 178 #define MXT_T100_DETECT         BIT(7)
 179 #define MXT_T100_TYPE_MASK      0x70
 180
 181 enum t100_type {
 182         MXT_T100_TYPE_FINGER            = 1,
 183         MXT_T100_TYPE_PASSIVE_STYLUS    = 2,
 184         MXT_T100_TYPE_HOVERING_FINGER   = 4,
 185         MXT_T100_TYPE_GLOVE             = 5,
 186         MXT_T100_TYPE_LARGE_TOUCH       = 6,
 187 };
 188
 189 #define MXT_DISTANCE_ACTIVE_TOUCH       0
 190 #define MXT_DISTANCE_HOVERING           1
 191
 192 #define MXT_TOUCH_MAJOR_DEFAULT         1
 193 #define MXT_PRESSURE_DEFAULT            1
 194
 195 /* Delay times */
 196 #define MXT_BACKUP_TIME         50      /* msec */
 197 #define MXT_RESET_GPIO_TIME     20      /* msec */
 198 #define MXT_RESET_INVALID_CHG   100     /* msec */
 199 #define MXT_RESET_TIME          200     /* msec */
 200 #define MXT_RESET_TIMEOUT       3000    /* msec */
 201 #define MXT_CRC_TIMEOUT         1000    /* msec */
 202 #define MXT_FW_RESET_TIME       3000    /* msec */
 203 #define MXT_FW_CHG_TIMEOUT      300     /* msec */
 204
 205 /* Command to unlock bootloader */
 206 #define MXT_UNLOCK_CMD_MSB      0xaa
 207 #define MXT_UNLOCK_CMD_LSB      0xdc
 208
 209 /* Bootloader mode status */
 210 #define MXT_WAITING_BOOTLOAD_CMD        0xc0    /* valid 7 6 bit only */
 211 #define MXT_WAITING_FRAME_DATA  0x80    /* valid 7 6 bit only */
 212 #define MXT_FRAME_CRC_CHECK     0x02
 213 #define MXT_FRAME_CRC_FAIL      0x03
 214 #define MXT_FRAME_CRC_PASS      0x04
 215 #define MXT_APP_CRC_FAIL        0x40    /* valid 7 8 bit only */
 216 #define MXT_BOOT_STATUS_MASK    0x3f
 217 #define MXT_BOOT_EXTENDED_ID    BIT(5)
 218 #define MXT_BOOT_ID_MASK        0x1f
 219
 220 /* Touchscreen absolute values */
 221 #define MXT_MAX_AREA            0xff
 222
 223 #define MXT_PIXELS_PER_MM       20
 224
 225 struct mxt_info {
 226         u8 family_id;
 227         u8 variant_id;
 228         u8 version;
 229         u8 build;
 230         u8 matrix_xsize;
 231         u8 matrix_ysize;
 232         u8 object_num;
 233 };
 234
 235 struct mxt_object {
 236         u8 type;
 237         u16 start_address;
 238         u8 size_minus_one;
 239         u8 instances_minus_one;
 240         u8 num_report_ids;
 241 } __packed;
 242
 243 struct mxt_dbg {
 244         u16 t37_address;
 245         u16 diag_cmd_address;
 246         struct t37_debug *t37_buf;
 247         unsigned int t37_pages;
 248         unsigned int t37_nodes;
 249
 250         struct v4l2_device v4l2;
 251         struct v4l2_pix_format format;
 252         struct video_device vdev;
 253         struct vb2_queue queue;
 254         struct mutex lock;
 255         int input;
 256 };
 257
 258 enum v4l_dbg_inputs {
 259         MXT_V4L_INPUT_DELTAS,
 260         MXT_V4L_INPUT_REFS,
 261         MXT_V4L_INPUT_MAX,
 262 };
 263
 264 static const struct v4l2_file_operations mxt_video_fops = {
 265         .owner = THIS_MODULE,
 266         .open = v4l2_fh_open,
 267         .release = vb2_fop_release,
 268         .unlocked_ioctl = video_ioctl2,
 269         .read = vb2_fop_read,
 270         .mmap = vb2_fop_mmap,
 271         .poll = vb2_fop_poll,
 272 };
 273
 274 enum mxt_suspend_mode {
 275         MXT_SUSPEND_DEEP_SLEEP  = 0,
 276         MXT_SUSPEND_T9_CTRL     = 1,
 277 };
 278
 279 /* Config update context */
 280 struct mxt_cfg {
 281         u8 *raw;
 282         size_t raw_size;
 283         off_t raw_pos;
 284
 285         u8 *mem;
 286         size_t mem_size;
 287         int start_ofs;
 288
 289         struct mxt_info info;
 290 };
 291
 292 /* Each client has this additional data */
 293 struct mxt_data {
 294         struct i2c_client *client;
 295         struct input_dev *input_dev;
 296         char phys[64];          /* device physical location */
 297         struct mxt_object *object_table;
 298         struct mxt_info *info;
 299         void *raw_info_block;
 300         unsigned int irq;
 301         unsigned int max_x;
 302         unsigned int max_y;
 303         bool invertx;
 304         bool inverty;
 305         bool xy_switch;
 306         u8 xsize;
 307         u8 ysize;
 308         bool in_bootloader;
 309         u16 mem_size;
 310         u8 t100_aux_ampl;
 311         u8 t100_aux_area;
 312         u8 t100_aux_vect;
 313         u8 max_reportid;
 314         u32 config_crc;
 315         u32 info_crc;
 316         u8 bootloader_addr;
 317         u8 *msg_buf;
 318         u8 t6_status;
 319         bool update_input;
 320         u8 last_message_count;
 321         u8 num_touchids;
 322         u8 multitouch;
 323         struct t7_config t7_cfg;
 324         struct mxt_dbg dbg;
 325         struct gpio_desc *reset_gpio;
 326
 327         /* Cached parameters from object table */
 328         u16 T5_address;
 329         u8 T5_msg_size;
 330         u8 T6_reportid;
 331         u16 T6_address;
 332         u16 T7_address;
 333         u16 T71_address;
 334         u8 T9_reportid_min;
 335         u8 T9_reportid_max;
 336         u8 T19_reportid;
 337         u16 T44_address;
 338         u8 T100_reportid_min;
 339         u8 T100_reportid_max;
 340
 341         /* for fw update in bootloader */
 342         struct completion bl_completion;
 343
 344         /* for reset handling */
 345         struct completion reset_completion;
 346
 347         /* for config update handling */
 348         struct completion crc_completion;
 349
 350         u32 *t19_keymap;
 351         unsigned int t19_num_keys;
 352
 353         enum mxt_suspend_mode suspend_mode;
 354 };
 355
 356 struct mxt_vb2_buffer {
 357         struct vb2_buffer       vb;
 358         struct list_head        list;
 359 };
 360
 361 static size_t mxt_obj_size(const struct mxt_object *obj)
 362 {
 363         return obj->size_minus_one + 1;
 364 }
 365
 366 static size_t mxt_obj_instances(const struct mxt_object *obj)
 367 {
 368         return obj->instances_minus_one + 1;
 369 }
 370
 371 static bool mxt_object_readable(unsigned int type)
 372 {
 373         switch (type) {
 374         case MXT_GEN_COMMAND_T6:
 375         case MXT_GEN_POWER_T7:
 376         case MXT_GEN_ACQUIRE_T8:
 377         case MXT_GEN_DATASOURCE_T53:
 378         case MXT_TOUCH_MULTI_T9:
 379         case MXT_TOUCH_KEYARRAY_T15:
 380         case MXT_TOUCH_PROXIMITY_T23:
 381         case MXT_TOUCH_PROXKEY_T52:
 382         case MXT_TOUCH_MULTITOUCHSCREEN_T100:
 383         case MXT_PROCI_GRIPFACE_T20:
 384         case MXT_PROCG_NOISE_T22:
 385         case MXT_PROCI_ONETOUCH_T24:
 386         case MXT_PROCI_TWOTOUCH_T27:
 387         case MXT_PROCI_GRIP_T40:
 388         case MXT_PROCI_PALM_T41:
 389         case MXT_PROCI_TOUCHSUPPRESSION_T42:
 390         case MXT_PROCI_STYLUS_T47:
 391         case MXT_PROCG_NOISESUPPRESSION_T48:
 392         case MXT_SPT_COMMSCONFIG_T18:
 393         case MXT_SPT_GPIOPWM_T19:
 394         case MXT_SPT_SELFTEST_T25:
 395         case MXT_SPT_CTECONFIG_T28:
 396         case MXT_SPT_USERDATA_T38:
 397         case MXT_SPT_DIGITIZER_T43:
 398         case MXT_SPT_CTECONFIG_T46:
 399         case MXT_SPT_DYNAMICCONFIGURATIONCONTAINER_T71:
 400                 return true;
 401         default:
 402                 return false;
 403         }
 404 }
 405
 406 static void mxt_dump_message(struct mxt_data *data, u8 *message)
 407 {
 408         dev_dbg(&data->client->dev, "message: %*ph\n",
 409                 data->T5_msg_size, message);
 410 }
 411
 412 static int mxt_wait_for_completion(struct mxt_data *data,
 413                                    struct completion *comp,
 414                                    unsigned int timeout_ms)
 415 {
 416         struct device *dev = &data->client->dev;
 417         unsigned long timeout = msecs_to_jiffies(timeout_ms);
 418         long ret;
 419
 420         ret = wait_for_completion_interruptible_timeout(comp, timeout);
 421         if (ret < 0) {
 422                 return ret;
 423         } else if (ret == 0) {
 424                 dev_err(dev, "Wait for completion timed out.\n");
 425                 return -ETIMEDOUT;
 426         }
 427         return 0;
 428 }
 429
 430 static int mxt_bootloader_read(struct mxt_data *data,
 431                                u8 *val, unsigned int count)
 432 {
 433         int ret;
 434         struct i2c_msg msg;
 435
 436         msg.addr = data->bootloader_addr;
 437         msg.flags = data->client->flags & I2C_M_TEN;
 438         msg.flags |= I2C_M_RD;
 439         msg.len = count;
 440         msg.buf = val;
 441
 442         ret = i2c_transfer(data->client->adapter, &msg, 1);
 443         if (ret == 1) {
 444                 ret = 0;
 445         } else {
 446                 ret = ret < 0 ? ret : -EIO;
 447                 dev_err(&data->client->dev, "%s: i2c recv failed (%d)\n",
 448                         __func__, ret);
 449         }
 450
 451         return ret;
 452 }
 453
 454 static int mxt_bootloader_write(struct mxt_data *data,
 455                                 const u8 * const val, unsigned int count)
 456 {
 457         int ret;
 458         struct i2c_msg msg;
 459
 460         msg.addr = data->bootloader_addr;
 461         msg.flags = data->client->flags & I2C_M_TEN;
 462         msg.len = count;
 463         msg.buf = (u8 *)val;
 464
 465         ret = i2c_transfer(data->client->adapter, &msg, 1);
 466         if (ret == 1) {
 467                 ret = 0;
 468         } else {
 469                 ret = ret < 0 ? ret : -EIO;
 470                 dev_err(&data->client->dev, "%s: i2c send failed (%d)\n",
 471                         __func__, ret);
 472         }
 473
 474         return ret;
 475 }
 476
 477 static int mxt_lookup_bootloader_address(struct mxt_data *data, bool retry)
 478 {
 479         u8 appmode = data->client->addr;
 480         u8 bootloader;
 481         u8 family_id = data->info ? data->info->family_id : 0;
 482
 483         switch (appmode) {
 484         case 0x4a:
 485         case 0x4b:
 486                 /* Chips after 1664S use different scheme */
 487                 if (retry || family_id >= 0xa2) {
 488                         bootloader = appmode - 0x24;
 489                         break;
 490                 }
 491                 /* Fall through - for normal case */
 492         case 0x4c:
 493         case 0x4d:
 494         case 0x5a:
 495         case 0x5b:
 496                 bootloader = appmode - 0x26;
 497                 break;
 498
 499         default:
 500                 dev_err(&data->client->dev,
 501                         "Appmode i2c address 0x%02x not found\n",
 502                         appmode);
 503                 return -EINVAL;
 504         }
 505
 506         data->bootloader_addr = bootloader;
 507         return 0;
 508 }
 509
 510 static int mxt_probe_bootloader(struct mxt_data *data, bool alt_address)
 511 {
 512         struct device *dev = &data->client->dev;
 513         int error;
 514         u8 val;
 515         bool crc_failure;
 516
 517         error = mxt_lookup_bootloader_address(data, alt_address);
 518         if (error)
 519                 return error;
 520
 521         error = mxt_bootloader_read(data, &val, 1);
 522         if (error)
 523                 return error;
 524
 525         /* Check app crc fail mode */
 526         crc_failure = (val & ~MXT_BOOT_STATUS_MASK) == MXT_APP_CRC_FAIL;
 527
 528         dev_err(dev, "Detected bootloader, status:%02X%s\n",
 529                         val, crc_failure ? ", APP_CRC_FAIL" : "");
 530
 531         return 0;
 532 }
 533
 534 static u8 mxt_get_bootloader_version(struct mxt_data *data, u8 val)
 535 {
 536         struct device *dev = &data->client->dev;
 537         u8 buf[3];
 538
 539         if (val & MXT_BOOT_EXTENDED_ID) {
 540                 if (mxt_bootloader_read(data, &buf[0], 3) != 0) {
 541                         dev_err(dev, "%s: i2c failure\n", __func__);
 542                         return val;
 543                 }
 544
 545                 dev_dbg(dev, "Bootloader ID:%d Version:%d\n", buf[1], buf[2]);
 546
 547                 return buf[0];
 548         } else {
 549                 dev_dbg(dev, "Bootloader ID:%d\n", val & MXT_BOOT_ID_MASK);
 550
 551                 return val;
 552         }
 553 }
 554
 555 static int mxt_check_bootloader(struct mxt_data *data, unsigned int state,
 556                                 bool wait)
 557 {
 558         struct device *dev = &data->client->dev;
 559         u8 val;
 560         int ret;
 561
 562 recheck:
 563         if (wait) {
 564                 /*
 565                  * In application update mode, the interrupt
 566                  * line signals state transitions. We must wait for the
 567                  * CHG assertion before reading the status byte.
 568                  * Once the status byte has been read, the line is deasserted.
 569                  */
 570                 ret = mxt_wait_for_completion(data, &data->bl_completion,
 571                                               MXT_FW_CHG_TIMEOUT);
 572                 if (ret) {
 573                         /*
 574                          * TODO: handle -ERESTARTSYS better by terminating
 575                          * fw update process before returning to userspace
 576                          * by writing length 0x000 to device (iff we are in
 577                          * WAITING_FRAME_DATA state).
 578                          */
 579                         dev_err(dev, "Update wait error %d\n", ret);
 580                         return ret;
 581                 }
 582         }
 583
 584         ret = mxt_bootloader_read(data, &val, 1);
 585         if (ret)
 586                 return ret;
 587
 588         if (state == MXT_WAITING_BOOTLOAD_CMD)
 589                 val = mxt_get_bootloader_version(data, val);
 590
 591         switch (state) {
 592         case MXT_WAITING_BOOTLOAD_CMD:
 593         case MXT_WAITING_FRAME_DATA:
 594         case MXT_APP_CRC_FAIL:
 595                 val &= ~MXT_BOOT_STATUS_MASK;
 596                 break;
 597         case MXT_FRAME_CRC_PASS:
 598                 if (val == MXT_FRAME_CRC_CHECK) {
 599                         goto recheck;
 600                 } else if (val == MXT_FRAME_CRC_FAIL) {
 601                         dev_err(dev, "Bootloader CRC fail\n");
 602                         return -EINVAL;
 603                 }
 604                 break;
 605         default:
 606                 return -EINVAL;
 607         }
 608
 609         if (val != state) {
 610                 dev_err(dev, "Invalid bootloader state %02X != %02X\n",
 611                         val, state);
 612                 return -EINVAL;
 613         }
 614
 615         return 0;
 616 }
 617
 618 static int mxt_send_bootloader_cmd(struct mxt_data *data, bool unlock)
 619 {
 620         int ret;
 621         u8 buf[2];
 622
 623         if (unlock) {
 624                 buf[0] = MXT_UNLOCK_CMD_LSB;
 625                 buf[1] = MXT_UNLOCK_CMD_MSB;
 626         } else {
 627                 buf[0] = 0x01;
 628                 buf[1] = 0x01;
 629         }
 630
 631         ret = mxt_bootloader_write(data, buf, 2);
 632         if (ret)
 633                 return ret;
 634
 635         return 0;
 636 }
 637
 638 static int __mxt_read_reg(struct i2c_client *client,
 639                                u16 reg, u16 len, void *val)
 640 {
 641         struct i2c_msg xfer[2];
 642         u8 buf[2];
 643         int ret;
 644
 645         buf[0] = reg & 0xff;
 646         buf[1] = (reg >> 8) & 0xff;
 647
 648         /* Write register */
 649         xfer[0].addr = client->addr;
 650         xfer[0].flags = 0;
 651         xfer[0].len = 2;
 652         xfer[0].buf = buf;
 653
 654         /* Read data */
 655         xfer[1].addr = client->addr;
 656         xfer[1].flags = I2C_M_RD;
 657         xfer[1].len = len;
 658         xfer[1].buf = val;
 659
 660         ret = i2c_transfer(client->adapter, xfer, 2);
 661         if (ret == 2) {
 662                 ret = 0;
 663         } else {
 664                 if (ret >= 0)
 665                         ret = -EIO;
 666                 dev_err(&client->dev, "%s: i2c transfer failed (%d)\n",
 667                         __func__, ret);
 668         }
 669
 670         return ret;
 671 }
 672
 673 static int __mxt_write_reg(struct i2c_client *client, u16 reg, u16 len,
 674                            const void *val)
 675 {
 676         u8 *buf;
 677         size_t count;
 678         int ret;
 679
 680         count = len + 2;
 681         buf = kmalloc(count, GFP_KERNEL);
 682         if (!buf)
 683                 return -ENOMEM;
 684
 685         buf[0] = reg & 0xff;
 686         buf[1] = (reg >> 8) & 0xff;
 687         memcpy(&buf[2], val, len);
 688
 689         ret = i2c_master_send(client, buf, count);
 690         if (ret == count) {
 691                 ret = 0;
 692         } else {
 693                 if (ret >= 0)
 694                         ret = -EIO;
 695                 dev_err(&client->dev, "%s: i2c send failed (%d)\n",
 696                         __func__, ret);
 697         }
 698
 699         kfree(buf);
 700         return ret;
 701 }
 702
 703 static int mxt_write_reg(struct i2c_client *client, u16 reg, u8 val)
 704 {
 705         return __mxt_write_reg(client, reg, 1, &val);
 706 }
 707
 708 static struct mxt_object *
 709 mxt_get_object(struct mxt_data *data, u8 type)
 710 {
 711         struct mxt_object *object;
 712         int i;
 713
 714         for (i = 0; i < data->info->object_num; i++) {
 715                 object = data->object_table + i;
 716                 if (object->type == type)
 717                         return object;
 718         }
 719
 720         dev_warn(&data->client->dev, "Invalid object type T%u\n", type);
 721         return NULL;
 722 }
 723
 724 static void mxt_proc_t6_messages(struct mxt_data *data, u8 *msg)
 725 {
 726         struct device *dev = &data->client->dev;
 727         u8 status = msg[1];
 728         u32 crc = msg[2] | (msg[3] << 8) | (msg[4] << 16);
 729
 730         if (crc != data->config_crc) {
 731                 data->config_crc = crc;
 732                 dev_dbg(dev, "T6 Config Checksum: 0x%06X\n", crc);
 733         }
 734
 735         complete(&data->crc_completion);
 736
 737         /* Detect reset */
 738         if (status & MXT_T6_STATUS_RESET)
 739                 complete(&data->reset_completion);
 740
 741         /* Output debug if status has changed */
 742         if (status != data->t6_status)
 743                 dev_dbg(dev, "T6 Status 0x%02X%s%s%s%s%s%s%s\n",
 744                         status,
 745                         status == 0 ? " OK" : "",
 746                         status & MXT_T6_STATUS_RESET ? " RESET" : "",
 747                         status & MXT_T6_STATUS_OFL ? " OFL" : "",
 748                         status & MXT_T6_STATUS_SIGERR ? " SIGERR" : "",
 749                         status & MXT_T6_STATUS_CAL ? " CAL" : "",
 750                         status & MXT_T6_STATUS_CFGERR ? " CFGERR" : "",
 751                         status & MXT_T6_STATUS_COMSERR ? " COMSERR" : "");
 752
 753         /* Save current status */
 754         data->t6_status = status;
 755 }
 756
 757 static int mxt_write_object(struct mxt_data *data,
 758                                  u8 type, u8 offset, u8 val)
 759 {
 760         struct mxt_object *object;
 761         u16 reg;
 762
 763         object = mxt_get_object(data, type);
 764         if (!object || offset >= mxt_obj_size(object))
 765                 return -EINVAL;
 766
 767         reg = object->start_address;
 768         return mxt_write_reg(data->client, reg + offset, val);
 769 }
 770
 771 static void mxt_input_button(struct mxt_data *data, u8 *message)
 772 {
 773         struct input_dev *input = data->input_dev;
 774         int i;
 775
 776         for (i = 0; i < data->t19_num_keys; i++) {
 777                 if (data->t19_keymap[i] == KEY_RESERVED)
 778                         continue;
 779
 780                 /* Active-low switch */
 781                 input_report_key(input, data->t19_keymap[i],
 782                                  !(message[1] & BIT(i)));
 783         }
 784 }
 785
 786 static void mxt_input_sync(struct mxt_data *data)
 787 {
 788         input_mt_report_pointer_emulation(data->input_dev,
 789                                           data->t19_num_keys);
 790         input_sync(data->input_dev);
 791 }
 792
 793 static void mxt_proc_t9_message(struct mxt_data *data, u8 *message)
 794 {
 795         struct device *dev = &data->client->dev;
 796         struct input_dev *input_dev = data->input_dev;
 797         int id;
 798         u8 status;
 799         int x;
 800         int y;
 801         int area;
 802         int amplitude;
 803
 804         id = message[0] - data->T9_reportid_min;
 805         status = message[1];
 806         x = (message[2] << 4) | ((message[4] >> 4) & 0xf);
 807         y = (message[3] << 4) | ((message[4] & 0xf));
 808
 809         /* Handle 10/12 bit switching */
 810         if (data->max_x < 1024)
 811                 x >>= 2;
 812         if (data->max_y < 1024)
 813                 y >>= 2;
 814
 815         area = message[5];
 816         amplitude = message[6];
 817
 818         dev_dbg(dev,
 819                 "[%u] %c%c%c%c%c%c%c%c x: %5u y: %5u area: %3u amp: %3u\n",
 820                 id,
 821                 (status & MXT_T9_DETECT) ? 'D' : '.',
 822                 (status & MXT_T9_PRESS) ? 'P' : '.',
 823                 (status & MXT_T9_RELEASE) ? 'R' : '.',
 824                 (status & MXT_T9_MOVE) ? 'M' : '.',
 825                 (status & MXT_T9_VECTOR) ? 'V' : '.',
 826                 (status & MXT_T9_AMP) ? 'A' : '.',
 827                 (status & MXT_T9_SUPPRESS) ? 'S' : '.',
 828                 (status & MXT_T9_UNGRIP) ? 'U' : '.',
 829                 x, y, area, amplitude);
 830
 831         input_mt_slot(input_dev, id);
 832
 833         if (status & MXT_T9_DETECT) {
 834                 /*
 835                  * Multiple bits may be set if the host is slow to read
 836                  * the status messages, indicating all the events that
 837                  * have happened.
 838                  */
 839                 if (status & MXT_T9_RELEASE) {
 840                         input_mt_report_slot_state(input_dev,
 841                                                    MT_TOOL_FINGER, 0);
 842                         mxt_input_sync(data);
 843                 }
 844
 845                 /* if active, pressure must be non-zero */
 846                 if (!amplitude)
 847                         amplitude = MXT_PRESSURE_DEFAULT;
 848
 849                 /* Touch active */
 850                 input_mt_report_slot_state(input_dev, MT_TOOL_FINGER, 1);
 851                 input_report_abs(input_dev, ABS_MT_POSITION_X, x);
 852                 input_report_abs(input_dev, ABS_MT_POSITION_Y, y);
 853                 input_report_abs(input_dev, ABS_MT_PRESSURE, amplitude);
 854                 input_report_abs(input_dev, ABS_MT_TOUCH_MAJOR, area);
 855         } else {
 856                 /* Touch no longer active, close out slot */
 857                 input_mt_report_slot_state(input_dev, MT_TOOL_FINGER, 0);
 858         }
 859
 860         data->update_input = true;
 861 }
 862
 863 static void mxt_proc_t100_message(struct mxt_data *data, u8 *message)
 864 {
 865         struct device *dev = &data->client->dev;
 866         struct input_dev *input_dev = data->input_dev;
 867         int id;
 868         u8 status;
 869         u8 type = 0;
 870         u16 x;
 871         u16 y;
 872         int distance = 0;
 873         int tool = 0;
 874         u8 major = 0;
 875         u8 pressure = 0;
 876         u8 orientation = 0;
 877
 878         id = message[0] - data->T100_reportid_min - 2;
 879
 880         /* ignore SCRSTATUS events */
 881         if (id < 0)
 882                 return;
 883
 884         status = message[1];
 885         x = get_unaligned_le16(&message[2]);
 886         y = get_unaligned_le16(&message[4]);
 887
 888         if (status & MXT_T100_DETECT) {
 889                 type = (status & MXT_T100_TYPE_MASK) >> 4;
 890
 891                 switch (type) {
 892                 case MXT_T100_TYPE_HOVERING_FINGER:
 893                         tool = MT_TOOL_FINGER;
 894                         distance = MXT_DISTANCE_HOVERING;
 895
 896                         if (data->t100_aux_vect)
 897                                 orientation = message[data->t100_aux_vect];
 898
 899                         break;
 900
 901                 case MXT_T100_TYPE_FINGER:
 902                 case MXT_T100_TYPE_GLOVE:
 903                         tool = MT_TOOL_FINGER;
 904                         distance = MXT_DISTANCE_ACTIVE_TOUCH;
 905
 906                         if (data->t100_aux_area)
 907                                 major = message[data->t100_aux_area];
 908
 909                         if (data->t100_aux_ampl)
 910                                 pressure = message[data->t100_aux_ampl];
 911
 912                         if (data->t100_aux_vect)
 913                                 orientation = message[data->t100_aux_vect];
 914
 915                         break;
 916
 917                 case MXT_T100_TYPE_PASSIVE_STYLUS:
 918                         tool = MT_TOOL_PEN;
 919
 920                         /*
 921                          * Passive stylus is reported with size zero so
 922                          * hardcode.
 923                          */
 924                         major = MXT_TOUCH_MAJOR_DEFAULT;
 925
 926                         if (data->t100_aux_ampl)
 927                                 pressure = message[data->t100_aux_ampl];
 928
 929                         break;
 930
 931                 case MXT_T100_TYPE_LARGE_TOUCH:
 932                         /* Ignore suppressed touch */
 933                         break;
 934
 935                 default:
 936                         dev_dbg(dev, "Unexpected T100 type\n");
 937                         return;
 938                 }
 939         }
 940
 941         /*
 942          * Values reported should be non-zero if tool is touching the
 943          * device
 944          */
 945         if (!pressure && type != MXT_T100_TYPE_HOVERING_FINGER)
 946                 pressure = MXT_PRESSURE_DEFAULT;
 947
 948         input_mt_slot(input_dev, id);
 949
 950         if (status & MXT_T100_DETECT) {
 951                 dev_dbg(dev, "[%u] type:%u x:%u y:%u a:%02X p:%02X v:%02X\n",
 952                         id, type, x, y, major, pressure, orientation);
 953
 954                 input_mt_report_slot_state(input_dev, tool, 1);
 955                 input_report_abs(input_dev, ABS_MT_POSITION_X, x);
 956                 input_report_abs(input_dev, ABS_MT_POSITION_Y, y);
 957                 input_report_abs(input_dev, ABS_MT_TOUCH_MAJOR, major);
 958                 input_report_abs(input_dev, ABS_MT_PRESSURE, pressure);
 959                 input_report_abs(input_dev, ABS_MT_DISTANCE, distance);
 960                 input_report_abs(input_dev, ABS_MT_ORIENTATION, orientation);
 961         } else {
 962                 dev_dbg(dev, "[%u] release\n", id);
 963
 964                 /* close out slot */
 965                 input_mt_report_slot_state(input_dev, 0, 0);
 966         }
 967
 968         data->update_input = true;
 969 }
 970
 971 static int mxt_proc_message(struct mxt_data *data, u8 *message)
 972 {
 973         u8 report_id = message[0];
 974
 975         if (report_id == MXT_RPTID_NOMSG)
 976                 return 0;
 977
 978         if (report_id == data->T6_reportid) {
 979                 mxt_proc_t6_messages(data, message);
 980         } else if (!data->input_dev) {
 981                 /*
 982                  * Do not report events if input device
 983                  * is not yet registered.
 984                  */
 985                 mxt_dump_message(data, message);
 986         } else if (report_id >= data->T9_reportid_min &&
 987                    report_id <= data->T9_reportid_max) {
 988                 mxt_proc_t9_message(data, message);
 989         } else if (report_id >= data->T100_reportid_min &&
 990                    report_id <= data->T100_reportid_max) {
 991                 mxt_proc_t100_message(data, message);
 992         } else if (report_id == data->T19_reportid) {
 993                 mxt_input_button(data, message);
 994                 data->update_input = true;
 995         } else {
 996                 mxt_dump_message(data, message);
 997         }
 998
 999         return 1;
1000 }
1001
1002 static int mxt_read_and_process_messages(struct mxt_data *data, u8 count)
1003 {
1004         struct device *dev = &data->client->dev;
1005         int ret;
1006         int i;
1007         u8 num_valid = 0;
1008
1009         /* Safety check for msg_buf */
1010         if (count > data->max_reportid)
1011                 return -EINVAL;
1012
1013         /* Process remaining messages if necessary */
1014         ret = __mxt_read_reg(data->client, data->T5_address,
1015                                 data->T5_msg_size * count, data->msg_buf);
1016         if (ret) {
1017                 dev_err(dev, "Failed to read %u messages (%d)\n", count, ret);
1018                 return ret;
1019         }
1020
1021         for (i = 0;  i < count; i++) {
1022                 ret = mxt_proc_message(data,
1023                         data->msg_buf + data->T5_msg_size * i);
1024
1025                 if (ret == 1)
1026                         num_valid++;
1027         }
1028
1029         /* return number of messages read */
1030         return num_valid;
1031 }
1032
1033 static irqreturn_t mxt_process_messages_t44(struct mxt_data *data)
1034 {
1035         struct device *dev = &data->client->dev;
1036         int ret;
1037         u8 count, num_left;
1038
1039         /* Read T44 and T5 together */
1040         ret = __mxt_read_reg(data->client, data->T44_address,
1041                 data->T5_msg_size + 1, data->msg_buf);
1042         if (ret) {
1043                 dev_err(dev, "Failed to read T44 and T5 (%d)\n", ret);
1044                 return IRQ_NONE;
1045         }
1046
1047         count = data->msg_buf[0];
1048
1049         /*
1050          * This condition may be caused by the CHG line being configured in
1051          * Mode 0. It results in unnecessary I2C operations but it is benign.
1052          */
1053         if (count == 0)
1054                 return IRQ_NONE;
1055
1056         if (count > data->max_reportid) {
1057                 dev_warn(dev, "T44 count %d exceeded max report id\n", count);
1058                 count = data->max_reportid;
1059         }
1060
1061         /* Process first message */
1062         ret = mxt_proc_message(data, data->msg_buf + 1);
1063         if (ret < 0) {
1064                 dev_warn(dev, "Unexpected invalid message\n");
1065                 return IRQ_NONE;
1066         }
1067
1068         num_left = count - 1;
1069
1070         /* Process remaining messages if necessary */
1071         if (num_left) {
1072                 ret = mxt_read_and_process_messages(data, num_left);
1073                 if (ret < 0)
1074                         goto end;
1075                 else if (ret != num_left)
1076                         dev_warn(dev, "Unexpected invalid message\n");
1077         }
1078
1079 end:
1080         if (data->update_input) {
1081                 mxt_input_sync(data);
1082                 data->update_input = false;
1083         }
1084
1085         return IRQ_HANDLED;
1086 }
1087
1088 static int mxt_process_messages_until_invalid(struct mxt_data *data)
1089 {
1090         struct device *dev = &data->client->dev;
1091         int count, read;
1092         u8 tries = 2;
1093
1094         count = data->max_reportid;
1095
1096         /* Read messages until we force an invalid */
1097         do {
1098                 read = mxt_read_and_process_messages(data, count);
1099                 if (read < count)
1100                         return 0;
1101         } while (--tries);
1102
1103         if (data->update_input) {
1104                 mxt_input_sync(data);
1105                 data->update_input = false;
1106         }
1107
1108         dev_err(dev, "CHG pin isn't cleared\n");
1109         return -EBUSY;
1110 }
1111
1112 static irqreturn_t mxt_process_messages(struct mxt_data *data)
1113 {
1114         int total_handled, num_handled;
1115         u8 count = data->last_message_count;
1116
1117         if (count < 1 || count > data->max_reportid)
1118                 count = 1;
1119
1120         /* include final invalid message */
1121         total_handled = mxt_read_and_process_messages(data, count + 1);
1122         if (total_handled < 0)
1123                 return IRQ_NONE;
1124         /* if there were invalid messages, then we are done */
1125         else if (total_handled <= count)
1126                 goto update_count;
1127
1128         /* keep reading two msgs until one is invalid or reportid limit */
1129         do {
1130                 num_handled = mxt_read_and_process_messages(data, 2);
1131                 if (num_handled < 0)
1132                         return IRQ_NONE;
1133
1134                 total_handled += num_handled;
1135
1136                 if (num_handled < 2)
1137                         break;
1138         } while (total_handled < data->num_touchids);
1139
1140 update_count:
1141         data->last_message_count = total_handled;
1142
1143         if (data->update_input) {
1144                 mxt_input_sync(data);
1145                 data->update_input = false;
1146         }
1147
1148         return IRQ_HANDLED;
1149 }
1150
1151 static irqreturn_t mxt_interrupt(int irq, void *dev_id)
1152 {
1153         struct mxt_data *data = dev_id;
1154
1155         if (data->in_bootloader) {
1156                 /* bootloader state transition completion */
1157                 complete(&data->bl_completion);
1158                 return IRQ_HANDLED;
1159         }
1160
1161         if (!data->object_table)
1162                 return IRQ_HANDLED;
1163
1164         if (data->T44_address) {
1165                 return mxt_process_messages_t44(data);
1166         } else {
1167                 return mxt_process_messages(data);
1168         }
1169 }
1170
1171 static int mxt_t6_command(struct mxt_data *data, u16 cmd_offset,
1172                           u8 value, bool wait)
1173 {
1174         u16 reg;
1175         u8 command_register;
1176         int timeout_counter = 0;
1177         int ret;
1178
1179         reg = data->T6_address + cmd_offset;
1180
1181         ret = mxt_write_reg(data->client, reg, value);
1182         if (ret)
1183                 return ret;
1184
1185         if (!wait)
1186                 return 0;
1187
1188         do {
1189                 msleep(20);
1190                 ret = __mxt_read_reg(data->client, reg, 1, &command_register);
1191                 if (ret)
1192                         return ret;
1193         } while (command_register != 0 && timeout_counter++ <= 100);
1194
1195         if (timeout_counter > 100) {
1196                 dev_err(&data->client->dev, "Command failed!\n");
1197                 return -EIO;
1198         }
1199
1200         return 0;
1201 }
1202
1203 static int mxt_acquire_irq(struct mxt_data *data)
1204 {
1205         int error;
1206
1207         enable_irq(data->irq);
1208
1209         error = mxt_process_messages_until_invalid(data);
1210         if (error)
1211                 return error;
1212
1213         return 0;
1214 }
1215
1216 static int mxt_soft_reset(struct mxt_data *data)
1217 {
1218         struct device *dev = &data->client->dev;
1219         int ret = 0;
1220
1221         dev_info(dev, "Resetting device\n");
1222
1223         disable_irq(data->irq);
1224
1225         reinit_completion(&data->reset_completion);
1226
1227         ret = mxt_t6_command(data, MXT_COMMAND_RESET, MXT_RESET_VALUE, false);
1228         if (ret)
1229                 return ret;
1230
1231         /* Ignore CHG line for 100ms after reset */
1232         msleep(MXT_RESET_INVALID_CHG);
1233
1234         mxt_acquire_irq(data);
1235
1236         ret = mxt_wait_for_completion(data, &data->reset_completion,
1237                                       MXT_RESET_TIMEOUT);
1238         if (ret)
1239                 return ret;
1240
1241         return 0;
1242 }
1243
1244 static void mxt_update_crc(struct mxt_data *data, u8 cmd, u8 value)
1245 {
1246         /*
1247          * On failure, CRC is set to 0 and config will always be
1248          * downloaded.
1249          */
1250         data->config_crc = 0;
1251         reinit_completion(&data->crc_completion);
1252
1253         mxt_t6_command(data, cmd, value, true);
1254
1255         /*
1256          * Wait for crc message. On failure, CRC is set to 0 and config will
1257          * always be downloaded.
1258          */
1259         mxt_wait_for_completion(data, &data->crc_completion, MXT_CRC_TIMEOUT);
1260 }
1261
1262 static void mxt_calc_crc24(u32 *crc, u8 firstbyte, u8 secondbyte)
1263 {
1264         static const unsigned int crcpoly = 0x80001B;
1265         u32 result;
1266         u32 data_word;
1267
1268         data_word = (secondbyte << 8) | firstbyte;
1269         result = ((*crc << 1) ^ data_word);
1270
1271         if (result & 0x1000000)
1272                 result ^= crcpoly;
1273
1274         *crc = result;
1275 }
1276
1277 static u32 mxt_calculate_crc(u8 *base, off_t start_off, off_t end_off)
1278 {
1279         u32 crc = 0;
1280         u8 *ptr = base + start_off;
1281         u8 *last_val = base + end_off - 1;
1282
1283         if (end_off < start_off)
1284                 return -EINVAL;
1285
1286         while (ptr < last_val) {
1287                 mxt_calc_crc24(&crc, *ptr, *(ptr + 1));
1288                 ptr += 2;
1289         }
1290
1291         /* if len is odd, fill the last byte with 0 */
1292         if (ptr == last_val)
1293                 mxt_calc_crc24(&crc, *ptr, 0);
1294
1295         /* Mask to 24-bit */
1296         crc &= 0x00FFFFFF;
1297
1298         return crc;
1299 }
1300
1301 static int mxt_prepare_cfg_mem(struct mxt_data *data, struct mxt_cfg *cfg)
1302 {
1303         struct device *dev = &data->client->dev;
1304         struct mxt_object *object;
1305         unsigned int type, instance, size, byte_offset;
1306         int offset;
1307         int ret;
1308         int i;
1309         u16 reg;
1310         u8 val;
1311
1312         while (cfg->raw_pos < cfg->raw_size) {
1313                 /* Read type, instance, length */
1314                 ret = sscanf(cfg->raw + cfg->raw_pos, "%x %x %x%n",
1315                              &type, &instance, &size, &offset);
1316                 if (ret == 0) {
1317                         /* EOF */
1318                         break;
1319                 } else if (ret != 3) {
1320                         dev_err(dev, "Bad format: failed to parse object\n");
1321                         return -EINVAL;
1322                 }
1323                 cfg->raw_pos += offset;
1324
1325                 object = mxt_get_object(data, type);
1326                 if (!object) {
1327                         /* Skip object */
1328                         for (i = 0; i < size; i++) {
1329                                 ret = sscanf(cfg->raw + cfg->raw_pos, "%hhx%n",
1330                                              &val, &offset);
1331                                 if (ret != 1) {
1332                                         dev_err(dev, "Bad format in T%d at %d\n",
1333                                                 type, i);
1334                                         return -EINVAL;
1335                                 }
1336                                 cfg->raw_pos += offset;
1337                         }
1338                         continue;
1339                 }
1340
1341                 if (size > mxt_obj_size(object)) {
1342                         /*
1343                          * Either we are in fallback mode due to wrong
1344                          * config or config from a later fw version,
1345                          * or the file is corrupt or hand-edited.
1346                          */
1347                         dev_warn(dev, "Discarding %zu byte(s) in T%u\n",
1348                                  size - mxt_obj_size(object), type);
1349                 } else if (mxt_obj_size(object) > size) {
1350                         /*
1351                          * If firmware is upgraded, new bytes may be added to
1352                          * end of objects. It is generally forward compatible
1353                          * to zero these bytes - previous behaviour will be
1354                          * retained. However this does invalidate the CRC and
1355                          * will force fallback mode until the configuration is
1356                          * updated. We warn here but do nothing else - the
1357                          * malloc has zeroed the entire configuration.
1358                          */
1359                         dev_warn(dev, "Zeroing %zu byte(s) in T%d\n",
1360                                  mxt_obj_size(object) - size, type);
1361                 }
1362
1363                 if (instance >= mxt_obj_instances(object)) {
1364                         dev_err(dev, "Object instances exceeded!\n");
1365                         return -EINVAL;
1366                 }
1367
1368                 reg = object->start_address + mxt_obj_size(object) * instance;
1369
1370                 for (i = 0; i < size; i++) {
1371                         ret = sscanf(cfg->raw + cfg->raw_pos, "%hhx%n",
1372                                      &val,
1373                                      &offset);
1374                         if (ret != 1) {
1375                                 dev_err(dev, "Bad format in T%d at %d\n",
1376                                         type, i);
1377                                 return -EINVAL;
1378                         }
1379                         cfg->raw_pos += offset;
1380
1381                         if (i > mxt_obj_size(object))
1382                                 continue;
1383
1384                         byte_offset = reg + i - cfg->start_ofs;
1385
1386                         if (byte_offset >= 0 && byte_offset < cfg->mem_size) {
1387                                 *(cfg->mem + byte_offset) = val;
1388                         } else {
1389                                 dev_err(dev, "Bad object: reg:%d, T%d, ofs=%d\n",
1390                                         reg, object->type, byte_offset);
1391                                 return -EINVAL;
1392                         }
1393                 }
1394         }
1395
1396         return 0;
1397 }
1398
1399 static int mxt_upload_cfg_mem(struct mxt_data *data, struct mxt_cfg *cfg)
1400 {
1401         unsigned int byte_offset = 0;
1402         int error;
1403
1404         /* Write configuration as blocks */
1405         while (byte_offset < cfg->mem_size) {
1406                 unsigned int size = cfg->mem_size - byte_offset;
1407
1408                 if (size > MXT_MAX_BLOCK_WRITE)
1409                         size = MXT_MAX_BLOCK_WRITE;
1410
1411                 error = __mxt_write_reg(data->client,
1412                                         cfg->start_ofs + byte_offset,
1413                                         size, cfg->mem + byte_offset);
1414                 if (error) {
1415                         dev_err(&data->client->dev,
1416                                 "Config write error, ret=%d\n", error);
1417                         return error;
1418                 }
1419
1420                 byte_offset += size;
1421         }
1422
1423         return 0;
1424 }
1425
1426 static int mxt_init_t7_power_cfg(struct mxt_data *data);
1427
1428 /*
1429  * mxt_update_cfg - download configuration to chip
1430  *
1431  * Atmel Raw Config File Format
1432  *
1433  * The first four lines of the raw config file contain:
1434  *  1) Version
1435  *  2) Chip ID Information (first 7 bytes of device memory)
1436  *  3) Chip Information Block 24-bit CRC Checksum
1437  *  4) Chip Configuration 24-bit CRC Checksum
1438  *
1439  * The rest of the file consists of one line per object instance:
1440  *   <TYPE> <INSTANCE> <SIZE> <CONTENTS>
1441  *
1442  *   <TYPE> - 2-byte object type as hex
1443  *   <INSTANCE> - 2-byte object instance number as hex
1444  *   <SIZE> - 2-byte object size as hex
1445  *   <CONTENTS> - array of <SIZE> 1-byte hex values
1446  */
1447 static int mxt_update_cfg(struct mxt_data *data, const struct firmware *fw)
1448 {
1449         struct device *dev = &data->client->dev;
1450         struct mxt_cfg cfg;
1451         int ret;
1452         int offset;
1453         int i;
1454         u32 info_crc, config_crc, calculated_crc;
1455         u16 crc_start = 0;
1456
1457         /* Make zero terminated copy of the OBP_RAW file */
1458         cfg.raw = kmemdup_nul(fw->data, fw->size, GFP_KERNEL);
1459         if (!cfg.raw)
1460                 return -ENOMEM;
1461
1462         cfg.raw_size = fw->size;
1463
1464         mxt_update_crc(data, MXT_COMMAND_REPORTALL, 1);
1465
1466         if (strncmp(cfg.raw, MXT_CFG_MAGIC, strlen(MXT_CFG_MAGIC))) {
1467                 dev_err(dev, "Unrecognised config file\n");
1468                 ret = -EINVAL;
1469                 goto release_raw;
1470         }
1471
1472         cfg.raw_pos = strlen(MXT_CFG_MAGIC);
1473
1474         /* Load information block and check */
1475         for (i = 0; i < sizeof(struct mxt_info); i++) {
1476                 ret = sscanf(cfg.raw + cfg.raw_pos, "%hhx%n",
1477                              (unsigned char *)&cfg.info + i,
1478                              &offset);
1479                 if (ret != 1) {
1480                         dev_err(dev, "Bad format\n");
1481                         ret = -EINVAL;
1482                         goto release_raw;
1483                 }
1484
1485                 cfg.raw_pos += offset;
1486         }
1487
1488         if (cfg.info.family_id != data->info->family_id) {
1489                 dev_err(dev, "Family ID mismatch!\n");
1490                 ret = -EINVAL;
1491                 goto release_raw;
1492         }
1493
1494         if (cfg.info.variant_id != data->info->variant_id) {
1495                 dev_err(dev, "Variant ID mismatch!\n");
1496                 ret = -EINVAL;
1497                 goto release_raw;
1498         }
1499
1500         /* Read CRCs */
1501         ret = sscanf(cfg.raw + cfg.raw_pos, "%x%n", &info_crc, &offset);
1502         if (ret != 1) {
1503                 dev_err(dev, "Bad format: failed to parse Info CRC\n");
1504                 ret = -EINVAL;
1505                 goto release_raw;
1506         }
1507         cfg.raw_pos += offset;
1508
1509         ret = sscanf(cfg.raw + cfg.raw_pos, "%x%n", &config_crc, &offset);
1510         if (ret != 1) {
1511                 dev_err(dev, "Bad format: failed to parse Config CRC\n");
1512                 ret = -EINVAL;
1513                 goto release_raw;
1514         }
1515         cfg.raw_pos += offset;
1516
1517         /*
1518          * The Info Block CRC is calculated over mxt_info and the object
1519          * table. If it does not match then we are trying to load the
1520          * configuration from a different chip or firmware version, so
1521          * the configuration CRC is invalid anyway.
1522          */
1523         if (info_crc == data->info_crc) {
1524                 if (config_crc == 0 || data->config_crc == 0) {
1525                         dev_info(dev, "CRC zero, attempting to apply config\n");
1526                 } else if (config_crc == data->config_crc) {
1527                         dev_dbg(dev, "Config CRC 0x%06X: OK\n",
1528                                  data->config_crc);
1529                         return 0;
1530                 } else {
1531                         dev_info(dev, "Config CRC 0x%06X: does not match file 0x%06X\n",
1532                                  data->config_crc, config_crc);
1533                 }
1534         } else {
1535                 dev_warn(dev,
1536                          "Warning: Info CRC error - device=0x%06X file=0x%06X\n",
1537                          data->info_crc, info_crc);
1538         }
1539
1540         /* Malloc memory to store configuration */
1541         cfg.start_ofs = MXT_OBJECT_START +
1542                         data->info->object_num * sizeof(struct mxt_object) +
1543                         MXT_INFO_CHECKSUM_SIZE;
1544         cfg.mem_size = data->mem_size - cfg.start_ofs;
1545         cfg.mem = kzalloc(cfg.mem_size, GFP_KERNEL);
1546         if (!cfg.mem) {
1547                 ret = -ENOMEM;
1548                 goto release_raw;
1549         }
1550
1551         ret = mxt_prepare_cfg_mem(data, &cfg);
1552         if (ret)
1553                 goto release_mem;
1554
1555         /* Calculate crc of the received configs (not the raw config file) */
1556         if (data->T71_address)
1557                 crc_start = data->T71_address;
1558         else if (data->T7_address)
1559                 crc_start = data->T7_address;
1560         else
1561                 dev_warn(dev, "Could not find CRC start\n");
1562
1563         if (crc_start > cfg.start_ofs) {
1564                 calculated_crc = mxt_calculate_crc(cfg.mem,
1565                                                    crc_start - cfg.start_ofs,
1566                                                    cfg.mem_size);
1567
1568                 if (config_crc > 0 && config_crc != calculated_crc)
1569                         dev_warn(dev, "Config CRC in file inconsistent, calculated=%06X, file=%06X\n",
1570                                  calculated_crc, config_crc);
1571         }
1572
1573         ret = mxt_upload_cfg_mem(data, &cfg);
1574         if (ret)
1575                 goto release_mem;
1576
1577         mxt_update_crc(data, MXT_COMMAND_BACKUPNV, MXT_BACKUP_VALUE);
1578
1579         ret = mxt_soft_reset(data);
1580         if (ret)
1581                 goto release_mem;
1582
1583         dev_info(dev, "Config successfully updated\n");
1584
1585         /* T7 config may have changed */
1586         mxt_init_t7_power_cfg(data);
1587
1588 release_mem:
1589         kfree(cfg.mem);
1590 release_raw:
1591         kfree(cfg.raw);
1592         return ret;
1593 }
1594
1595 static void mxt_free_input_device(struct mxt_data *data)
1596 {
1597         if (data->input_dev) {
1598                 input_unregister_device(data->input_dev);
1599                 data->input_dev = NULL;
1600         }
1601 }
1602
1603 static void mxt_free_object_table(struct mxt_data *data)
1604 {
1605 #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
1606         video_unregister_device(&data->dbg.vdev);
1607         v4l2_device_unregister(&data->dbg.v4l2);
1608 #endif
1609         data->object_table = NULL;
1610         data->info = NULL;
1611         kfree(data->raw_info_block);
1612         data->raw_info_block = NULL;
1613         kfree(data->msg_buf);
1614         data->msg_buf = NULL;
1615         data->T5_address = 0;
1616         data->T5_msg_size = 0;
1617         data->T6_reportid = 0;
1618         data->T7_address = 0;
1619         data->T71_address = 0;
1620         data->T9_reportid_min = 0;
1621         data->T9_reportid_max = 0;
1622         data->T19_reportid = 0;
1623         data->T44_address = 0;
1624         data->T100_reportid_min = 0;
1625         data->T100_reportid_max = 0;
1626         data->max_reportid = 0;
1627 }
1628
1629 static int mxt_parse_object_table(struct mxt_data *data,
1630                                   struct mxt_object *object_table)
1631 {
1632         struct i2c_client *client = data->client;
1633         int i;
1634         u8 reportid;
1635         u16 end_address;
1636
1637         /* Valid Report IDs start counting from 1 */
1638         reportid = 1;
1639         data->mem_size = 0;
1640         for (i = 0; i < data->info->object_num; i++) {
1641                 struct mxt_object *object = object_table + i;
1642                 u8 min_id, max_id;
1643
1644                 le16_to_cpus(&object->start_address);
1645
1646                 if (object->num_report_ids) {
1647                         min_id = reportid;
1648                         reportid += object->num_report_ids *
1649                                         mxt_obj_instances(object);
1650                         max_id = reportid - 1;
1651                 } else {
1652                         min_id = 0;
1653                         max_id = 0;
1654                 }
1655
1656                 dev_dbg(&data->client->dev,
1657                         "T%u Start:%u Size:%zu Instances:%zu Report IDs:%u-%u\n",
1658                         object->type, object->start_address,
1659                         mxt_obj_size(object), mxt_obj_instances(object),
1660                         min_id, max_id);
1661
1662                 switch (object->type) {
1663                 case MXT_GEN_MESSAGE_T5:
1664                         if (data->info->family_id == 0x80 &&
1665                             data->info->version < 0x20) {
1666                                 /*
1667                                  * On mXT224 firmware versions prior to V2.0
1668                                  * read and discard unused CRC byte otherwise
1669                                  * DMA reads are misaligned.
1670                                  */
1671                                 data->T5_msg_size = mxt_obj_size(object);
1672                         } else {
1673                                 /* CRC not enabled, so skip last byte */
1674                                 data->T5_msg_size = mxt_obj_size(object) - 1;
1675                         }
1676                         data->T5_address = object->start_address;
1677                         break;
1678                 case MXT_GEN_COMMAND_T6:
1679                         data->T6_reportid = min_id;
1680                         data->T6_address = object->start_address;
1681                         break;
1682                 case MXT_GEN_POWER_T7:
1683                         data->T7_address = object->start_address;
1684                         break;
1685                 case MXT_SPT_DYNAMICCONFIGURATIONCONTAINER_T71:
1686                         data->T71_address = object->start_address;
1687                         break;
1688                 case MXT_TOUCH_MULTI_T9:
1689                         data->multitouch = MXT_TOUCH_MULTI_T9;
1690                         /* Only handle messages from first T9 instance */
1691                         data->T9_reportid_min = min_id;
1692                         data->T9_reportid_max = min_id +
1693                                                 object->num_report_ids - 1;
1694                         data->num_touchids = object->num_report_ids;
1695                         break;
1696                 case MXT_SPT_MESSAGECOUNT_T44:
1697                         data->T44_address = object->start_address;
1698                         break;
1699                 case MXT_SPT_GPIOPWM_T19:
1700                         data->T19_reportid = min_id;
1701                         break;
1702                 case MXT_TOUCH_MULTITOUCHSCREEN_T100:
1703                         data->multitouch = MXT_TOUCH_MULTITOUCHSCREEN_T100;
1704                         data->T100_reportid_min = min_id;
1705                         data->T100_reportid_max = max_id;
1706                         /* first two report IDs reserved */
1707                         data->num_touchids = object->num_report_ids - 2;
1708                         break;
1709                 }
1710
1711                 end_address = object->start_address
1712                         + mxt_obj_size(object) * mxt_obj_instances(object) - 1;
1713
1714                 if (end_address >= data->mem_size)
1715                         data->mem_size = end_address + 1;
1716         }
1717
1718         /* Store maximum reportid */
1719         data->max_reportid = reportid;
1720
1721         /* If T44 exists, T5 position has to be directly after */
1722         if (data->T44_address && (data->T5_address != data->T44_address + 1)) {
1723                 dev_err(&client->dev, "Invalid T44 position\n");
1724                 return -EINVAL;
1725         }
1726
1727         data->msg_buf = kcalloc(data->max_reportid,
1728                                 data->T5_msg_size, GFP_KERNEL);
1729         if (!data->msg_buf)
1730                 return -ENOMEM;
1731
1732         return 0;
1733 }
1734
1735 static int mxt_read_info_block(struct mxt_data *data)
1736 {
1737         struct i2c_client *client = data->client;
1738         int error;
1739         size_t size;
1740         void *id_buf, *buf;
1741         uint8_t num_objects;
1742         u32 calculated_crc;
1743         u8 *crc_ptr;
1744
1745         /* If info block already allocated, free it */
1746         if (data->raw_info_block)
1747                 mxt_free_object_table(data);
1748
1749         /* Read 7-byte ID information block starting at address 0 */
1750         size = sizeof(struct mxt_info);
1751         id_buf = kzalloc(size, GFP_KERNEL);
1752         if (!id_buf)
1753                 return -ENOMEM;
1754
1755         error = __mxt_read_reg(client, 0, size, id_buf);
1756         if (error)
1757                 goto err_free_mem;
1758
1759         /* Resize buffer to give space for rest of info block */
1760         num_objects = ((struct mxt_info *)id_buf)->object_num;
1761         size += (num_objects * sizeof(struct mxt_object))
1762                 + MXT_INFO_CHECKSUM_SIZE;
1763
1764         buf = krealloc(id_buf, size, GFP_KERNEL);
1765         if (!buf) {
1766                 error = -ENOMEM;
1767                 goto err_free_mem;
1768         }
1769         id_buf = buf;
1770
1771         /* Read rest of info block */
1772         error = __mxt_read_reg(client, MXT_OBJECT_START,
1773                                size - MXT_OBJECT_START,
1774                                id_buf + MXT_OBJECT_START);
1775         if (error)
1776                 goto err_free_mem;
1777
1778         /* Extract & calculate checksum */
1779         crc_ptr = id_buf + size - MXT_INFO_CHECKSUM_SIZE;
1780         data->info_crc = crc_ptr[0] | (crc_ptr[1] << 8) | (crc_ptr[2] << 16);
1781
1782         calculated_crc = mxt_calculate_crc(id_buf, 0,
1783                                            size - MXT_INFO_CHECKSUM_SIZE);
1784
1785         /*
1786          * CRC mismatch can be caused by data corruption due to I2C comms
1787          * issue or else device is not using Object Based Protocol (eg i2c-hid)
1788          */
1789         if ((data->info_crc == 0) || (data->info_crc != calculated_crc)) {
1790                 dev_err(&client->dev,
1791                         "Info Block CRC error calculated=0x%06X read=0x%06X\n",
1792                         calculated_crc, data->info_crc);
1793                 error = -EIO;
1794                 goto err_free_mem;
1795         }
1796
1797         data->raw_info_block = id_buf;
1798         data->info = (struct mxt_info *)id_buf;
1799
1800         dev_info(&client->dev,
1801                  "Family: %u Variant: %u Firmware V%u.%u.%02X Objects: %u\n",
1802                  data->info->family_id, data->info->variant_id,
1803                  data->info->version >> 4, data->info->version & 0xf,
1804                  data->info->build, data->info->object_num);
1805
1806         /* Parse object table information */
1807         error = mxt_parse_object_table(data, id_buf + MXT_OBJECT_START);
1808         if (error) {
1809                 dev_err(&client->dev, "Error %d parsing object table\n", error);
1810                 mxt_free_object_table(data);
1811                 goto err_free_mem;
1812         }
1813
1814         data->object_table = (struct mxt_object *)(id_buf + MXT_OBJECT_START);
1815
1816         return 0;
1817
1818 err_free_mem:
1819         kfree(id_buf);
1820         return error;
1821 }
1822
1823 static int mxt_read_t9_resolution(struct mxt_data *data)
1824 {
1825         struct i2c_client *client = data->client;
1826         int error;
1827         struct t9_range range;
1828         unsigned char orient;
1829         struct mxt_object *object;
1830
1831         object = mxt_get_object(data, MXT_TOUCH_MULTI_T9);
1832         if (!object)
1833                 return -EINVAL;
1834
1835         error = __mxt_read_reg(client,
1836                                object->start_address + MXT_T9_XSIZE,
1837                                sizeof(data->xsize), &data->xsize);
1838         if (error)
1839                 return error;
1840
1841         error = __mxt_read_reg(client,
1842                                object->start_address + MXT_T9_YSIZE,
1843                                sizeof(data->ysize), &data->ysize);
1844         if (error)
1845                 return error;
1846
1847         error = __mxt_read_reg(client,
1848                                object->start_address + MXT_T9_RANGE,
1849                                sizeof(range), &range);
1850         if (error)
1851                 return error;
1852
1853         data->max_x = get_unaligned_le16(&range.x);
1854         data->max_y = get_unaligned_le16(&range.y);
1855
1856         error =  __mxt_read_reg(client,
1857                                 object->start_address + MXT_T9_ORIENT,
1858                                 1, &orient);
1859         if (error)
1860                 return error;
1861
1862         data->xy_switch = orient & MXT_T9_ORIENT_SWITCH;
1863         data->invertx = orient & MXT_T9_ORIENT_INVERTX;
1864         data->inverty = orient & MXT_T9_ORIENT_INVERTY;
1865
1866         return 0;
1867 }
1868
1869 static int mxt_read_t100_config(struct mxt_data *data)
1870 {
1871         struct i2c_client *client = data->client;
1872         int error;
1873         struct mxt_object *object;
1874         u16 range_x, range_y;
1875         u8 cfg, tchaux;
1876         u8 aux;
1877
1878         object = mxt_get_object(data, MXT_TOUCH_MULTITOUCHSCREEN_T100);
1879         if (!object)
1880                 return -EINVAL;
1881
1882         /* read touchscreen dimensions */
1883         error = __mxt_read_reg(client,
1884                                object->start_address + MXT_T100_XRANGE,
1885                                sizeof(range_x), &range_x);
1886         if (error)
1887                 return error;
1888
1889         data->max_x = get_unaligned_le16(&range_x);
1890
1891         error = __mxt_read_reg(client,
1892                                object->start_address + MXT_T100_YRANGE,
1893                                sizeof(range_y), &range_y);
1894         if (error)
1895                 return error;
1896
1897         data->max_y = get_unaligned_le16(&range_y);
1898
1899         error = __mxt_read_reg(client,
1900                                object->start_address + MXT_T100_XSIZE,
1901                                sizeof(data->xsize), &data->xsize);
1902         if (error)
1903                 return error;
1904
1905         error = __mxt_read_reg(client,
1906                                object->start_address + MXT_T100_YSIZE,
1907                                sizeof(data->ysize), &data->ysize);
1908         if (error)
1909                 return error;
1910
1911         /* read orientation config */
1912         error =  __mxt_read_reg(client,
1913                                 object->start_address + MXT_T100_CFG1,
1914                                 1, &cfg);
1915         if (error)
1916                 return error;
1917
1918         data->xy_switch = cfg & MXT_T100_CFG_SWITCHXY;
1919         data->invertx = cfg & MXT_T100_CFG_INVERTX;
1920         data->inverty = cfg & MXT_T100_CFG_INVERTY;
1921
1922         /* allocate aux bytes */
1923         error =  __mxt_read_reg(client,
1924                                 object->start_address + MXT_T100_TCHAUX,
1925                                 1, &tchaux);
1926         if (error)
1927                 return error;
1928
1929         aux = 6;
1930
1931         if (tchaux & MXT_T100_TCHAUX_VECT)
1932                 data->t100_aux_vect = aux++;
1933
1934         if (tchaux & MXT_T100_TCHAUX_AMPL)
1935                 data->t100_aux_ampl = aux++;
1936
1937         if (tchaux & MXT_T100_TCHAUX_AREA)
1938                 data->t100_aux_area = aux++;
1939
1940         dev_dbg(&client->dev,
1941                 "T100 aux mappings vect:%u ampl:%u area:%u\n",
1942                 data->t100_aux_vect, data->t100_aux_ampl, data->t100_aux_area);
1943
1944         return 0;
1945 }
1946
1947 static int mxt_input_open(struct input_dev *dev);
1948 static void mxt_input_close(struct input_dev *dev);
1949
1950 static void mxt_set_up_as_touchpad(struct input_dev *input_dev,
1951                                    struct mxt_data *data)
1952 {
1953         int i;
1954
1955         input_dev->name = "Atmel maXTouch Touchpad";
1956
1957         __set_bit(INPUT_PROP_BUTTONPAD, input_dev->propbit);
1958
1959         input_abs_set_res(input_dev, ABS_X, MXT_PIXELS_PER_MM);
1960         input_abs_set_res(input_dev, ABS_Y, MXT_PIXELS_PER_MM);
1961         input_abs_set_res(input_dev, ABS_MT_POSITION_X,
1962                           MXT_PIXELS_PER_MM);
1963         input_abs_set_res(input_dev, ABS_MT_POSITION_Y,
1964                           MXT_PIXELS_PER_MM);
1965
1966         for (i = 0; i < data->t19_num_keys; i++)
1967                 if (data->t19_keymap[i] != KEY_RESERVED)
1968                         input_set_capability(input_dev, EV_KEY,
1969                                              data->t19_keymap[i]);
1970 }
1971
1972 static int mxt_initialize_input_device(struct mxt_data *data)
1973 {
1974         struct device *dev = &data->client->dev;
1975         struct input_dev *input_dev;
1976         int error;
1977         unsigned int num_mt_slots;
1978         unsigned int mt_flags = 0;
1979
1980         switch (data->multitouch) {
1981         case MXT_TOUCH_MULTI_T9:
1982                 num_mt_slots = data->T9_reportid_max - data->T9_reportid_min + 1;
1983                 error = mxt_read_t9_resolution(data);
1984                 if (error)
1985                         dev_warn(dev, "Failed to initialize T9 resolution\n");
1986                 break;
1987
1988         case MXT_TOUCH_MULTITOUCHSCREEN_T100:
1989                 num_mt_slots = data->num_touchids;
1990                 error = mxt_read_t100_config(data);
1991                 if (error)
1992                         dev_warn(dev, "Failed to read T100 config\n");
1993                 break;
1994
1995         default:
1996                 dev_err(dev, "Invalid multitouch object\n");
1997                 return -EINVAL;
1998         }
1999
2000         /* Handle default values and orientation switch */
2001         if (data->max_x == 0)
2002                 data->max_x = 1023;
2003
2004         if (data->max_y == 0)
2005                 data->max_y = 1023;
2006
2007         if (data->xy_switch)
2008                 swap(data->max_x, data->max_y);
2009
2010         dev_info(dev, "Touchscreen size X%uY%u\n", data->max_x, data->max_y);
2011
2012         /* Register input device */
2013         input_dev = input_allocate_device();
2014         if (!input_dev)
2015                 return -ENOMEM;
2016
2017         input_dev->name = "Atmel maXTouch Touchscreen";
2018         input_dev->phys = data->phys;
2019         input_dev->id.bustype = BUS_I2C;
2020         input_dev->dev.parent = dev;
2021         input_dev->open = mxt_input_open;
2022         input_dev->close = mxt_input_close;
2023
2024         input_set_capability(input_dev, EV_KEY, BTN_TOUCH);
2025
2026         /* For single touch */
2027         input_set_abs_params(input_dev, ABS_X, 0, data->max_x, 0, 0);
2028         input_set_abs_params(input_dev, ABS_Y, 0, data->max_y, 0, 0);
2029
2030         if (data->multitouch == MXT_TOUCH_MULTI_T9 ||
2031             (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
2032              data->t100_aux_ampl)) {
2033                 input_set_abs_params(input_dev, ABS_PRESSURE, 0, 255, 0, 0);
2034         }
2035
2036         /* If device has buttons we assume it is a touchpad */
2037         if (data->t19_num_keys) {
2038                 mxt_set_up_as_touchpad(input_dev, data);
2039                 mt_flags |= INPUT_MT_POINTER;
2040         } else {
2041                 mt_flags |= INPUT_MT_DIRECT;
2042         }
2043
2044         /* For multi touch */
2045         error = input_mt_init_slots(input_dev, num_mt_slots, mt_flags);
2046         if (error) {
2047                 dev_err(dev, "Error %d initialising slots\n", error);
2048                 goto err_free_mem;
2049         }
2050
2051         if (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100) {
2052                 input_set_abs_params(input_dev, ABS_MT_TOOL_TYPE,
2053                                      0, MT_TOOL_MAX, 0, 0);
2054                 input_set_abs_params(input_dev, ABS_MT_DISTANCE,
2055                                      MXT_DISTANCE_ACTIVE_TOUCH,
2056                                      MXT_DISTANCE_HOVERING,
2057                                      0, 0);
2058         }
2059
2060         input_set_abs_params(input_dev, ABS_MT_POSITION_X,
2061                              0, data->max_x, 0, 0);
2062         input_set_abs_params(input_dev, ABS_MT_POSITION_Y,
2063                              0, data->max_y, 0, 0);
2064
2065         if (data->multitouch == MXT_TOUCH_MULTI_T9 ||
2066             (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
2067              data->t100_aux_area)) {
2068                 input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR,
2069                                      0, MXT_MAX_AREA, 0, 0);
2070         }
2071
2072         if (data->multitouch == MXT_TOUCH_MULTI_T9 ||
2073             (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
2074              data->t100_aux_ampl)) {
2075                 input_set_abs_params(input_dev, ABS_MT_PRESSURE,
2076                                      0, 255, 0, 0);
2077         }
2078
2079         if (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
2080             data->t100_aux_vect) {
2081                 input_set_abs_params(input_dev, ABS_MT_ORIENTATION,
2082                                      0, 255, 0, 0);
2083         }
2084
2085         if (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
2086             data->t100_aux_vect) {
2087                 input_set_abs_params(input_dev, ABS_MT_ORIENTATION,
2088                                      0, 255, 0, 0);
2089         }
2090
2091         input_set_drvdata(input_dev, data);
2092
2093         error = input_register_device(input_dev);
2094         if (error) {
2095                 dev_err(dev, "Error %d registering input device\n", error);
2096                 goto err_free_mem;
2097         }
2098
2099         data->input_dev = input_dev;
2100
2101         return 0;
2102
2103 err_free_mem:
2104         input_free_device(input_dev);
2105         return error;
2106 }
2107
2108 static int mxt_configure_objects(struct mxt_data *data,
2109                                  const struct firmware *cfg);
2110
2111 static void mxt_config_cb(const struct firmware *cfg, void *ctx)
2112 {
2113         mxt_configure_objects(ctx, cfg);
2114         release_firmware(cfg);
2115 }
2116
2117 static int mxt_initialize(struct mxt_data *data)
2118 {
2119         struct i2c_client *client = data->client;
2120         int recovery_attempts = 0;
2121         int error;
2122
2123         while (1) {
2124                 error = mxt_read_info_block(data);
2125                 if (!error)
2126                         break;
2127
2128                 /* Check bootloader state */
2129                 error = mxt_probe_bootloader(data, false);
2130                 if (error) {
2131                         dev_info(&client->dev, "Trying alternate bootloader address\n");
2132                         error = mxt_probe_bootloader(data, true);
2133                         if (error) {
2134                                 /* Chip is not in appmode or bootloader mode */
2135                                 return error;
2136                         }
2137                 }
2138
2139                 /* OK, we are in bootloader, see if we can recover */
2140                 if (++recovery_attempts > 1) {
2141                         dev_err(&client->dev, "Could not recover from bootloader mode\n");
2142                         /*
2143                          * We can reflash from this state, so do not
2144                          * abort initialization.
2145                          */
2146                         data->in_bootloader = true;
2147                         return 0;
2148                 }
2149
2150                 /* Attempt to exit bootloader into app mode */
2151                 mxt_send_bootloader_cmd(data, false);
2152                 msleep(MXT_FW_RESET_TIME);
2153         }
2154
2155         error = mxt_acquire_irq(data);
2156         if (error)
2157                 return error;
2158
2159         error = request_firmware_nowait(THIS_MODULE, true, MXT_CFG_NAME,
2160                                         &client->dev, GFP_KERNEL, data,
2161                                         mxt_config_cb);
2162         if (error) {
2163                 dev_err(&client->dev, "Failed to invoke firmware loader: %d\n",
2164                         error);
2165                 return error;
2166         }
2167
2168         return 0;
2169 }
2170
2171 static int mxt_set_t7_power_cfg(struct mxt_data *data, u8 sleep)
2172 {
2173         struct device *dev = &data->client->dev;
2174         int error;
2175         struct t7_config *new_config;
2176         struct t7_config deepsleep = { .active = 0, .idle = 0 };
2177
2178         if (sleep == MXT_POWER_CFG_DEEPSLEEP)
2179                 new_config = &deepsleep;
2180         else
2181                 new_config = &data->t7_cfg;
2182
2183         error = __mxt_write_reg(data->client, data->T7_address,
2184                                 sizeof(data->t7_cfg), new_config);
2185         if (error)
2186                 return error;
2187
2188         dev_dbg(dev, "Set T7 ACTV:%d IDLE:%d\n",
2189                 new_config->active, new_config->idle);
2190
2191         return 0;
2192 }
2193
2194 static int mxt_init_t7_power_cfg(struct mxt_data *data)
2195 {
2196         struct device *dev = &data->client->dev;
2197         int error;
2198         bool retry = false;
2199
2200 recheck:
2201         error = __mxt_read_reg(data->client, data->T7_address,
2202                                 sizeof(data->t7_cfg), &data->t7_cfg);
2203         if (error)
2204                 return error;
2205
2206         if (data->t7_cfg.active == 0 || data->t7_cfg.idle == 0) {
2207                 if (!retry) {
2208                         dev_dbg(dev, "T7 cfg zero, resetting\n");
2209                         mxt_soft_reset(data);
2210                         retry = true;
2211                         goto recheck;
2212                 } else {
2213                         dev_dbg(dev, "T7 cfg zero after reset, overriding\n");
2214                         data->t7_cfg.active = 20;
2215                         data->t7_cfg.idle = 100;
2216                         return mxt_set_t7_power_cfg(data, MXT_POWER_CFG_RUN);
2217                 }
2218         }
2219
2220         dev_dbg(dev, "Initialized power cfg: ACTV %d, IDLE %d\n",
2221                 data->t7_cfg.active, data->t7_cfg.idle);
2222         return 0;
2223 }
2224
2225 #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
2226 static u16 mxt_get_debug_value(struct mxt_data *data, unsigned int x,
2227                                unsigned int y)
2228 {
2229         struct mxt_info *info = data->info;
2230         struct mxt_dbg *dbg = &data->dbg;
2231         unsigned int ofs, page;
2232         unsigned int col = 0;
2233         unsigned int col_width;
2234
2235         if (info->family_id == MXT_FAMILY_1386) {
2236                 col_width = info->matrix_ysize / MXT1386_COLUMNS;
2237                 col = y / col_width;
2238                 y = y % col_width;
2239         } else {
2240                 col_width = info->matrix_ysize;
2241         }
2242
2243         ofs = (y + (x * col_width)) * sizeof(u16);
2244         page = ofs / MXT_DIAGNOSTIC_SIZE;
2245         ofs %= MXT_DIAGNOSTIC_SIZE;
2246
2247         if (info->family_id == MXT_FAMILY_1386)
2248                 page += col * MXT1386_PAGES_PER_COLUMN;
2249
2250         return get_unaligned_le16(&dbg->t37_buf[page].data[ofs]);
2251 }
2252
2253 static int mxt_convert_debug_pages(struct mxt_data *data, u16 *outbuf)
2254 {
2255         struct mxt_dbg *dbg = &data->dbg;
2256         unsigned int x = 0;
2257         unsigned int y = 0;
2258         unsigned int i, rx, ry;
2259
2260         for (i = 0; i < dbg->t37_nodes; i++) {
2261                 /* Handle orientation */
2262                 rx = data->xy_switch ? y : x;
2263                 ry = data->xy_switch ? x : y;
2264                 rx = data->invertx ? (data->xsize - 1 - rx) : rx;
2265                 ry = data->inverty ? (data->ysize - 1 - ry) : ry;
2266
2267                 outbuf[i] = mxt_get_debug_value(data, rx, ry);
2268
2269                 /* Next value */
2270                 if (++x >= (data->xy_switch ? data->ysize : data->xsize)) {
2271                         x = 0;
2272                         y++;
2273                 }
2274         }
2275
2276         return 0;
2277 }
2278
2279 static int mxt_read_diagnostic_debug(struct mxt_data *data, u8 mode,
2280                                      u16 *outbuf)
2281 {
2282         struct mxt_dbg *dbg = &data->dbg;
2283         int retries = 0;
2284         int page;
2285         int ret;
2286         u8 cmd = mode;
2287         struct t37_debug *p;
2288         u8 cmd_poll;
2289
2290         for (page = 0; page < dbg->t37_pages; page++) {
2291                 p = dbg->t37_buf + page;
2292
2293                 ret = mxt_write_reg(data->client, dbg->diag_cmd_address,
2294                                     cmd);
2295                 if (ret)
2296                         return ret;
2297
2298                 retries = 0;
2299                 msleep(20);
2300 wait_cmd:
2301                 /* Read back command byte */
2302                 ret = __mxt_read_reg(data->client, dbg->diag_cmd_address,
2303                                      sizeof(cmd_poll), &cmd_poll);
2304                 if (ret)
2305                         return ret;
2306
2307                 /* Field is cleared once the command has been processed */
2308                 if (cmd_poll) {
2309                         if (retries++ > 100)
2310                                 return -EINVAL;
2311
2312                         msleep(20);
2313                         goto wait_cmd;
2314                 }
2315
2316                 /* Read T37 page */
2317                 ret = __mxt_read_reg(data->client, dbg->t37_address,
2318                                      sizeof(struct t37_debug), p);
2319                 if (ret)
2320                         return ret;
2321
2322                 if (p->mode != mode || p->page != page) {
2323                         dev_err(&data->client->dev, "T37 page mismatch\n");
2324                         return -EINVAL;
2325                 }
2326
2327                 dev_dbg(&data->client->dev, "%s page:%d retries:%d\n",
2328                         __func__, page, retries);
2329
2330                 /* For remaining pages, write PAGEUP rather than mode */
2331                 cmd = MXT_DIAGNOSTIC_PAGEUP;
2332         }
2333
2334         return mxt_convert_debug_pages(data, outbuf);
2335 }
2336
2337 static int mxt_queue_setup(struct vb2_queue *q,
2338                        unsigned int *nbuffers, unsigned int *nplanes,
2339                        unsigned int sizes[], struct device *alloc_devs[])
2340 {
2341         struct mxt_data *data = q->drv_priv;
2342         size_t size = data->dbg.t37_nodes * sizeof(u16);
2343
2344         if (*nplanes)
2345                 return sizes[0] < size ? -EINVAL : 0;
2346
2347         *nplanes = 1;
2348         sizes[0] = size;
2349
2350         return 0;
2351 }
2352
2353 static void mxt_buffer_queue(struct vb2_buffer *vb)
2354 {
2355         struct mxt_data *data = vb2_get_drv_priv(vb->vb2_queue);
2356         u16 *ptr;
2357         int ret;
2358         u8 mode;
2359
2360         ptr = vb2_plane_vaddr(vb, 0);
2361         if (!ptr) {
2362                 dev_err(&data->client->dev, "Error acquiring frame ptr\n");
2363                 goto fault;
2364         }
2365
2366         switch (data->dbg.input) {
2367         case MXT_V4L_INPUT_DELTAS:
2368         default:
2369                 mode = MXT_DIAGNOSTIC_DELTAS;
2370                 break;
2371
2372         case MXT_V4L_INPUT_REFS:
2373                 mode = MXT_DIAGNOSTIC_REFS;
2374                 break;
2375         }
2376
2377         ret = mxt_read_diagnostic_debug(data, mode, ptr);
2378         if (ret)
2379                 goto fault;
2380
2381         vb2_set_plane_payload(vb, 0, data->dbg.t37_nodes * sizeof(u16));
2382         vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
2383         return;
2384
2385 fault:
2386         vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
2387 }
2388
2389 /* V4L2 structures */
2390 static const struct vb2_ops mxt_queue_ops = {
2391         .queue_setup            = mxt_queue_setup,
2392         .buf_queue              = mxt_buffer_queue,
2393         .wait_prepare           = vb2_ops_wait_prepare,
2394         .wait_finish            = vb2_ops_wait_finish,
2395 };
2396
2397 static const struct vb2_queue mxt_queue = {
2398         .type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
2399         .io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF | VB2_READ,
2400         .buf_struct_size = sizeof(struct mxt_vb2_buffer),
2401         .ops = &mxt_queue_ops,
2402         .mem_ops = &vb2_vmalloc_memops,
2403         .timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC,
2404         .min_buffers_needed = 1,
2405 };
2406
2407 static int mxt_vidioc_querycap(struct file *file, void *priv,
2408                                  struct v4l2_capability *cap)
2409 {
2410         struct mxt_data *data = video_drvdata(file);
2411
2412         strlcpy(cap->driver, "atmel_mxt_ts", sizeof(cap->driver));
2413         strlcpy(cap->card, "atmel_mxt_ts touch", sizeof(cap->card));
2414         snprintf(cap->bus_info, sizeof(cap->bus_info),
2415                  "I2C:%s", dev_name(&data->client->dev));
2416         return 0;
2417 }
2418
2419 static int mxt_vidioc_enum_input(struct file *file, void *priv,
2420                                    struct v4l2_input *i)
2421 {
2422         if (i->index >= MXT_V4L_INPUT_MAX)
2423                 return -EINVAL;
2424
2425         i->type = V4L2_INPUT_TYPE_TOUCH;
2426
2427         switch (i->index) {
2428         case MXT_V4L_INPUT_REFS:
2429                 strlcpy(i->name, "Mutual Capacitance References",
2430                         sizeof(i->name));
2431                 break;
2432         case MXT_V4L_INPUT_DELTAS:
2433                 strlcpy(i->name, "Mutual Capacitance Deltas", sizeof(i->name));
2434                 break;
2435         }
2436
2437         return 0;
2438 }
2439
2440 static int mxt_set_input(struct mxt_data *data, unsigned int i)
2441 {
2442         struct v4l2_pix_format *f = &data->dbg.format;
2443
2444         if (i >= MXT_V4L_INPUT_MAX)
2445                 return -EINVAL;
2446
2447         if (i == MXT_V4L_INPUT_DELTAS)
2448                 f->pixelformat = V4L2_TCH_FMT_DELTA_TD16;
2449         else
2450                 f->pixelformat = V4L2_TCH_FMT_TU16;
2451
2452         f->width = data->xy_switch ? data->ysize : data->xsize;
2453         f->height = data->xy_switch ? data->xsize : data->ysize;
2454         f->field = V4L2_FIELD_NONE;
2455         f->colorspace = V4L2_COLORSPACE_RAW;
2456         f->bytesperline = f->width * sizeof(u16);
2457         f->sizeimage = f->width * f->height * sizeof(u16);
2458
2459         data->dbg.input = i;
2460
2461         return 0;
2462 }
2463
2464 static int mxt_vidioc_s_input(struct file *file, void *priv, unsigned int i)
2465 {
2466         return mxt_set_input(video_drvdata(file), i);
2467 }
2468
2469 static int mxt_vidioc_g_input(struct file *file, void *priv, unsigned int *i)
2470 {
2471         struct mxt_data *data = video_drvdata(file);
2472
2473         *i = data->dbg.input;
2474
2475         return 0;
2476 }
2477
2478 static int mxt_vidioc_fmt(struct file *file, void *priv, struct v4l2_format *f)
2479 {
2480         struct mxt_data *data = video_drvdata(file);
2481
2482         f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2483         f->fmt.pix = data->dbg.format;
2484
2485         return 0;
2486 }
2487
2488 static int mxt_vidioc_enum_fmt(struct file *file, void *priv,
2489                                  struct v4l2_fmtdesc *fmt)
2490 {
2491         if (fmt->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
2492                 return -EINVAL;
2493
2494         switch (fmt->index) {
2495         case 0:
2496                 fmt->pixelformat = V4L2_TCH_FMT_TU16;
2497                 break;
2498
2499         case 1:
2500                 fmt->pixelformat = V4L2_TCH_FMT_DELTA_TD16;
2501                 break;
2502
2503         default:
2504                 return -EINVAL;
2505         }
2506
2507         return 0;
2508 }
2509
2510 static int mxt_vidioc_g_parm(struct file *file, void *fh,
2511                              struct v4l2_streamparm *a)
2512 {
2513         if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
2514                 return -EINVAL;
2515
2516         a->parm.capture.readbuffers = 1;
2517         a->parm.capture.timeperframe.numerator = 1;
2518         a->parm.capture.timeperframe.denominator = 10;
2519         return 0;
2520 }
2521
2522 static const struct v4l2_ioctl_ops mxt_video_ioctl_ops = {
2523         .vidioc_querycap        = mxt_vidioc_querycap,
2524
2525         .vidioc_enum_fmt_vid_cap = mxt_vidioc_enum_fmt,
2526         .vidioc_s_fmt_vid_cap   = mxt_vidioc_fmt,
2527         .vidioc_g_fmt_vid_cap   = mxt_vidioc_fmt,
2528         .vidioc_try_fmt_vid_cap = mxt_vidioc_fmt,
2529         .vidioc_g_parm          = mxt_vidioc_g_parm,
2530
2531         .vidioc_enum_input      = mxt_vidioc_enum_input,
2532         .vidioc_g_input         = mxt_vidioc_g_input,
2533         .vidioc_s_input         = mxt_vidioc_s_input,
2534
2535         .vidioc_reqbufs         = vb2_ioctl_reqbufs,
2536         .vidioc_create_bufs     = vb2_ioctl_create_bufs,
2537         .vidioc_querybuf        = vb2_ioctl_querybuf,
2538         .vidioc_qbuf            = vb2_ioctl_qbuf,
2539         .vidioc_dqbuf           = vb2_ioctl_dqbuf,
2540         .vidioc_expbuf          = vb2_ioctl_expbuf,
2541
2542         .vidioc_streamon        = vb2_ioctl_streamon,
2543         .vidioc_streamoff       = vb2_ioctl_streamoff,
2544 };
2545
2546 static const struct video_device mxt_video_device = {
2547         .name = "Atmel maxTouch",
2548         .fops = &mxt_video_fops,
2549         .ioctl_ops = &mxt_video_ioctl_ops,
2550         .release = video_device_release_empty,
2551         .device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_TOUCH |
2552                        V4L2_CAP_READWRITE | V4L2_CAP_STREAMING,
2553 };
2554
2555 static void mxt_debug_init(struct mxt_data *data)
2556 {
2557         struct mxt_info *info = data->info;
2558         struct mxt_dbg *dbg = &data->dbg;
2559         struct mxt_object *object;
2560         int error;
2561
2562         object = mxt_get_object(data, MXT_GEN_COMMAND_T6);
2563         if (!object)
2564                 goto error;
2565
2566         dbg->diag_cmd_address = object->start_address + MXT_COMMAND_DIAGNOSTIC;
2567
2568         object = mxt_get_object(data, MXT_DEBUG_DIAGNOSTIC_T37);
2569         if (!object)
2570                 goto error;
2571
2572         if (mxt_obj_size(object) != sizeof(struct t37_debug)) {
2573                 dev_warn(&data->client->dev, "Bad T37 size");
2574                 goto error;
2575         }
2576
2577         dbg->t37_address = object->start_address;
2578
2579         /* Calculate size of data and allocate buffer */
2580         dbg->t37_nodes = data->xsize * data->ysize;
2581
2582         if (info->family_id == MXT_FAMILY_1386)
2583                 dbg->t37_pages = MXT1386_COLUMNS * MXT1386_PAGES_PER_COLUMN;
2584         else
2585                 dbg->t37_pages = DIV_ROUND_UP(data->xsize *
2586                                               info->matrix_ysize *
2587                                               sizeof(u16),
2588                                               sizeof(dbg->t37_buf->data));
2589
2590         dbg->t37_buf = devm_kmalloc_array(&data->client->dev, dbg->t37_pages,
2591                                           sizeof(struct t37_debug), GFP_KERNEL);
2592         if (!dbg->t37_buf)
2593                 goto error;
2594
2595         /* init channel to zero */
2596         mxt_set_input(data, 0);
2597
2598         /* register video device */
2599         snprintf(dbg->v4l2.name, sizeof(dbg->v4l2.name), "%s", "atmel_mxt_ts");
2600         error = v4l2_device_register(&data->client->dev, &dbg->v4l2);
2601         if (error)
2602                 goto error;
2603
2604         /* initialize the queue */
2605         mutex_init(&dbg->lock);
2606         dbg->queue = mxt_queue;
2607         dbg->queue.drv_priv = data;
2608         dbg->queue.lock = &dbg->lock;
2609         dbg->queue.dev = &data->client->dev;
2610
2611         error = vb2_queue_init(&dbg->queue);
2612         if (error)
2613                 goto error_unreg_v4l2;
2614
2615         dbg->vdev = mxt_video_device;
2616         dbg->vdev.v4l2_dev = &dbg->v4l2;
2617         dbg->vdev.lock = &dbg->lock;
2618         dbg->vdev.vfl_dir = VFL_DIR_RX;
2619         dbg->vdev.queue = &dbg->queue;
2620         video_set_drvdata(&dbg->vdev, data);
2621
2622         error = video_register_device(&dbg->vdev, VFL_TYPE_TOUCH, -1);
2623         if (error)
2624                 goto error_unreg_v4l2;
2625
2626         return;
2627
2628 error_unreg_v4l2:
2629         v4l2_device_unregister(&dbg->v4l2);
2630 error:
2631         dev_warn(&data->client->dev, "Error initializing T37\n");
2632 }
2633 #else
2634 static void mxt_debug_init(struct mxt_data *data)
2635 {
2636 }
2637 #endif
2638
2639 static int mxt_configure_objects(struct mxt_data *data,
2640                                  const struct firmware *cfg)
2641 {
2642         struct device *dev = &data->client->dev;
2643         int error;
2644
2645         error = mxt_init_t7_power_cfg(data);
2646         if (error) {
2647                 dev_err(dev, "Failed to initialize power cfg\n");
2648                 return error;
2649         }
2650
2651         if (cfg) {
2652                 error = mxt_update_cfg(data, cfg);
2653                 if (error)
2654                         dev_warn(dev, "Error %d updating config\n", error);
2655         }
2656
2657         if (data->multitouch) {
2658                 error = mxt_initialize_input_device(data);
2659                 if (error)
2660                         return error;
2661         } else {
2662                 dev_warn(dev, "No touch object detected\n");
2663         }
2664
2665         mxt_debug_init(data);
2666
2667         return 0;
2668 }
2669
2670 /* Firmware Version is returned as Major.Minor.Build */
2671 static ssize_t mxt_fw_version_show(struct device *dev,
2672                                    struct device_attribute *attr, char *buf)
2673 {
2674         struct mxt_data *data = dev_get_drvdata(dev);
2675         struct mxt_info *info = data->info;
2676         return scnprintf(buf, PAGE_SIZE, "%u.%u.%02X\n",
2677                          info->version >> 4, info->version & 0xf, info->build);
2678 }
2679
2680 /* Hardware Version is returned as FamilyID.VariantID */
2681 static ssize_t mxt_hw_version_show(struct device *dev,
2682                                    struct device_attribute *attr, char *buf)
2683 {
2684         struct mxt_data *data = dev_get_drvdata(dev);
2685         struct mxt_info *info = data->info;
2686         return scnprintf(buf, PAGE_SIZE, "%u.%u\n",
2687                          info->family_id, info->variant_id);
2688 }
2689
2690 static ssize_t mxt_show_instance(char *buf, int count,
2691                                  struct mxt_object *object, int instance,
2692                                  const u8 *val)
2693 {
2694         int i;
2695
2696         if (mxt_obj_instances(object) > 1)
2697                 count += scnprintf(buf + count, PAGE_SIZE - count,
2698                                    "Instance %u\n", instance);
2699
2700         for (i = 0; i < mxt_obj_size(object); i++)
2701                 count += scnprintf(buf + count, PAGE_SIZE - count,
2702                                 "\t[%2u]: %02x (%d)\n", i, val[i], val[i]);
2703         count += scnprintf(buf + count, PAGE_SIZE - count, "\n");
2704
2705         return count;
2706 }
2707
2708 static ssize_t mxt_object_show(struct device *dev,
2709                                     struct device_attribute *attr, char *buf)
2710 {
2711         struct mxt_data *data = dev_get_drvdata(dev);
2712         struct mxt_object *object;
2713         int count = 0;
2714         int i, j;
2715         int error;
2716         u8 *obuf;
2717
2718         /* Pre-allocate buffer large enough to hold max sized object. */
2719         obuf = kmalloc(256, GFP_KERNEL);
2720         if (!obuf)
2721                 return -ENOMEM;
2722
2723         error = 0;
2724         for (i = 0; i < data->info->object_num; i++) {
2725                 object = data->object_table + i;
2726
2727                 if (!mxt_object_readable(object->type))
2728                         continue;
2729
2730                 count += scnprintf(buf + count, PAGE_SIZE - count,
2731                                 "T%u:\n", object->type);
2732
2733                 for (j = 0; j < mxt_obj_instances(object); j++) {
2734                         u16 size = mxt_obj_size(object);
2735                         u16 addr = object->start_address + j * size;
2736
2737                         error = __mxt_read_reg(data->client, addr, size, obuf);
2738                         if (error)
2739                                 goto done;
2740
2741                         count = mxt_show_instance(buf, count, object, j, obuf);
2742                 }
2743         }
2744
2745 done:
2746         kfree(obuf);
2747         return error ?: count;
2748 }
2749
2750 static int mxt_check_firmware_format(struct device *dev,
2751                                      const struct firmware *fw)
2752 {
2753         unsigned int pos = 0;
2754         char c;
2755
2756         while (pos < fw->size) {
2757                 c = *(fw->data + pos);
2758
2759                 if (c < '0' || (c > '9' && c < 'A') || c > 'F')
2760                         return 0;
2761
2762                 pos++;
2763         }
2764
2765         /*
2766          * To convert file try:
2767          * xxd -r -p mXTXXX__APP_VX-X-XX.enc > maxtouch.fw
2768          */
2769         dev_err(dev, "Aborting: firmware file must be in binary format\n");
2770
2771         return -EINVAL;
2772 }
2773
2774 static int mxt_load_fw(struct device *dev, const char *fn)
2775 {
2776         struct mxt_data *data = dev_get_drvdata(dev);
2777         const struct firmware *fw = NULL;
2778         unsigned int frame_size;
2779         unsigned int pos = 0;
2780         unsigned int retry = 0;
2781         unsigned int frame = 0;
2782         int ret;
2783
2784         ret = request_firmware(&fw, fn, dev);
2785         if (ret) {
2786                 dev_err(dev, "Unable to open firmware %s\n", fn);
2787                 return ret;
2788         }
2789
2790         /* Check for incorrect enc file */
2791         ret = mxt_check_firmware_format(dev, fw);
2792         if (ret)
2793                 goto release_firmware;
2794
2795         if (!data->in_bootloader) {
2796                 /* Change to the bootloader mode */
2797                 data->in_bootloader = true;
2798
2799                 ret = mxt_t6_command(data, MXT_COMMAND_RESET,
2800                                      MXT_BOOT_VALUE, false);
2801                 if (ret)
2802                         goto release_firmware;
2803
2804                 msleep(MXT_RESET_TIME);
2805
2806                 /* Do not need to scan since we know family ID */
2807                 ret = mxt_lookup_bootloader_address(data, 0);
2808                 if (ret)
2809                         goto release_firmware;
2810
2811                 mxt_free_input_device(data);
2812                 mxt_free_object_table(data);
2813         } else {
2814                 enable_irq(data->irq);
2815         }
2816
2817         reinit_completion(&data->bl_completion);
2818
2819         ret = mxt_check_bootloader(data, MXT_WAITING_BOOTLOAD_CMD, false);
2820         if (ret) {
2821                 /* Bootloader may still be unlocked from previous attempt */
2822                 ret = mxt_check_bootloader(data, MXT_WAITING_FRAME_DATA, false);
2823                 if (ret)
2824                         goto disable_irq;
2825         } else {
2826                 dev_info(dev, "Unlocking bootloader\n");
2827
2828                 /* Unlock bootloader */
2829                 ret = mxt_send_bootloader_cmd(data, true);
2830                 if (ret)
2831                         goto disable_irq;
2832         }
2833
2834         while (pos < fw->size) {
2835                 ret = mxt_check_bootloader(data, MXT_WAITING_FRAME_DATA, true);
2836                 if (ret)
2837                         goto disable_irq;
2838
2839                 frame_size = ((*(fw->data + pos) << 8) | *(fw->data + pos + 1));
2840
2841                 /* Take account of CRC bytes */
2842                 frame_size += 2;
2843
2844                 /* Write one frame to device */
2845                 ret = mxt_bootloader_write(data, fw->data + pos, frame_size);
2846                 if (ret)
2847                         goto disable_irq;
2848
2849                 ret = mxt_check_bootloader(data, MXT_FRAME_CRC_PASS, true);
2850                 if (ret) {
2851                         retry++;
2852
2853                         /* Back off by 20ms per retry */
2854                         msleep(retry * 20);
2855
2856                         if (retry > 20) {
2857                                 dev_err(dev, "Retry count exceeded\n");
2858                                 goto disable_irq;
2859                         }
2860                 } else {
2861                         retry = 0;
2862                         pos += frame_size;
2863                         frame++;
2864                 }
2865
2866                 if (frame % 50 == 0)
2867                         dev_dbg(dev, "Sent %d frames, %d/%zd bytes\n",
2868                                 frame, pos, fw->size);
2869         }
2870
2871         /* Wait for flash. */
2872         ret = mxt_wait_for_completion(data, &data->bl_completion,
2873                                       MXT_FW_RESET_TIME);
2874         if (ret)
2875                 goto disable_irq;
2876
2877         dev_dbg(dev, "Sent %d frames, %d bytes\n", frame, pos);
2878
2879         /*
2880          * Wait for device to reset. Some bootloader versions do not assert
2881          * the CHG line after bootloading has finished, so ignore potential
2882          * errors.
2883          */
2884         mxt_wait_for_completion(data, &data->bl_completion, MXT_FW_RESET_TIME);
2885
2886         data->in_bootloader = false;
2887
2888 disable_irq:
2889         disable_irq(data->irq);
2890 release_firmware:
2891         release_firmware(fw);
2892         return ret;
2893 }
2894
2895 static ssize_t mxt_update_fw_store(struct device *dev,
2896                                         struct device_attribute *attr,
2897                                         const char *buf, size_t count)
2898 {
2899         struct mxt_data *data = dev_get_drvdata(dev);
2900         int error;
2901
2902         error = mxt_load_fw(dev, MXT_FW_NAME);
2903         if (error) {
2904                 dev_err(dev, "The firmware update failed(%d)\n", error);
2905                 count = error;
2906         } else {
2907                 dev_info(dev, "The firmware update succeeded\n");
2908
2909                 error = mxt_initialize(data);
2910                 if (error)
2911                         return error;
2912         }
2913
2914         return count;
2915 }
2916
2917 static DEVICE_ATTR(fw_version, S_IRUGO, mxt_fw_version_show, NULL);
2918 static DEVICE_ATTR(hw_version, S_IRUGO, mxt_hw_version_show, NULL);
2919 static DEVICE_ATTR(object, S_IRUGO, mxt_object_show, NULL);
2920 static DEVICE_ATTR(update_fw, S_IWUSR, NULL, mxt_update_fw_store);
2921
2922 static struct attribute *mxt_attrs[] = {
2923         &dev_attr_fw_version.attr,
2924         &dev_attr_hw_version.attr,
2925         &dev_attr_object.attr,
2926         &dev_attr_update_fw.attr,
2927         NULL
2928 };
2929
2930 static const struct attribute_group mxt_attr_group = {
2931         .attrs = mxt_attrs,
2932 };
2933
2934 static void mxt_start(struct mxt_data *data)
2935 {
2936         switch (data->suspend_mode) {
2937         case MXT_SUSPEND_T9_CTRL:
2938                 mxt_soft_reset(data);
2939
2940                 /* Touch enable */
2941                 /* 0x83 = SCANEN | RPTEN | ENABLE */
2942                 mxt_write_object(data,
2943                                 MXT_TOUCH_MULTI_T9, MXT_T9_CTRL, 0x83);
2944                 break;
2945
2946         case MXT_SUSPEND_DEEP_SLEEP:
2947         default:
2948                 mxt_set_t7_power_cfg(data, MXT_POWER_CFG_RUN);
2949
2950                 /* Recalibrate since chip has been in deep sleep */
2951                 mxt_t6_command(data, MXT_COMMAND_CALIBRATE, 1, false);
2952                 break;
2953         }
2954 }
2955
2956 static void mxt_stop(struct mxt_data *data)
2957 {
2958         switch (data->suspend_mode) {
2959         case MXT_SUSPEND_T9_CTRL:
2960                 /* Touch disable */
2961                 mxt_write_object(data,
2962                                 MXT_TOUCH_MULTI_T9, MXT_T9_CTRL, 0);
2963                 break;
2964
2965         case MXT_SUSPEND_DEEP_SLEEP:
2966         default:
2967                 mxt_set_t7_power_cfg(data, MXT_POWER_CFG_DEEPSLEEP);
2968                 break;
2969         }
2970 }
2971
2972 static int mxt_input_open(struct input_dev *dev)
2973 {
2974         struct mxt_data *data = input_get_drvdata(dev);
2975
2976         mxt_start(data);
2977
2978         return 0;
2979 }
2980
2981 static void mxt_input_close(struct input_dev *dev)
2982 {
2983         struct mxt_data *data = input_get_drvdata(dev);
2984
2985         mxt_stop(data);
2986 }
2987
2988 static int mxt_parse_device_properties(struct mxt_data *data)
2989 {
2990         static const char keymap_property[] = "linux,gpio-keymap";
2991         struct device *dev = &data->client->dev;
2992         u32 *keymap;
2993         int n_keys;
2994         int error;
2995
2996         if (device_property_present(dev, keymap_property)) {
2997                 n_keys = device_property_read_u32_array(dev, keymap_property,
2998                                                         NULL, 0);
2999                 if (n_keys <= 0) {
3000                         error = n_keys < 0 ? n_keys : -EINVAL;
3001                         dev_err(dev, "invalid/malformed '%s' property: %d\n",
3002                                 keymap_property, error);
3003                         return error;
3004                 }
3005
3006                 keymap = devm_kmalloc_array(dev, n_keys, sizeof(*keymap),
3007                                             GFP_KERNEL);
3008                 if (!keymap)
3009                         return -ENOMEM;
3010
3011                 error = device_property_read_u32_array(dev, keymap_property,
3012                                                        keymap, n_keys);
3013                 if (error) {
3014                         dev_err(dev, "failed to parse '%s' property: %d\n",
3015                                 keymap_property, error);
3016                         return error;
3017                 }
3018
3019                 data->t19_keymap = keymap;
3020                 data->t19_num_keys = n_keys;
3021         }
3022
3023         return 0;
3024 }
3025
3026 static const struct dmi_system_id chromebook_T9_suspend_dmi[] = {
3027         {
3028                 .matches = {
3029                         DMI_MATCH(DMI_SYS_VENDOR, "GOOGLE"),
3030                         DMI_MATCH(DMI_PRODUCT_NAME, "Link"),
3031                 },
3032         },
3033         {
3034                 .matches = {
3035                         DMI_MATCH(DMI_PRODUCT_NAME, "Peppy"),
3036                 },
3037         },
3038         { }
3039 };
3040
3041 static int mxt_probe(struct i2c_client *client, const struct i2c_device_id *id)
3042 {
3043         struct mxt_data *data;
3044         int error;
3045
3046         /*
3047          * Ignore devices that do not have device properties attached to
3048          * them, as we need help determining whether we are dealing with
3049          * touch screen or touchpad.
3050          *
3051          * So far on x86 the only users of Atmel touch controllers are
3052          * Chromebooks, and chromeos_laptop driver will ensure that
3053          * necessary properties are provided (if firmware does not do that).
3054          */
3055         if (!device_property_present(&client->dev, "compatible"))
3056                 return -ENXIO;
3057
3058         /*
3059          * Ignore ACPI devices representing bootloader mode.
3060          *
3061          * This is a bit of a hack: Google Chromebook BIOS creates ACPI
3062          * devices for both application and bootloader modes, but we are
3063          * interested in application mode only (if device is in bootloader
3064          * mode we'll end up switching into application anyway). So far
3065          * application mode addresses were all above 0x40, so we'll use it
3066          * as a threshold.
3067          */
3068         if (ACPI_COMPANION(&client->dev) && client->addr < 0x40)
3069                 return -ENXIO;
3070
3071         data = devm_kzalloc(&client->dev, sizeof(struct mxt_data), GFP_KERNEL);
3072         if (!data)
3073                 return -ENOMEM;
3074
3075         snprintf(data->phys, sizeof(data->phys), "i2c-%u-%04x/input0",
3076                  client->adapter->nr, client->addr);
3077
3078         data->client = client;
3079         data->irq = client->irq;
3080         i2c_set_clientdata(client, data);
3081
3082         init_completion(&data->bl_completion);
3083         init_completion(&data->reset_completion);
3084         init_completion(&data->crc_completion);
3085
3086         data->suspend_mode = dmi_check_system(chromebook_T9_suspend_dmi) ?
3087                 MXT_SUSPEND_T9_CTRL : MXT_SUSPEND_DEEP_SLEEP;
3088
3089         error = mxt_parse_device_properties(data);
3090         if (error)
3091                 return error;
3092
3093         data->reset_gpio = devm_gpiod_get_optional(&client->dev,
3094                                                    "reset", GPIOD_OUT_LOW);
3095         if (IS_ERR(data->reset_gpio)) {
3096                 error = PTR_ERR(data->reset_gpio);
3097                 dev_err(&client->dev, "Failed to get reset gpio: %d\n", error);
3098                 return error;
3099         }
3100
3101         error = devm_request_threaded_irq(&client->dev, client->irq,
3102                                           NULL, mxt_interrupt, IRQF_ONESHOT,
3103                                           client->name, data);
3104         if (error) {
3105                 dev_err(&client->dev, "Failed to register interrupt\n");
3106                 return error;
3107         }
3108
3109         disable_irq(client->irq);
3110
3111         if (data->reset_gpio) {
3112                 msleep(MXT_RESET_GPIO_TIME);
3113                 gpiod_set_value(data->reset_gpio, 1);
3114                 msleep(MXT_RESET_INVALID_CHG);
3115         }
3116
3117         error = mxt_initialize(data);
3118         if (error)
3119                 return error;
3120
3121         error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group);
3122         if (error) {
3123                 dev_err(&client->dev, "Failure %d creating sysfs group\n",
3124                         error);
3125                 goto err_free_object;
3126         }
3127
3128         return 0;
3129
3130 err_free_object:
3131         mxt_free_input_device(data);
3132         mxt_free_object_table(data);
3133         return error;
3134 }
3135
3136 static int mxt_remove(struct i2c_client *client)
3137 {
3138         struct mxt_data *data = i2c_get_clientdata(client);
3139
3140         disable_irq(data->irq);
3141         sysfs_remove_group(&client->dev.kobj, &mxt_attr_group);
3142         mxt_free_input_device(data);
3143         mxt_free_object_table(data);
3144
3145         return 0;
3146 }
3147
3148 static int __maybe_unused mxt_suspend(struct device *dev)
3149 {
3150         struct i2c_client *client = to_i2c_client(dev);
3151         struct mxt_data *data = i2c_get_clientdata(client);
3152         struct input_dev *input_dev = data->input_dev;
3153
3154         if (!input_dev)
3155                 return 0;
3156
3157         mutex_lock(&input_dev->mutex);
3158
3159         if (input_dev->users)
3160                 mxt_stop(data);
3161
3162         mutex_unlock(&input_dev->mutex);
3163
3164         return 0;
3165 }
3166
3167 static int __maybe_unused mxt_resume(struct device *dev)
3168 {
3169         struct i2c_client *client = to_i2c_client(dev);
3170         struct mxt_data *data = i2c_get_clientdata(client);
3171         struct input_dev *input_dev = data->input_dev;
3172
3173         if (!input_dev)
3174                 return 0;
3175
3176         mutex_lock(&input_dev->mutex);
3177
3178         if (input_dev->users)
3179                 mxt_start(data);
3180
3181         mutex_unlock(&input_dev->mutex);
3182
3183         return 0;
3184 }
3185
3186 static SIMPLE_DEV_PM_OPS(mxt_pm_ops, mxt_suspend, mxt_resume);
3187
3188 static const struct of_device_id mxt_of_match[] = {
3189         { .compatible = "atmel,maxtouch", },
3190         /* Compatibles listed below are deprecated */
3191         { .compatible = "atmel,qt602240_ts", },
3192         { .compatible = "atmel,atmel_mxt_ts", },
3193         { .compatible = "atmel,atmel_mxt_tp", },
3194         { .compatible = "atmel,mXT224", },
3195         {},
3196 };
3197 MODULE_DEVICE_TABLE(of, mxt_of_match);
3198
3199 #ifdef CONFIG_ACPI
3200 static const struct acpi_device_id mxt_acpi_id[] = {
3201         { "ATML0000", 0 },      /* Touchpad */
3202         { "ATML0001", 0 },      /* Touchscreen */
3203         { }
3204 };
3205 MODULE_DEVICE_TABLE(acpi, mxt_acpi_id);
3206 #endif
3207
3208 static const struct i2c_device_id mxt_id[] = {
3209         { "qt602240_ts", 0 },
3210         { "atmel_mxt_ts", 0 },
3211         { "atmel_mxt_tp", 0 },
3212         { "maxtouch", 0 },
3213         { "mXT224", 0 },
3214         { }
3215 };
3216 MODULE_DEVICE_TABLE(i2c, mxt_id);
3217
3218 static struct i2c_driver mxt_driver = {
3219         .driver = {
3220                 .name   = "atmel_mxt_ts",
3221                 .of_match_table = mxt_of_match,
3222                 .acpi_match_table = ACPI_PTR(mxt_acpi_id),
3223                 .pm     = &mxt_pm_ops,
3224         },
3225         .probe          = mxt_probe,
3226         .remove         = mxt_remove,
3227         .id_table       = mxt_id,
3228 };
3229
3230 module_i2c_driver(mxt_driver);
3231
3232 /* Module information */
3233 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
3234 MODULE_DESCRIPTION("Atmel maXTouch Touchscreen driver");
3235 MODULE_LICENSE("GPL");