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