Input: atmel_mxt_ts - return errors from i2c layer
[firefly-linux-kernel-4.4.55.git] / drivers / input / touchscreen / atmel_mxt_ts.c
1 /*
2  * Atmel maXTouch Touchscreen driver
3  *
4  * Copyright (C) 2010 Samsung Electronics Co.Ltd
5  * Author: Joonyoung Shim <jy0922.shim@samsung.com>
6  *
7  * This program is free software; you can redistribute  it and/or modify it
8  * under  the terms of  the GNU General  Public License as published by the
9  * Free Software Foundation;  either version 2 of the  License, or (at your
10  * option) any later version.
11  *
12  */
13
14 #include <linux/module.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
17 #include <linux/firmware.h>
18 #include <linux/i2c.h>
19 #include <linux/i2c/atmel_mxt_ts.h>
20 #include <linux/input/mt.h>
21 #include <linux/interrupt.h>
22 #include <linux/slab.h>
23
24 /* Version */
25 #define MXT_VER_20              20
26 #define MXT_VER_21              21
27 #define MXT_VER_22              22
28
29 /* Slave addresses */
30 #define MXT_APP_LOW             0x4a
31 #define MXT_APP_HIGH            0x4b
32 #define MXT_BOOT_LOW            0x24
33 #define MXT_BOOT_HIGH           0x25
34
35 /* Firmware */
36 #define MXT_FW_NAME             "maxtouch.fw"
37
38 /* Registers */
39 #define MXT_FAMILY_ID           0x00
40 #define MXT_VARIANT_ID          0x01
41 #define MXT_VERSION             0x02
42 #define MXT_BUILD               0x03
43 #define MXT_MATRIX_X_SIZE       0x04
44 #define MXT_MATRIX_Y_SIZE       0x05
45 #define MXT_OBJECT_NUM          0x06
46 #define MXT_OBJECT_START        0x07
47
48 #define MXT_OBJECT_SIZE         6
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
79 /* MXT_GEN_COMMAND_T6 field */
80 #define MXT_COMMAND_RESET       0
81 #define MXT_COMMAND_BACKUPNV    1
82 #define MXT_COMMAND_CALIBRATE   2
83 #define MXT_COMMAND_REPORTALL   3
84 #define MXT_COMMAND_DIAGNOSTIC  5
85
86 /* MXT_GEN_POWER_T7 field */
87 #define MXT_POWER_IDLEACQINT    0
88 #define MXT_POWER_ACTVACQINT    1
89 #define MXT_POWER_ACTV2IDLETO   2
90
91 /* MXT_GEN_ACQUIRE_T8 field */
92 #define MXT_ACQUIRE_CHRGTIME    0
93 #define MXT_ACQUIRE_TCHDRIFT    2
94 #define MXT_ACQUIRE_DRIFTST     3
95 #define MXT_ACQUIRE_TCHAUTOCAL  4
96 #define MXT_ACQUIRE_SYNC        5
97 #define MXT_ACQUIRE_ATCHCALST   6
98 #define MXT_ACQUIRE_ATCHCALSTHR 7
99
100 /* MXT_TOUCH_MULTI_T9 field */
101 #define MXT_TOUCH_CTRL          0
102 #define MXT_TOUCH_XORIGIN       1
103 #define MXT_TOUCH_YORIGIN       2
104 #define MXT_TOUCH_XSIZE         3
105 #define MXT_TOUCH_YSIZE         4
106 #define MXT_TOUCH_BLEN          6
107 #define MXT_TOUCH_TCHTHR        7
108 #define MXT_TOUCH_TCHDI         8
109 #define MXT_TOUCH_ORIENT        9
110 #define MXT_TOUCH_MOVHYSTI      11
111 #define MXT_TOUCH_MOVHYSTN      12
112 #define MXT_TOUCH_NUMTOUCH      14
113 #define MXT_TOUCH_MRGHYST       15
114 #define MXT_TOUCH_MRGTHR        16
115 #define MXT_TOUCH_AMPHYST       17
116 #define MXT_TOUCH_XRANGE_LSB    18
117 #define MXT_TOUCH_XRANGE_MSB    19
118 #define MXT_TOUCH_YRANGE_LSB    20
119 #define MXT_TOUCH_YRANGE_MSB    21
120 #define MXT_TOUCH_XLOCLIP       22
121 #define MXT_TOUCH_XHICLIP       23
122 #define MXT_TOUCH_YLOCLIP       24
123 #define MXT_TOUCH_YHICLIP       25
124 #define MXT_TOUCH_XEDGECTRL     26
125 #define MXT_TOUCH_XEDGEDIST     27
126 #define MXT_TOUCH_YEDGECTRL     28
127 #define MXT_TOUCH_YEDGEDIST     29
128 #define MXT_TOUCH_JUMPLIMIT     30
129
130 /* MXT_PROCI_GRIPFACE_T20 field */
131 #define MXT_GRIPFACE_CTRL       0
132 #define MXT_GRIPFACE_XLOGRIP    1
133 #define MXT_GRIPFACE_XHIGRIP    2
134 #define MXT_GRIPFACE_YLOGRIP    3
135 #define MXT_GRIPFACE_YHIGRIP    4
136 #define MXT_GRIPFACE_MAXTCHS    5
137 #define MXT_GRIPFACE_SZTHR1     7
138 #define MXT_GRIPFACE_SZTHR2     8
139 #define MXT_GRIPFACE_SHPTHR1    9
140 #define MXT_GRIPFACE_SHPTHR2    10
141 #define MXT_GRIPFACE_SUPEXTTO   11
142
143 /* MXT_PROCI_NOISE field */
144 #define MXT_NOISE_CTRL          0
145 #define MXT_NOISE_OUTFLEN       1
146 #define MXT_NOISE_GCAFUL_LSB    3
147 #define MXT_NOISE_GCAFUL_MSB    4
148 #define MXT_NOISE_GCAFLL_LSB    5
149 #define MXT_NOISE_GCAFLL_MSB    6
150 #define MXT_NOISE_ACTVGCAFVALID 7
151 #define MXT_NOISE_NOISETHR      8
152 #define MXT_NOISE_FREQHOPSCALE  10
153 #define MXT_NOISE_FREQ0         11
154 #define MXT_NOISE_FREQ1         12
155 #define MXT_NOISE_FREQ2         13
156 #define MXT_NOISE_FREQ3         14
157 #define MXT_NOISE_FREQ4         15
158 #define MXT_NOISE_IDLEGCAFVALID 16
159
160 /* MXT_SPT_COMMSCONFIG_T18 */
161 #define MXT_COMMS_CTRL          0
162 #define MXT_COMMS_CMD           1
163
164 /* MXT_SPT_CTECONFIG_T28 field */
165 #define MXT_CTE_CTRL            0
166 #define MXT_CTE_CMD             1
167 #define MXT_CTE_MODE            2
168 #define MXT_CTE_IDLEGCAFDEPTH   3
169 #define MXT_CTE_ACTVGCAFDEPTH   4
170 #define MXT_CTE_VOLTAGE         5
171
172 #define MXT_VOLTAGE_DEFAULT     2700000
173 #define MXT_VOLTAGE_STEP        10000
174
175 /* Define for MXT_GEN_COMMAND_T6 */
176 #define MXT_BOOT_VALUE          0xa5
177 #define MXT_BACKUP_VALUE        0x55
178 #define MXT_BACKUP_TIME         25      /* msec */
179 #define MXT_RESET_TIME          65      /* msec */
180
181 #define MXT_FWRESET_TIME        175     /* msec */
182
183 /* Command to unlock bootloader */
184 #define MXT_UNLOCK_CMD_MSB      0xaa
185 #define MXT_UNLOCK_CMD_LSB      0xdc
186
187 /* Bootloader mode status */
188 #define MXT_WAITING_BOOTLOAD_CMD        0xc0    /* valid 7 6 bit only */
189 #define MXT_WAITING_FRAME_DATA  0x80    /* valid 7 6 bit only */
190 #define MXT_FRAME_CRC_CHECK     0x02
191 #define MXT_FRAME_CRC_FAIL      0x03
192 #define MXT_FRAME_CRC_PASS      0x04
193 #define MXT_APP_CRC_FAIL        0x40    /* valid 7 8 bit only */
194 #define MXT_BOOT_STATUS_MASK    0x3f
195
196 /* Touch status */
197 #define MXT_SUPPRESS            (1 << 1)
198 #define MXT_AMP                 (1 << 2)
199 #define MXT_VECTOR              (1 << 3)
200 #define MXT_MOVE                (1 << 4)
201 #define MXT_RELEASE             (1 << 5)
202 #define MXT_PRESS               (1 << 6)
203 #define MXT_DETECT              (1 << 7)
204
205 /* Touch orient bits */
206 #define MXT_XY_SWITCH           (1 << 0)
207 #define MXT_X_INVERT            (1 << 1)
208 #define MXT_Y_INVERT            (1 << 2)
209
210 /* Touchscreen absolute values */
211 #define MXT_MAX_AREA            0xff
212
213 #define MXT_MAX_FINGER          10
214
215 struct mxt_info {
216         u8 family_id;
217         u8 variant_id;
218         u8 version;
219         u8 build;
220         u8 matrix_xsize;
221         u8 matrix_ysize;
222         u8 object_num;
223 };
224
225 struct mxt_object {
226         u8 type;
227         u16 start_address;
228         u8 size;
229         u8 instances;
230         u8 num_report_ids;
231
232         /* to map object and message */
233         u8 max_reportid;
234 };
235
236 struct mxt_message {
237         u8 reportid;
238         u8 message[7];
239 };
240
241 struct mxt_finger {
242         int status;
243         int x;
244         int y;
245         int area;
246         int pressure;
247 };
248
249 /* Each client has this additional data */
250 struct mxt_data {
251         struct i2c_client *client;
252         struct input_dev *input_dev;
253         char phys[64];          /* device physical location */
254         const struct mxt_platform_data *pdata;
255         struct mxt_object *object_table;
256         struct mxt_info info;
257         struct mxt_finger finger[MXT_MAX_FINGER];
258         unsigned int irq;
259         unsigned int max_x;
260         unsigned int max_y;
261 };
262
263 static bool mxt_object_readable(unsigned int type)
264 {
265         switch (type) {
266         case MXT_GEN_COMMAND_T6:
267         case MXT_GEN_POWER_T7:
268         case MXT_GEN_ACQUIRE_T8:
269         case MXT_GEN_DATASOURCE_T53:
270         case MXT_TOUCH_MULTI_T9:
271         case MXT_TOUCH_KEYARRAY_T15:
272         case MXT_TOUCH_PROXIMITY_T23:
273         case MXT_TOUCH_PROXKEY_T52:
274         case MXT_PROCI_GRIPFACE_T20:
275         case MXT_PROCG_NOISE_T22:
276         case MXT_PROCI_ONETOUCH_T24:
277         case MXT_PROCI_TWOTOUCH_T27:
278         case MXT_PROCI_GRIP_T40:
279         case MXT_PROCI_PALM_T41:
280         case MXT_PROCI_TOUCHSUPPRESSION_T42:
281         case MXT_PROCI_STYLUS_T47:
282         case MXT_PROCG_NOISESUPPRESSION_T48:
283         case MXT_SPT_COMMSCONFIG_T18:
284         case MXT_SPT_GPIOPWM_T19:
285         case MXT_SPT_SELFTEST_T25:
286         case MXT_SPT_CTECONFIG_T28:
287         case MXT_SPT_USERDATA_T38:
288         case MXT_SPT_DIGITIZER_T43:
289         case MXT_SPT_CTECONFIG_T46:
290                 return true;
291         default:
292                 return false;
293         }
294 }
295
296 static bool mxt_object_writable(unsigned int type)
297 {
298         switch (type) {
299         case MXT_GEN_COMMAND_T6:
300         case MXT_GEN_POWER_T7:
301         case MXT_GEN_ACQUIRE_T8:
302         case MXT_TOUCH_MULTI_T9:
303         case MXT_TOUCH_KEYARRAY_T15:
304         case MXT_TOUCH_PROXIMITY_T23:
305         case MXT_TOUCH_PROXKEY_T52:
306         case MXT_PROCI_GRIPFACE_T20:
307         case MXT_PROCG_NOISE_T22:
308         case MXT_PROCI_ONETOUCH_T24:
309         case MXT_PROCI_TWOTOUCH_T27:
310         case MXT_PROCI_GRIP_T40:
311         case MXT_PROCI_PALM_T41:
312         case MXT_PROCI_TOUCHSUPPRESSION_T42:
313         case MXT_PROCI_STYLUS_T47:
314         case MXT_PROCG_NOISESUPPRESSION_T48:
315         case MXT_SPT_COMMSCONFIG_T18:
316         case MXT_SPT_GPIOPWM_T19:
317         case MXT_SPT_SELFTEST_T25:
318         case MXT_SPT_CTECONFIG_T28:
319         case MXT_SPT_DIGITIZER_T43:
320         case MXT_SPT_CTECONFIG_T46:
321                 return true;
322         default:
323                 return false;
324         }
325 }
326
327 static void mxt_dump_message(struct device *dev,
328                              struct mxt_message *message)
329 {
330         dev_dbg(dev, "reportid: %u\tmessage: %02x %02x %02x %02x %02x %02x %02x\n",
331                 message->reportid, message->message[0], message->message[1],
332                 message->message[2], message->message[3], message->message[4],
333                 message->message[5], message->message[6]);
334 }
335
336 static int mxt_check_bootloader(struct i2c_client *client,
337                                      unsigned int state)
338 {
339         u8 val;
340
341 recheck:
342         if (i2c_master_recv(client, &val, 1) != 1) {
343                 dev_err(&client->dev, "%s: i2c recv failed\n", __func__);
344                 return -EIO;
345         }
346
347         switch (state) {
348         case MXT_WAITING_BOOTLOAD_CMD:
349         case MXT_WAITING_FRAME_DATA:
350                 val &= ~MXT_BOOT_STATUS_MASK;
351                 break;
352         case MXT_FRAME_CRC_PASS:
353                 if (val == MXT_FRAME_CRC_CHECK)
354                         goto recheck;
355                 break;
356         default:
357                 return -EINVAL;
358         }
359
360         if (val != state) {
361                 dev_err(&client->dev, "Unvalid bootloader mode state\n");
362                 return -EINVAL;
363         }
364
365         return 0;
366 }
367
368 static int mxt_unlock_bootloader(struct i2c_client *client)
369 {
370         u8 buf[2];
371
372         buf[0] = MXT_UNLOCK_CMD_LSB;
373         buf[1] = MXT_UNLOCK_CMD_MSB;
374
375         if (i2c_master_send(client, buf, 2) != 2) {
376                 dev_err(&client->dev, "%s: i2c send failed\n", __func__);
377                 return -EIO;
378         }
379
380         return 0;
381 }
382
383 static int mxt_fw_write(struct i2c_client *client,
384                              const u8 *data, unsigned int frame_size)
385 {
386         if (i2c_master_send(client, data, frame_size) != frame_size) {
387                 dev_err(&client->dev, "%s: i2c send failed\n", __func__);
388                 return -EIO;
389         }
390
391         return 0;
392 }
393
394 static int __mxt_read_reg(struct i2c_client *client,
395                                u16 reg, u16 len, void *val)
396 {
397         struct i2c_msg xfer[2];
398         u8 buf[2];
399         int ret;
400
401         buf[0] = reg & 0xff;
402         buf[1] = (reg >> 8) & 0xff;
403
404         /* Write register */
405         xfer[0].addr = client->addr;
406         xfer[0].flags = 0;
407         xfer[0].len = 2;
408         xfer[0].buf = buf;
409
410         /* Read data */
411         xfer[1].addr = client->addr;
412         xfer[1].flags = I2C_M_RD;
413         xfer[1].len = len;
414         xfer[1].buf = val;
415
416         ret = i2c_transfer(client->adapter, xfer, 2);
417         if (ret == 2) {
418                 ret = 0;
419         } else {
420                 if (ret >= 0)
421                         ret = -EIO;
422                 dev_err(&client->dev, "%s: i2c transfer failed (%d)\n",
423                         __func__, ret);
424         }
425
426         return ret;
427 }
428
429 static int mxt_read_reg(struct i2c_client *client, u16 reg, u8 *val)
430 {
431         return __mxt_read_reg(client, reg, 1, val);
432 }
433
434 static int mxt_write_reg(struct i2c_client *client, u16 reg, u8 val)
435 {
436         u8 buf[3];
437         int ret;
438
439         buf[0] = reg & 0xff;
440         buf[1] = (reg >> 8) & 0xff;
441         buf[2] = val;
442
443         ret = i2c_master_send(client, buf, 3);
444         if (ret == 3) {
445                 ret = 0;
446         } else {
447                 if (ret >= 0)
448                         ret = -EIO;
449                 dev_err(&client->dev, "%s: i2c send failed (%d)\n",
450                         __func__, ret);
451         }
452
453         return ret;
454 }
455
456 static int mxt_read_object_table(struct i2c_client *client,
457                                       u16 reg, u8 *object_buf)
458 {
459         return __mxt_read_reg(client, reg, MXT_OBJECT_SIZE,
460                                    object_buf);
461 }
462
463 static struct mxt_object *
464 mxt_get_object(struct mxt_data *data, u8 type)
465 {
466         struct mxt_object *object;
467         int i;
468
469         for (i = 0; i < data->info.object_num; i++) {
470                 object = data->object_table + i;
471                 if (object->type == type)
472                         return object;
473         }
474
475         dev_err(&data->client->dev, "Invalid object type\n");
476         return NULL;
477 }
478
479 static int mxt_read_message(struct mxt_data *data,
480                                  struct mxt_message *message)
481 {
482         struct mxt_object *object;
483         u16 reg;
484
485         object = mxt_get_object(data, MXT_GEN_MESSAGE_T5);
486         if (!object)
487                 return -EINVAL;
488
489         reg = object->start_address;
490         return __mxt_read_reg(data->client, reg,
491                         sizeof(struct mxt_message), message);
492 }
493
494 static int mxt_write_object(struct mxt_data *data,
495                                  u8 type, u8 offset, u8 val)
496 {
497         struct mxt_object *object;
498         u16 reg;
499
500         object = mxt_get_object(data, type);
501         if (!object || offset >= object->size + 1)
502                 return -EINVAL;
503
504         reg = object->start_address;
505         return mxt_write_reg(data->client, reg + offset, val);
506 }
507
508 static void mxt_input_report(struct mxt_data *data, int single_id)
509 {
510         struct mxt_finger *finger = data->finger;
511         struct input_dev *input_dev = data->input_dev;
512         int status = finger[single_id].status;
513         int finger_num = 0;
514         int id;
515
516         for (id = 0; id < MXT_MAX_FINGER; id++) {
517                 if (!finger[id].status)
518                         continue;
519
520                 input_mt_slot(input_dev, id);
521                 input_mt_report_slot_state(input_dev, MT_TOOL_FINGER,
522                                 finger[id].status != MXT_RELEASE);
523
524                 if (finger[id].status != MXT_RELEASE) {
525                         finger_num++;
526                         input_report_abs(input_dev, ABS_MT_TOUCH_MAJOR,
527                                         finger[id].area);
528                         input_report_abs(input_dev, ABS_MT_POSITION_X,
529                                         finger[id].x);
530                         input_report_abs(input_dev, ABS_MT_POSITION_Y,
531                                         finger[id].y);
532                         input_report_abs(input_dev, ABS_MT_PRESSURE,
533                                         finger[id].pressure);
534                 } else {
535                         finger[id].status = 0;
536                 }
537         }
538
539         input_report_key(input_dev, BTN_TOUCH, finger_num > 0);
540
541         if (status != MXT_RELEASE) {
542                 input_report_abs(input_dev, ABS_X, finger[single_id].x);
543                 input_report_abs(input_dev, ABS_Y, finger[single_id].y);
544                 input_report_abs(input_dev,
545                                  ABS_PRESSURE, finger[single_id].pressure);
546         }
547
548         input_sync(input_dev);
549 }
550
551 static void mxt_input_touchevent(struct mxt_data *data,
552                                       struct mxt_message *message, int id)
553 {
554         struct mxt_finger *finger = data->finger;
555         struct device *dev = &data->client->dev;
556         u8 status = message->message[0];
557         int x;
558         int y;
559         int area;
560         int pressure;
561
562         /* Check the touch is present on the screen */
563         if (!(status & MXT_DETECT)) {
564                 if (status & MXT_RELEASE) {
565                         dev_dbg(dev, "[%d] released\n", id);
566
567                         finger[id].status = MXT_RELEASE;
568                         mxt_input_report(data, id);
569                 }
570                 return;
571         }
572
573         /* Check only AMP detection */
574         if (!(status & (MXT_PRESS | MXT_MOVE)))
575                 return;
576
577         x = (message->message[1] << 4) | ((message->message[3] >> 4) & 0xf);
578         y = (message->message[2] << 4) | ((message->message[3] & 0xf));
579         if (data->max_x < 1024)
580                 x = x >> 2;
581         if (data->max_y < 1024)
582                 y = y >> 2;
583
584         area = message->message[4];
585         pressure = message->message[5];
586
587         dev_dbg(dev, "[%d] %s x: %d, y: %d, area: %d\n", id,
588                 status & MXT_MOVE ? "moved" : "pressed",
589                 x, y, area);
590
591         finger[id].status = status & MXT_MOVE ?
592                                 MXT_MOVE : MXT_PRESS;
593         finger[id].x = x;
594         finger[id].y = y;
595         finger[id].area = area;
596         finger[id].pressure = pressure;
597
598         mxt_input_report(data, id);
599 }
600
601 static irqreturn_t mxt_interrupt(int irq, void *dev_id)
602 {
603         struct mxt_data *data = dev_id;
604         struct mxt_message message;
605         struct mxt_object *object;
606         struct device *dev = &data->client->dev;
607         int id;
608         u8 reportid;
609         u8 max_reportid;
610         u8 min_reportid;
611
612         do {
613                 if (mxt_read_message(data, &message)) {
614                         dev_err(dev, "Failed to read message\n");
615                         goto end;
616                 }
617
618                 reportid = message.reportid;
619
620                 /* whether reportid is thing of MXT_TOUCH_MULTI_T9 */
621                 object = mxt_get_object(data, MXT_TOUCH_MULTI_T9);
622                 if (!object)
623                         goto end;
624
625                 max_reportid = object->max_reportid;
626                 min_reportid = max_reportid - object->num_report_ids + 1;
627                 id = reportid - min_reportid;
628
629                 if (reportid >= min_reportid && reportid <= max_reportid)
630                         mxt_input_touchevent(data, &message, id);
631                 else
632                         mxt_dump_message(dev, &message);
633         } while (reportid != 0xff);
634
635 end:
636         return IRQ_HANDLED;
637 }
638
639 static int mxt_check_reg_init(struct mxt_data *data)
640 {
641         const struct mxt_platform_data *pdata = data->pdata;
642         struct mxt_object *object;
643         struct device *dev = &data->client->dev;
644         int index = 0;
645         int i, j, config_offset;
646
647         if (!pdata->config) {
648                 dev_dbg(dev, "No cfg data defined, skipping reg init\n");
649                 return 0;
650         }
651
652         for (i = 0; i < data->info.object_num; i++) {
653                 object = data->object_table + i;
654
655                 if (!mxt_object_writable(object->type))
656                         continue;
657
658                 for (j = 0;
659                      j < (object->size + 1) * (object->instances + 1);
660                      j++) {
661                         config_offset = index + j;
662                         if (config_offset > pdata->config_length) {
663                                 dev_err(dev, "Not enough config data!\n");
664                                 return -EINVAL;
665                         }
666                         mxt_write_object(data, object->type, j,
667                                          pdata->config[config_offset]);
668                 }
669                 index += (object->size + 1) * (object->instances + 1);
670         }
671
672         return 0;
673 }
674
675 static int mxt_make_highchg(struct mxt_data *data)
676 {
677         struct device *dev = &data->client->dev;
678         struct mxt_message message;
679         int count = 10;
680         int error;
681
682         /* Read dummy message to make high CHG pin */
683         do {
684                 error = mxt_read_message(data, &message);
685                 if (error)
686                         return error;
687         } while (message.reportid != 0xff && --count);
688
689         if (!count) {
690                 dev_err(dev, "CHG pin isn't cleared\n");
691                 return -EBUSY;
692         }
693
694         return 0;
695 }
696
697 static void mxt_handle_pdata(struct mxt_data *data)
698 {
699         const struct mxt_platform_data *pdata = data->pdata;
700         u8 voltage;
701
702         /* Set touchscreen lines */
703         mxt_write_object(data, MXT_TOUCH_MULTI_T9, MXT_TOUCH_XSIZE,
704                         pdata->x_line);
705         mxt_write_object(data, MXT_TOUCH_MULTI_T9, MXT_TOUCH_YSIZE,
706                         pdata->y_line);
707
708         /* Set touchscreen orient */
709         mxt_write_object(data, MXT_TOUCH_MULTI_T9, MXT_TOUCH_ORIENT,
710                         pdata->orient);
711
712         /* Set touchscreen burst length */
713         mxt_write_object(data, MXT_TOUCH_MULTI_T9,
714                         MXT_TOUCH_BLEN, pdata->blen);
715
716         /* Set touchscreen threshold */
717         mxt_write_object(data, MXT_TOUCH_MULTI_T9,
718                         MXT_TOUCH_TCHTHR, pdata->threshold);
719
720         /* Set touchscreen resolution */
721         mxt_write_object(data, MXT_TOUCH_MULTI_T9,
722                         MXT_TOUCH_XRANGE_LSB, (pdata->x_size - 1) & 0xff);
723         mxt_write_object(data, MXT_TOUCH_MULTI_T9,
724                         MXT_TOUCH_XRANGE_MSB, (pdata->x_size - 1) >> 8);
725         mxt_write_object(data, MXT_TOUCH_MULTI_T9,
726                         MXT_TOUCH_YRANGE_LSB, (pdata->y_size - 1) & 0xff);
727         mxt_write_object(data, MXT_TOUCH_MULTI_T9,
728                         MXT_TOUCH_YRANGE_MSB, (pdata->y_size - 1) >> 8);
729
730         /* Set touchscreen voltage */
731         if (pdata->voltage) {
732                 if (pdata->voltage < MXT_VOLTAGE_DEFAULT) {
733                         voltage = (MXT_VOLTAGE_DEFAULT - pdata->voltage) /
734                                 MXT_VOLTAGE_STEP;
735                         voltage = 0xff - voltage + 1;
736                 } else
737                         voltage = (pdata->voltage - MXT_VOLTAGE_DEFAULT) /
738                                 MXT_VOLTAGE_STEP;
739
740                 mxt_write_object(data, MXT_SPT_CTECONFIG_T28,
741                                 MXT_CTE_VOLTAGE, voltage);
742         }
743 }
744
745 static int mxt_get_info(struct mxt_data *data)
746 {
747         struct i2c_client *client = data->client;
748         struct mxt_info *info = &data->info;
749         int error;
750         u8 val;
751
752         error = mxt_read_reg(client, MXT_FAMILY_ID, &val);
753         if (error)
754                 return error;
755         info->family_id = val;
756
757         error = mxt_read_reg(client, MXT_VARIANT_ID, &val);
758         if (error)
759                 return error;
760         info->variant_id = val;
761
762         error = mxt_read_reg(client, MXT_VERSION, &val);
763         if (error)
764                 return error;
765         info->version = val;
766
767         error = mxt_read_reg(client, MXT_BUILD, &val);
768         if (error)
769                 return error;
770         info->build = val;
771
772         error = mxt_read_reg(client, MXT_OBJECT_NUM, &val);
773         if (error)
774                 return error;
775         info->object_num = val;
776
777         return 0;
778 }
779
780 static int mxt_get_object_table(struct mxt_data *data)
781 {
782         int error;
783         int i;
784         u16 reg;
785         u8 reportid = 0;
786         u8 buf[MXT_OBJECT_SIZE];
787
788         for (i = 0; i < data->info.object_num; i++) {
789                 struct mxt_object *object = data->object_table + i;
790
791                 reg = MXT_OBJECT_START + MXT_OBJECT_SIZE * i;
792                 error = mxt_read_object_table(data->client, reg, buf);
793                 if (error)
794                         return error;
795
796                 object->type = buf[0];
797                 object->start_address = (buf[2] << 8) | buf[1];
798                 object->size = buf[3];
799                 object->instances = buf[4];
800                 object->num_report_ids = buf[5];
801
802                 if (object->num_report_ids) {
803                         reportid += object->num_report_ids *
804                                         (object->instances + 1);
805                         object->max_reportid = reportid;
806                 }
807         }
808
809         return 0;
810 }
811
812 static int mxt_initialize(struct mxt_data *data)
813 {
814         struct i2c_client *client = data->client;
815         struct mxt_info *info = &data->info;
816         int error;
817         u8 val;
818
819         error = mxt_get_info(data);
820         if (error)
821                 return error;
822
823         data->object_table = kcalloc(info->object_num,
824                                      sizeof(struct mxt_object),
825                                      GFP_KERNEL);
826         if (!data->object_table) {
827                 dev_err(&client->dev, "Failed to allocate memory\n");
828                 return -ENOMEM;
829         }
830
831         /* Get object table information */
832         error = mxt_get_object_table(data);
833         if (error)
834                 return error;
835
836         /* Check register init values */
837         error = mxt_check_reg_init(data);
838         if (error)
839                 return error;
840
841         mxt_handle_pdata(data);
842
843         /* Backup to memory */
844         mxt_write_object(data, MXT_GEN_COMMAND_T6,
845                         MXT_COMMAND_BACKUPNV,
846                         MXT_BACKUP_VALUE);
847         msleep(MXT_BACKUP_TIME);
848
849         /* Soft reset */
850         mxt_write_object(data, MXT_GEN_COMMAND_T6,
851                         MXT_COMMAND_RESET, 1);
852         msleep(MXT_RESET_TIME);
853
854         /* Update matrix size at info struct */
855         error = mxt_read_reg(client, MXT_MATRIX_X_SIZE, &val);
856         if (error)
857                 return error;
858         info->matrix_xsize = val;
859
860         error = mxt_read_reg(client, MXT_MATRIX_Y_SIZE, &val);
861         if (error)
862                 return error;
863         info->matrix_ysize = val;
864
865         dev_info(&client->dev,
866                         "Family ID: %d Variant ID: %d Version: %d Build: %d\n",
867                         info->family_id, info->variant_id, info->version,
868                         info->build);
869
870         dev_info(&client->dev,
871                         "Matrix X Size: %d Matrix Y Size: %d Object Num: %d\n",
872                         info->matrix_xsize, info->matrix_ysize,
873                         info->object_num);
874
875         return 0;
876 }
877
878 static void mxt_calc_resolution(struct mxt_data *data)
879 {
880         unsigned int max_x = data->pdata->x_size - 1;
881         unsigned int max_y = data->pdata->y_size - 1;
882
883         if (data->pdata->orient & MXT_XY_SWITCH) {
884                 data->max_x = max_y;
885                 data->max_y = max_x;
886         } else {
887                 data->max_x = max_x;
888                 data->max_y = max_y;
889         }
890 }
891
892 static ssize_t mxt_show_instance(char *buf, int count,
893                                  struct mxt_object *object, int instance,
894                                  const u8 *val)
895 {
896         int i;
897
898         if (object->instances > 0)
899                 count += scnprintf(buf + count, PAGE_SIZE - count,
900                                    "Instance %u\n", instance);
901
902         for (i = 0; i < object->size + 1; i++)
903                 count += scnprintf(buf + count, PAGE_SIZE - count,
904                                 "\t[%2u]: %02x (%d)\n", i, val[i], val[i]);
905         count += scnprintf(buf + count, PAGE_SIZE - count, "\n");
906
907         return count;
908 }
909
910 static ssize_t mxt_object_show(struct device *dev,
911                                     struct device_attribute *attr, char *buf)
912 {
913         struct mxt_data *data = dev_get_drvdata(dev);
914         struct mxt_object *object;
915         int count = 0;
916         int i, j;
917         int error;
918         u8 *obuf;
919
920         /* Pre-allocate buffer large enough to hold max sized object. */
921         obuf = kmalloc(256, GFP_KERNEL);
922         if (!obuf)
923                 return -ENOMEM;
924
925         error = 0;
926         for (i = 0; i < data->info.object_num; i++) {
927                 object = data->object_table + i;
928
929                 if (!mxt_object_readable(object->type))
930                         continue;
931
932                 count += scnprintf(buf + count, PAGE_SIZE - count,
933                                 "T%u:\n", object->type);
934
935                 for (j = 0; j < object->instances + 1; j++) {
936                         u16 size = object->size + 1;
937                         u16 addr = object->start_address + j * size;
938
939                         error = __mxt_read_reg(data->client, addr, size, obuf);
940                         if (error)
941                                 goto done;
942
943                         count = mxt_show_instance(buf, count, object, j, obuf);
944                 }
945         }
946
947 done:
948         kfree(obuf);
949         return error ?: count;
950 }
951
952 static int mxt_load_fw(struct device *dev, const char *fn)
953 {
954         struct mxt_data *data = dev_get_drvdata(dev);
955         struct i2c_client *client = data->client;
956         const struct firmware *fw = NULL;
957         unsigned int frame_size;
958         unsigned int pos = 0;
959         int ret;
960
961         ret = request_firmware(&fw, fn, dev);
962         if (ret) {
963                 dev_err(dev, "Unable to open firmware %s\n", fn);
964                 return ret;
965         }
966
967         /* Change to the bootloader mode */
968         mxt_write_object(data, MXT_GEN_COMMAND_T6,
969                         MXT_COMMAND_RESET, MXT_BOOT_VALUE);
970         msleep(MXT_RESET_TIME);
971
972         /* Change to slave address of bootloader */
973         if (client->addr == MXT_APP_LOW)
974                 client->addr = MXT_BOOT_LOW;
975         else
976                 client->addr = MXT_BOOT_HIGH;
977
978         ret = mxt_check_bootloader(client, MXT_WAITING_BOOTLOAD_CMD);
979         if (ret)
980                 goto out;
981
982         /* Unlock bootloader */
983         mxt_unlock_bootloader(client);
984
985         while (pos < fw->size) {
986                 ret = mxt_check_bootloader(client,
987                                                 MXT_WAITING_FRAME_DATA);
988                 if (ret)
989                         goto out;
990
991                 frame_size = ((*(fw->data + pos) << 8) | *(fw->data + pos + 1));
992
993                 /* We should add 2 at frame size as the the firmware data is not
994                  * included the CRC bytes.
995                  */
996                 frame_size += 2;
997
998                 /* Write one frame to device */
999                 mxt_fw_write(client, fw->data + pos, frame_size);
1000
1001                 ret = mxt_check_bootloader(client,
1002                                                 MXT_FRAME_CRC_PASS);
1003                 if (ret)
1004                         goto out;
1005
1006                 pos += frame_size;
1007
1008                 dev_dbg(dev, "Updated %d bytes / %zd bytes\n", pos, fw->size);
1009         }
1010
1011 out:
1012         release_firmware(fw);
1013
1014         /* Change to slave address of application */
1015         if (client->addr == MXT_BOOT_LOW)
1016                 client->addr = MXT_APP_LOW;
1017         else
1018                 client->addr = MXT_APP_HIGH;
1019
1020         return ret;
1021 }
1022
1023 static ssize_t mxt_update_fw_store(struct device *dev,
1024                                         struct device_attribute *attr,
1025                                         const char *buf, size_t count)
1026 {
1027         struct mxt_data *data = dev_get_drvdata(dev);
1028         int error;
1029
1030         disable_irq(data->irq);
1031
1032         error = mxt_load_fw(dev, MXT_FW_NAME);
1033         if (error) {
1034                 dev_err(dev, "The firmware update failed(%d)\n", error);
1035                 count = error;
1036         } else {
1037                 dev_dbg(dev, "The firmware update succeeded\n");
1038
1039                 /* Wait for reset */
1040                 msleep(MXT_FWRESET_TIME);
1041
1042                 kfree(data->object_table);
1043                 data->object_table = NULL;
1044
1045                 mxt_initialize(data);
1046         }
1047
1048         enable_irq(data->irq);
1049
1050         error = mxt_make_highchg(data);
1051         if (error)
1052                 return error;
1053
1054         return count;
1055 }
1056
1057 static DEVICE_ATTR(object, S_IRUGO, mxt_object_show, NULL);
1058 static DEVICE_ATTR(update_fw, S_IWUSR, NULL, mxt_update_fw_store);
1059
1060 static struct attribute *mxt_attrs[] = {
1061         &dev_attr_object.attr,
1062         &dev_attr_update_fw.attr,
1063         NULL
1064 };
1065
1066 static const struct attribute_group mxt_attr_group = {
1067         .attrs = mxt_attrs,
1068 };
1069
1070 static void mxt_start(struct mxt_data *data)
1071 {
1072         /* Touch enable */
1073         mxt_write_object(data,
1074                         MXT_TOUCH_MULTI_T9, MXT_TOUCH_CTRL, 0x83);
1075 }
1076
1077 static void mxt_stop(struct mxt_data *data)
1078 {
1079         /* Touch disable */
1080         mxt_write_object(data,
1081                         MXT_TOUCH_MULTI_T9, MXT_TOUCH_CTRL, 0);
1082 }
1083
1084 static int mxt_input_open(struct input_dev *dev)
1085 {
1086         struct mxt_data *data = input_get_drvdata(dev);
1087
1088         mxt_start(data);
1089
1090         return 0;
1091 }
1092
1093 static void mxt_input_close(struct input_dev *dev)
1094 {
1095         struct mxt_data *data = input_get_drvdata(dev);
1096
1097         mxt_stop(data);
1098 }
1099
1100 static int __devinit mxt_probe(struct i2c_client *client,
1101                 const struct i2c_device_id *id)
1102 {
1103         const struct mxt_platform_data *pdata = client->dev.platform_data;
1104         struct mxt_data *data;
1105         struct input_dev *input_dev;
1106         int error;
1107
1108         if (!pdata)
1109                 return -EINVAL;
1110
1111         data = kzalloc(sizeof(struct mxt_data), GFP_KERNEL);
1112         input_dev = input_allocate_device();
1113         if (!data || !input_dev) {
1114                 dev_err(&client->dev, "Failed to allocate memory\n");
1115                 error = -ENOMEM;
1116                 goto err_free_mem;
1117         }
1118
1119         input_dev->name = "Atmel maXTouch Touchscreen";
1120         snprintf(data->phys, sizeof(data->phys), "i2c-%u-%04x/input0",
1121                  client->adapter->nr, client->addr);
1122         input_dev->phys = data->phys;
1123
1124         input_dev->id.bustype = BUS_I2C;
1125         input_dev->dev.parent = &client->dev;
1126         input_dev->open = mxt_input_open;
1127         input_dev->close = mxt_input_close;
1128
1129         data->client = client;
1130         data->input_dev = input_dev;
1131         data->pdata = pdata;
1132         data->irq = client->irq;
1133
1134         mxt_calc_resolution(data);
1135
1136         __set_bit(EV_ABS, input_dev->evbit);
1137         __set_bit(EV_KEY, input_dev->evbit);
1138         __set_bit(BTN_TOUCH, input_dev->keybit);
1139
1140         /* For single touch */
1141         input_set_abs_params(input_dev, ABS_X,
1142                              0, data->max_x, 0, 0);
1143         input_set_abs_params(input_dev, ABS_Y,
1144                              0, data->max_y, 0, 0);
1145         input_set_abs_params(input_dev, ABS_PRESSURE,
1146                              0, 255, 0, 0);
1147
1148         /* For multi touch */
1149         error = input_mt_init_slots(input_dev, MXT_MAX_FINGER);
1150         if (error)
1151                 goto err_free_mem;
1152         input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR,
1153                              0, MXT_MAX_AREA, 0, 0);
1154         input_set_abs_params(input_dev, ABS_MT_POSITION_X,
1155                              0, data->max_x, 0, 0);
1156         input_set_abs_params(input_dev, ABS_MT_POSITION_Y,
1157                              0, data->max_y, 0, 0);
1158         input_set_abs_params(input_dev, ABS_MT_PRESSURE,
1159                              0, 255, 0, 0);
1160
1161         input_set_drvdata(input_dev, data);
1162         i2c_set_clientdata(client, data);
1163
1164         error = mxt_initialize(data);
1165         if (error)
1166                 goto err_free_object;
1167
1168         error = request_threaded_irq(client->irq, NULL, mxt_interrupt,
1169                         pdata->irqflags, client->name, data);
1170         if (error) {
1171                 dev_err(&client->dev, "Failed to register interrupt\n");
1172                 goto err_free_object;
1173         }
1174
1175         error = mxt_make_highchg(data);
1176         if (error)
1177                 goto err_free_irq;
1178
1179         error = input_register_device(input_dev);
1180         if (error)
1181                 goto err_free_irq;
1182
1183         error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group);
1184         if (error)
1185                 dev_warn(&client->dev, "error creating sysfs entries.\n");
1186
1187         return 0;
1188
1189 err_free_irq:
1190         free_irq(client->irq, data);
1191 err_free_object:
1192         kfree(data->object_table);
1193 err_free_mem:
1194         input_free_device(input_dev);
1195         kfree(data);
1196         return error;
1197 }
1198
1199 static int __devexit mxt_remove(struct i2c_client *client)
1200 {
1201         struct mxt_data *data = i2c_get_clientdata(client);
1202
1203         sysfs_remove_group(&client->dev.kobj, &mxt_attr_group);
1204         free_irq(data->irq, data);
1205         input_unregister_device(data->input_dev);
1206         kfree(data->object_table);
1207         kfree(data);
1208
1209         return 0;
1210 }
1211
1212 #ifdef CONFIG_PM_SLEEP
1213 static int mxt_suspend(struct device *dev)
1214 {
1215         struct i2c_client *client = to_i2c_client(dev);
1216         struct mxt_data *data = i2c_get_clientdata(client);
1217         struct input_dev *input_dev = data->input_dev;
1218
1219         mutex_lock(&input_dev->mutex);
1220
1221         if (input_dev->users)
1222                 mxt_stop(data);
1223
1224         mutex_unlock(&input_dev->mutex);
1225
1226         return 0;
1227 }
1228
1229 static int mxt_resume(struct device *dev)
1230 {
1231         struct i2c_client *client = to_i2c_client(dev);
1232         struct mxt_data *data = i2c_get_clientdata(client);
1233         struct input_dev *input_dev = data->input_dev;
1234
1235         /* Soft reset */
1236         mxt_write_object(data, MXT_GEN_COMMAND_T6,
1237                         MXT_COMMAND_RESET, 1);
1238
1239         msleep(MXT_RESET_TIME);
1240
1241         mutex_lock(&input_dev->mutex);
1242
1243         if (input_dev->users)
1244                 mxt_start(data);
1245
1246         mutex_unlock(&input_dev->mutex);
1247
1248         return 0;
1249 }
1250 #endif
1251
1252 static SIMPLE_DEV_PM_OPS(mxt_pm_ops, mxt_suspend, mxt_resume);
1253
1254 static const struct i2c_device_id mxt_id[] = {
1255         { "qt602240_ts", 0 },
1256         { "atmel_mxt_ts", 0 },
1257         { "mXT224", 0 },
1258         { }
1259 };
1260 MODULE_DEVICE_TABLE(i2c, mxt_id);
1261
1262 static struct i2c_driver mxt_driver = {
1263         .driver = {
1264                 .name   = "atmel_mxt_ts",
1265                 .owner  = THIS_MODULE,
1266                 .pm     = &mxt_pm_ops,
1267         },
1268         .probe          = mxt_probe,
1269         .remove         = __devexit_p(mxt_remove),
1270         .id_table       = mxt_id,
1271 };
1272
1273 module_i2c_driver(mxt_driver);
1274
1275 /* Module information */
1276 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
1277 MODULE_DESCRIPTION("Atmel maXTouch Touchscreen driver");
1278 MODULE_LICENSE("GPL");