projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Input: atmel_mxt_ts - split config update a bit
[deliverable/linux.git] / 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 *
8 * Author: Joonyoung Shim <jy0922.shim@samsung.com>
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
14 *
15 */
16
17 #include <linux/module.h>
18 #include <linux/init.h>
19 #include <linux/completion.h>
20 #include <linux/delay.h>
21 #include <linux/firmware.h>
22 #include <linux/i2c.h>
23 #include <linux/i2c/atmel_mxt_ts.h>
24 #include <linux/input/mt.h>
25 #include <linux/interrupt.h>
26 #include <linux/of.h>
27 #include <linux/slab.h>
28
29 /* Version */
30 #define MXT_VER_20 20
31 #define MXT_VER_21 21
32 #define MXT_VER_22 22
33
34 /* Firmware files */
35 #define MXT_FW_NAME "maxtouch.fw"
36 #define MXT_CFG_NAME "maxtouch.cfg"
37 #define MXT_CFG_MAGIC "OBP_RAW V1"
38
39 /* Registers */
40 #define MXT_INFO 0x00
41 #define MXT_FAMILY_ID 0x00
42 #define MXT_VARIANT_ID 0x01
43 #define MXT_VERSION 0x02
44 #define MXT_BUILD 0x03
45 #define MXT_MATRIX_X_SIZE 0x04
46 #define MXT_MATRIX_Y_SIZE 0x05
47 #define MXT_OBJECT_NUM 0x06
48 #define MXT_OBJECT_START 0x07
49
50 #define MXT_OBJECT_SIZE 6
51 #define MXT_INFO_CHECKSUM_SIZE 3
52 #define MXT_MAX_BLOCK_WRITE 256
53
54 /* Object types */
55 #define MXT_DEBUG_DIAGNOSTIC_T37 37
56 #define MXT_GEN_MESSAGE_T5 5
57 #define MXT_GEN_COMMAND_T6 6
58 #define MXT_GEN_POWER_T7 7
59 #define MXT_GEN_ACQUIRE_T8 8
60 #define MXT_GEN_DATASOURCE_T53 53
61 #define MXT_TOUCH_MULTI_T9 9
62 #define MXT_TOUCH_KEYARRAY_T15 15
63 #define MXT_TOUCH_PROXIMITY_T23 23
64 #define MXT_TOUCH_PROXKEY_T52 52
65 #define MXT_PROCI_GRIPFACE_T20 20
66 #define MXT_PROCG_NOISE_T22 22
67 #define MXT_PROCI_ONETOUCH_T24 24
68 #define MXT_PROCI_TWOTOUCH_T27 27
69 #define MXT_PROCI_GRIP_T40 40
70 #define MXT_PROCI_PALM_T41 41
71 #define MXT_PROCI_TOUCHSUPPRESSION_T42 42
72 #define MXT_PROCI_STYLUS_T47 47
73 #define MXT_PROCG_NOISESUPPRESSION_T48 48
74 #define MXT_SPT_COMMSCONFIG_T18 18
75 #define MXT_SPT_GPIOPWM_T19 19
76 #define MXT_SPT_SELFTEST_T25 25
77 #define MXT_SPT_CTECONFIG_T28 28
78 #define MXT_SPT_USERDATA_T38 38
79 #define MXT_SPT_DIGITIZER_T43 43
80 #define MXT_SPT_MESSAGECOUNT_T44 44
81 #define MXT_SPT_CTECONFIG_T46 46
82
83 /* MXT_GEN_MESSAGE_T5 object */
84 #define MXT_RPTID_NOMSG 0xff
85
86 /* MXT_GEN_COMMAND_T6 field */
87 #define MXT_COMMAND_RESET 0
88 #define MXT_COMMAND_BACKUPNV 1
89 #define MXT_COMMAND_CALIBRATE 2
90 #define MXT_COMMAND_REPORTALL 3
91 #define MXT_COMMAND_DIAGNOSTIC 5
92
93 /* Define for T6 status byte */
94 #define MXT_T6_STATUS_RESET (1 << 7)
95 #define MXT_T6_STATUS_OFL (1 << 6)
96 #define MXT_T6_STATUS_SIGERR (1 << 5)
97 #define MXT_T6_STATUS_CAL (1 << 4)
98 #define MXT_T6_STATUS_CFGERR (1 << 3)
99 #define MXT_T6_STATUS_COMSERR (1 << 2)
100
101 /* MXT_GEN_POWER_T7 field */
102 struct t7_config {
103 u8 idle;
104 u8 active;
105 } __packed;
106
107 #define MXT_POWER_CFG_RUN 0
108 #define MXT_POWER_CFG_DEEPSLEEP 1
109
110 /* MXT_GEN_ACQUIRE_T8 field */
111 #define MXT_ACQUIRE_CHRGTIME 0
112 #define MXT_ACQUIRE_TCHDRIFT 2
113 #define MXT_ACQUIRE_DRIFTST 3
114 #define MXT_ACQUIRE_TCHAUTOCAL 4
115 #define MXT_ACQUIRE_SYNC 5
116 #define MXT_ACQUIRE_ATCHCALST 6
117 #define MXT_ACQUIRE_ATCHCALSTHR 7
118
119 /* MXT_TOUCH_MULTI_T9 field */
120 #define MXT_T9_ORIENT 9
121 #define MXT_T9_RANGE 18
122
123 /* MXT_TOUCH_MULTI_T9 status */
124 #define MXT_T9_UNGRIP (1 << 0)
125 #define MXT_T9_SUPPRESS (1 << 1)
126 #define MXT_T9_AMP (1 << 2)
127 #define MXT_T9_VECTOR (1 << 3)
128 #define MXT_T9_MOVE (1 << 4)
129 #define MXT_T9_RELEASE (1 << 5)
130 #define MXT_T9_PRESS (1 << 6)
131 #define MXT_T9_DETECT (1 << 7)
132
133 struct t9_range {
134 u16 x;
135 u16 y;
136 } __packed;
137
138 /* MXT_TOUCH_MULTI_T9 orient */
139 #define MXT_T9_ORIENT_SWITCH (1 << 0)
140
141 /* MXT_PROCI_GRIPFACE_T20 field */
142 #define MXT_GRIPFACE_CTRL 0
143 #define MXT_GRIPFACE_XLOGRIP 1
144 #define MXT_GRIPFACE_XHIGRIP 2
145 #define MXT_GRIPFACE_YLOGRIP 3
146 #define MXT_GRIPFACE_YHIGRIP 4
147 #define MXT_GRIPFACE_MAXTCHS 5
148 #define MXT_GRIPFACE_SZTHR1 7
149 #define MXT_GRIPFACE_SZTHR2 8
150 #define MXT_GRIPFACE_SHPTHR1 9
151 #define MXT_GRIPFACE_SHPTHR2 10
152 #define MXT_GRIPFACE_SUPEXTTO 11
153
154 /* MXT_PROCI_NOISE field */
155 #define MXT_NOISE_CTRL 0
156 #define MXT_NOISE_OUTFLEN 1
157 #define MXT_NOISE_GCAFUL_LSB 3
158 #define MXT_NOISE_GCAFUL_MSB 4
159 #define MXT_NOISE_GCAFLL_LSB 5
160 #define MXT_NOISE_GCAFLL_MSB 6
161 #define MXT_NOISE_ACTVGCAFVALID 7
162 #define MXT_NOISE_NOISETHR 8
163 #define MXT_NOISE_FREQHOPSCALE 10
164 #define MXT_NOISE_FREQ0 11
165 #define MXT_NOISE_FREQ1 12
166 #define MXT_NOISE_FREQ2 13
167 #define MXT_NOISE_FREQ3 14
168 #define MXT_NOISE_FREQ4 15
169 #define MXT_NOISE_IDLEGCAFVALID 16
170
171 /* MXT_SPT_COMMSCONFIG_T18 */
172 #define MXT_COMMS_CTRL 0
173 #define MXT_COMMS_CMD 1
174
175 /* MXT_SPT_CTECONFIG_T28 field */
176 #define MXT_CTE_CTRL 0
177 #define MXT_CTE_CMD 1
178 #define MXT_CTE_MODE 2
179 #define MXT_CTE_IDLEGCAFDEPTH 3
180 #define MXT_CTE_ACTVGCAFDEPTH 4
181 #define MXT_CTE_VOLTAGE 5
182
183 #define MXT_VOLTAGE_DEFAULT 2700000
184 #define MXT_VOLTAGE_STEP 10000
185
186 /* Define for MXT_GEN_COMMAND_T6 */
187 #define MXT_BOOT_VALUE 0xa5
188 #define MXT_RESET_VALUE 0x01
189 #define MXT_BACKUP_VALUE 0x55
190
191 /* Delay times */
192 #define MXT_BACKUP_TIME 50 /* msec */
193 #define MXT_RESET_TIME 200 /* msec */
194 #define MXT_RESET_TIMEOUT 3000 /* msec */
195 #define MXT_CRC_TIMEOUT 1000 /* msec */
196 #define MXT_FW_RESET_TIME 3000 /* msec */
197 #define MXT_FW_CHG_TIMEOUT 300 /* msec */
198
199 /* Command to unlock bootloader */
200 #define MXT_UNLOCK_CMD_MSB 0xaa
201 #define MXT_UNLOCK_CMD_LSB 0xdc
202
203 /* Bootloader mode status */
204 #define MXT_WAITING_BOOTLOAD_CMD 0xc0 /* valid 7 6 bit only */
205 #define MXT_WAITING_FRAME_DATA 0x80 /* valid 7 6 bit only */
206 #define MXT_FRAME_CRC_CHECK 0x02
207 #define MXT_FRAME_CRC_FAIL 0x03
208 #define MXT_FRAME_CRC_PASS 0x04
209 #define MXT_APP_CRC_FAIL 0x40 /* valid 7 8 bit only */
210 #define MXT_BOOT_STATUS_MASK 0x3f
211 #define MXT_BOOT_EXTENDED_ID (1 << 5)
212 #define MXT_BOOT_ID_MASK 0x1f
213
214 /* Touchscreen absolute values */
215 #define MXT_MAX_AREA 0xff
216
217 #define MXT_PIXELS_PER_MM 20
218
219 struct mxt_info {
220 u8 family_id;
221 u8 variant_id;
222 u8 version;
223 u8 build;
224 u8 matrix_xsize;
225 u8 matrix_ysize;
226 u8 object_num;
227 };
228
229 struct mxt_object {
230 u8 type;
231 u16 start_address;
232 u8 size_minus_one;
233 u8 instances_minus_one;
234 u8 num_report_ids;
235 } __packed;
236
237 /* Each client has this additional data */
238 struct mxt_data {
239 struct i2c_client *client;
240 struct input_dev *input_dev;
241 char phys[64]; /* device physical location */
242 const struct mxt_platform_data *pdata;
243 struct mxt_object *object_table;
244 struct mxt_info info;
245 unsigned int irq;
246 unsigned int max_x;
247 unsigned int max_y;
248 bool in_bootloader;
249 u16 mem_size;
250 u8 max_reportid;
251 u32 config_crc;
252 u32 info_crc;
253 u8 bootloader_addr;
254 u8 *msg_buf;
255 u8 t6_status;
256 bool update_input;
257 u8 last_message_count;
258 u8 num_touchids;
259 struct t7_config t7_cfg;
260
261 /* Cached parameters from object table */
262 u16 T5_address;
263 u8 T5_msg_size;
264 u8 T6_reportid;
265 u16 T6_address;
266 u16 T7_address;
267 u8 T9_reportid_min;
268 u8 T9_reportid_max;
269 u8 T19_reportid;
270 u16 T44_address;
271
272 /* for fw update in bootloader */
273 struct completion bl_completion;
274
275 /* for reset handling */
276 struct completion reset_completion;
277
278 /* for config update handling */
279 struct completion crc_completion;
280 };
281
282 static size_t mxt_obj_size(const struct mxt_object *obj)
283 {
284 return obj->size_minus_one + 1;
285 }
286
287 static size_t mxt_obj_instances(const struct mxt_object *obj)
288 {
289 return obj->instances_minus_one + 1;
290 }
291
292 static bool mxt_object_readable(unsigned int type)
293 {
294 switch (type) {
295 case MXT_GEN_COMMAND_T6:
296 case MXT_GEN_POWER_T7:
297 case MXT_GEN_ACQUIRE_T8:
298 case MXT_GEN_DATASOURCE_T53:
299 case MXT_TOUCH_MULTI_T9:
300 case MXT_TOUCH_KEYARRAY_T15:
301 case MXT_TOUCH_PROXIMITY_T23:
302 case MXT_TOUCH_PROXKEY_T52:
303 case MXT_PROCI_GRIPFACE_T20:
304 case MXT_PROCG_NOISE_T22:
305 case MXT_PROCI_ONETOUCH_T24:
306 case MXT_PROCI_TWOTOUCH_T27:
307 case MXT_PROCI_GRIP_T40:
308 case MXT_PROCI_PALM_T41:
309 case MXT_PROCI_TOUCHSUPPRESSION_T42:
310 case MXT_PROCI_STYLUS_T47:
311 case MXT_PROCG_NOISESUPPRESSION_T48:
312 case MXT_SPT_COMMSCONFIG_T18:
313 case MXT_SPT_GPIOPWM_T19:
314 case MXT_SPT_SELFTEST_T25:
315 case MXT_SPT_CTECONFIG_T28:
316 case MXT_SPT_USERDATA_T38:
317 case MXT_SPT_DIGITIZER_T43:
318 case MXT_SPT_CTECONFIG_T46:
319 return true;
320 default:
321 return false;
322 }
323 }
324
325 static void mxt_dump_message(struct mxt_data *data, u8 *message)
326 {
327 dev_dbg(&data->client->dev, "message: %*ph\n",
328 data->T5_msg_size, message);
329 }
330
331 static int mxt_wait_for_completion(struct mxt_data *data,
332 struct completion *comp,
333 unsigned int timeout_ms)
334 {
335 struct device *dev = &data->client->dev;
336 unsigned long timeout = msecs_to_jiffies(timeout_ms);
337 long ret;
338
339 ret = wait_for_completion_interruptible_timeout(comp, timeout);
340 if (ret < 0) {
341 return ret;
342 } else if (ret == 0) {
343 dev_err(dev, "Wait for completion timed out.\n");
344 return -ETIMEDOUT;
345 }
346 return 0;
347 }
348
349 static int mxt_bootloader_read(struct mxt_data *data,
350 u8 *val, unsigned int count)
351 {
352 int ret;
353 struct i2c_msg msg;
354
355 msg.addr = data->bootloader_addr;
356 msg.flags = data->client->flags & I2C_M_TEN;
357 msg.flags |= I2C_M_RD;
358 msg.len = count;
359 msg.buf = val;
360
361 ret = i2c_transfer(data->client->adapter, &msg, 1);
362 if (ret == 1) {
363 ret = 0;
364 } else {
365 ret = ret < 0 ? ret : -EIO;
366 dev_err(&data->client->dev, "%s: i2c recv failed (%d)\n",
367 __func__, ret);
368 }
369
370 return ret;
371 }
372
373 static int mxt_bootloader_write(struct mxt_data *data,
374 const u8 * const val, unsigned int count)
375 {
376 int ret;
377 struct i2c_msg msg;
378
379 msg.addr = data->bootloader_addr;
380 msg.flags = data->client->flags & I2C_M_TEN;
381 msg.len = count;
382 msg.buf = (u8 *)val;
383
384 ret = i2c_transfer(data->client->adapter, &msg, 1);
385 if (ret == 1) {
386 ret = 0;
387 } else {
388 ret = ret < 0 ? ret : -EIO;
389 dev_err(&data->client->dev, "%s: i2c send failed (%d)\n",
390 __func__, ret);
391 }
392
393 return ret;
394 }
395
396 static int mxt_lookup_bootloader_address(struct mxt_data *data, bool retry)
397 {
398 u8 appmode = data->client->addr;
399 u8 bootloader;
400
401 switch (appmode) {
402 case 0x4a:
403 case 0x4b:
404 /* Chips after 1664S use different scheme */
405 if (retry || data->info.family_id >= 0xa2) {
406 bootloader = appmode - 0x24;
407 break;
408 }
409 /* Fall through for normal case */
410 case 0x4c:
411 case 0x4d:
412 case 0x5a:
413 case 0x5b:
414 bootloader = appmode - 0x26;
415 break;
416
417 default:
418 dev_err(&data->client->dev,
419 "Appmode i2c address 0x%02x not found\n",
420 appmode);
421 return -EINVAL;
422 }
423
424 data->bootloader_addr = bootloader;
425 return 0;
426 }
427
428 static int mxt_probe_bootloader(struct mxt_data *data, bool alt_address)
429 {
430 struct device *dev = &data->client->dev;
431 int error;
432 u8 val;
433 bool crc_failure;
434
435 error = mxt_lookup_bootloader_address(data, alt_address);
436 if (error)
437 return error;
438
439 error = mxt_bootloader_read(data, &val, 1);
440 if (error)
441 return error;
442
443 /* Check app crc fail mode */
444 crc_failure = (val & ~MXT_BOOT_STATUS_MASK) == MXT_APP_CRC_FAIL;
445
446 dev_err(dev, "Detected bootloader, status:%02X%s\n",
447 val, crc_failure ? ", APP_CRC_FAIL" : "");
448
449 return 0;
450 }
451
452 static u8 mxt_get_bootloader_version(struct mxt_data *data, u8 val)
453 {
454 struct device *dev = &data->client->dev;
455 u8 buf[3];
456
457 if (val & MXT_BOOT_EXTENDED_ID) {
458 if (mxt_bootloader_read(data, &buf[0], 3) != 0) {
459 dev_err(dev, "%s: i2c failure\n", __func__);
460 return val;
461 }
462
463 dev_dbg(dev, "Bootloader ID:%d Version:%d\n", buf[1], buf[2]);
464
465 return buf[0];
466 } else {
467 dev_dbg(dev, "Bootloader ID:%d\n", val & MXT_BOOT_ID_MASK);
468
469 return val;
470 }
471 }
472
473 static int mxt_check_bootloader(struct mxt_data *data, unsigned int state,
474 bool wait)
475 {
476 struct device *dev = &data->client->dev;
477 u8 val;
478 int ret;
479
480 recheck:
481 if (wait) {
482 /*
483 * In application update mode, the interrupt
484 * line signals state transitions. We must wait for the
485 * CHG assertion before reading the status byte.
486 * Once the status byte has been read, the line is deasserted.
487 */
488 ret = mxt_wait_for_completion(data, &data->bl_completion,
489 MXT_FW_CHG_TIMEOUT);
490 if (ret) {
491 /*
492 * TODO: handle -ERESTARTSYS better by terminating
493 * fw update process before returning to userspace
494 * by writing length 0x000 to device (iff we are in
495 * WAITING_FRAME_DATA state).
496 */
497 dev_err(dev, "Update wait error %d\n", ret);
498 return ret;
499 }
500 }
501
502 ret = mxt_bootloader_read(data, &val, 1);
503 if (ret)
504 return ret;
505
506 if (state == MXT_WAITING_BOOTLOAD_CMD)
507 val = mxt_get_bootloader_version(data, val);
508
509 switch (state) {
510 case MXT_WAITING_BOOTLOAD_CMD:
511 case MXT_WAITING_FRAME_DATA:
512 case MXT_APP_CRC_FAIL:
513 val &= ~MXT_BOOT_STATUS_MASK;
514 break;
515 case MXT_FRAME_CRC_PASS:
516 if (val == MXT_FRAME_CRC_CHECK) {
517 goto recheck;
518 } else if (val == MXT_FRAME_CRC_FAIL) {
519 dev_err(dev, "Bootloader CRC fail\n");
520 return -EINVAL;
521 }
522 break;
523 default:
524 return -EINVAL;
525 }
526
527 if (val != state) {
528 dev_err(dev, "Invalid bootloader state %02X != %02X\n",
529 val, state);
530 return -EINVAL;
531 }
532
533 return 0;
534 }
535
536 static int mxt_send_bootloader_cmd(struct mxt_data *data, bool unlock)
537 {
538 int ret;
539 u8 buf[2];
540
541 if (unlock) {
542 buf[0] = MXT_UNLOCK_CMD_LSB;
543 buf[1] = MXT_UNLOCK_CMD_MSB;
544 } else {
545 buf[0] = 0x01;
546 buf[1] = 0x01;
547 }
548
549 ret = mxt_bootloader_write(data, buf, 2);
550 if (ret)
551 return ret;
552
553 return 0;
554 }
555
556 static int __mxt_read_reg(struct i2c_client *client,
557 u16 reg, u16 len, void *val)
558 {
559 struct i2c_msg xfer[2];
560 u8 buf[2];
561 int ret;
562
563 buf[0] = reg & 0xff;
564 buf[1] = (reg >> 8) & 0xff;
565
566 /* Write register */
567 xfer[0].addr = client->addr;
568 xfer[0].flags = 0;
569 xfer[0].len = 2;
570 xfer[0].buf = buf;
571
572 /* Read data */
573 xfer[1].addr = client->addr;
574 xfer[1].flags = I2C_M_RD;
575 xfer[1].len = len;
576 xfer[1].buf = val;
577
578 ret = i2c_transfer(client->adapter, xfer, 2);
579 if (ret == 2) {
580 ret = 0;
581 } else {
582 if (ret >= 0)
583 ret = -EIO;
584 dev_err(&client->dev, "%s: i2c transfer failed (%d)\n",
585 __func__, ret);
586 }
587
588 return ret;
589 }
590
591 static int __mxt_write_reg(struct i2c_client *client, u16 reg, u16 len,
592 const void *val)
593 {
594 u8 *buf;
595 size_t count;
596 int ret;
597
598 count = len + 2;
599 buf = kmalloc(count, GFP_KERNEL);
600 if (!buf)
601 return -ENOMEM;
602
603 buf[0] = reg & 0xff;
604 buf[1] = (reg >> 8) & 0xff;
605 memcpy(&buf[2], val, len);
606
607 ret = i2c_master_send(client, buf, count);
608 if (ret == count) {
609 ret = 0;
610 } else {
611 if (ret >= 0)
612 ret = -EIO;
613 dev_err(&client->dev, "%s: i2c send failed (%d)\n",
614 __func__, ret);
615 }
616
617 kfree(buf);
618 return ret;
619 }
620
621 static int mxt_write_reg(struct i2c_client *client, u16 reg, u8 val)
622 {
623 return __mxt_write_reg(client, reg, 1, &val);
624 }
625
626 static struct mxt_object *
627 mxt_get_object(struct mxt_data *data, u8 type)
628 {
629 struct mxt_object *object;
630 int i;
631
632 for (i = 0; i < data->info.object_num; i++) {
633 object = data->object_table + i;
634 if (object->type == type)
635 return object;
636 }
637
638 dev_warn(&data->client->dev, "Invalid object type T%u\n", type);
639 return NULL;
640 }
641
642 static void mxt_proc_t6_messages(struct mxt_data *data, u8 *msg)
643 {
644 struct device *dev = &data->client->dev;
645 u8 status = msg[1];
646 u32 crc = msg[2] | (msg[3] << 8) | (msg[4] << 16);
647
648 complete(&data->crc_completion);
649
650 if (crc != data->config_crc) {
651 data->config_crc = crc;
652 dev_dbg(dev, "T6 Config Checksum: 0x%06X\n", crc);
653 }
654
655 /* Detect reset */
656 if (status & MXT_T6_STATUS_RESET)
657 complete(&data->reset_completion);
658
659 /* Output debug if status has changed */
660 if (status != data->t6_status)
661 dev_dbg(dev, "T6 Status 0x%02X%s%s%s%s%s%s%s\n",
662 status,
663 status == 0 ? " OK" : "",
664 status & MXT_T6_STATUS_RESET ? " RESET" : "",
665 status & MXT_T6_STATUS_OFL ? " OFL" : "",
666 status & MXT_T6_STATUS_SIGERR ? " SIGERR" : "",
667 status & MXT_T6_STATUS_CAL ? " CAL" : "",
668 status & MXT_T6_STATUS_CFGERR ? " CFGERR" : "",
669 status & MXT_T6_STATUS_COMSERR ? " COMSERR" : "");
670
671 /* Save current status */
672 data->t6_status = status;
673 }
674
675 static void mxt_input_button(struct mxt_data *data, u8 *message)
676 {
677 struct input_dev *input = data->input_dev;
678 const struct mxt_platform_data *pdata = data->pdata;
679 bool button;
680 int i;
681
682 /* Active-low switch */
683 for (i = 0; i < pdata->t19_num_keys; i++) {
684 if (pdata->t19_keymap[i] == KEY_RESERVED)
685 continue;
686 button = !(message[1] & (1 << i));
687 input_report_key(input, pdata->t19_keymap[i], button);
688 }
689 }
690
691 static void mxt_input_sync(struct mxt_data *data)
692 {
693 input_mt_report_pointer_emulation(data->input_dev,
694 data->pdata->t19_num_keys);
695 input_sync(data->input_dev);
696 }
697
698 static void mxt_proc_t9_message(struct mxt_data *data, u8 *message)
699 {
700 struct device *dev = &data->client->dev;
701 struct input_dev *input_dev = data->input_dev;
702 int id;
703 u8 status;
704 int x;
705 int y;
706 int area;
707 int amplitude;
708
709 id = message[0] - data->T9_reportid_min;
710 status = message[1];
711 x = (message[2] << 4) | ((message[4] >> 4) & 0xf);
712 y = (message[3] << 4) | ((message[4] & 0xf));
713
714 /* Handle 10/12 bit switching */
715 if (data->max_x < 1024)
716 x >>= 2;
717 if (data->max_y < 1024)
718 y >>= 2;
719
720 area = message[5];
721 amplitude = message[6];
722
723 dev_dbg(dev,
724 "[%u] %c%c%c%c%c%c%c%c x: %5u y: %5u area: %3u amp: %3u\n",
725 id,
726 (status & MXT_T9_DETECT) ? 'D' : '.',
727 (status & MXT_T9_PRESS) ? 'P' : '.',
728 (status & MXT_T9_RELEASE) ? 'R' : '.',
729 (status & MXT_T9_MOVE) ? 'M' : '.',
730 (status & MXT_T9_VECTOR) ? 'V' : '.',
731 (status & MXT_T9_AMP) ? 'A' : '.',
732 (status & MXT_T9_SUPPRESS) ? 'S' : '.',
733 (status & MXT_T9_UNGRIP) ? 'U' : '.',
734 x, y, area, amplitude);
735
736 input_mt_slot(input_dev, id);
737
738 if (status & MXT_T9_DETECT) {
739 /*
740 * Multiple bits may be set if the host is slow to read
741 * the status messages, indicating all the events that
742 * have happened.
743 */
744 if (status & MXT_T9_RELEASE) {
745 input_mt_report_slot_state(input_dev,
746 MT_TOOL_FINGER, 0);
747 mxt_input_sync(data);
748 }
749
750 /* Touch active */
751 input_mt_report_slot_state(input_dev, MT_TOOL_FINGER, 1);
752 input_report_abs(input_dev, ABS_MT_POSITION_X, x);
753 input_report_abs(input_dev, ABS_MT_POSITION_Y, y);
754 input_report_abs(input_dev, ABS_MT_PRESSURE, amplitude);
755 input_report_abs(input_dev, ABS_MT_TOUCH_MAJOR, area);
756 } else {
757 /* Touch no longer active, close out slot */
758 input_mt_report_slot_state(input_dev, MT_TOOL_FINGER, 0);
759 }
760
761 data->update_input = true;
762 }
763
764 static int mxt_proc_message(struct mxt_data *data, u8 *message)
765 {
766 u8 report_id = message[0];
767
768 if (report_id == MXT_RPTID_NOMSG)
769 return 0;
770
771 if (report_id == data->T6_reportid) {
772 mxt_proc_t6_messages(data, message);
773 } else if (!data->input_dev) {
774 /*
775 * Do not report events if input device
776 * is not yet registered.
777 */
778 mxt_dump_message(data, message);
779 } else if (report_id >= data->T9_reportid_min
780 && report_id <= data->T9_reportid_max) {
781 mxt_proc_t9_message(data, message);
782 } else if (report_id == data->T19_reportid) {
783 mxt_input_button(data, message);
784 data->update_input = true;
785 } else {
786 mxt_dump_message(data, message);
787 }
788
789 return 1;
790 }
791
792 static int mxt_read_and_process_messages(struct mxt_data *data, u8 count)
793 {
794 struct device *dev = &data->client->dev;
795 int ret;
796 int i;
797 u8 num_valid = 0;
798
799 /* Safety check for msg_buf */
800 if (count > data->max_reportid)
801 return -EINVAL;
802
803 /* Process remaining messages if necessary */
804 ret = __mxt_read_reg(data->client, data->T5_address,
805 data->T5_msg_size * count, data->msg_buf);
806 if (ret) {
807 dev_err(dev, "Failed to read %u messages (%d)\n", count, ret);
808 return ret;
809 }
810
811 for (i = 0; i < count; i++) {
812 ret = mxt_proc_message(data,
813 data->msg_buf + data->T5_msg_size * i);
814
815 if (ret == 1)
816 num_valid++;
817 }
818
819 /* return number of messages read */
820 return num_valid;
821 }
822
823 static irqreturn_t mxt_process_messages_t44(struct mxt_data *data)
824 {
825 struct device *dev = &data->client->dev;
826 int ret;
827 u8 count, num_left;
828
829 /* Read T44 and T5 together */
830 ret = __mxt_read_reg(data->client, data->T44_address,
831 data->T5_msg_size + 1, data->msg_buf);
832 if (ret) {
833 dev_err(dev, "Failed to read T44 and T5 (%d)\n", ret);
834 return IRQ_NONE;
835 }
836
837 count = data->msg_buf[0];
838
839 if (count == 0) {
840 dev_warn(dev, "Interrupt triggered but zero messages\n");
841 return IRQ_NONE;
842 } else if (count > data->max_reportid) {
843 dev_err(dev, "T44 count %d exceeded max report id\n", count);
844 count = data->max_reportid;
845 }
846
847 /* Process first message */
848 ret = mxt_proc_message(data, data->msg_buf + 1);
849 if (ret < 0) {
850 dev_warn(dev, "Unexpected invalid message\n");
851 return IRQ_NONE;
852 }
853
854 num_left = count - 1;
855
856 /* Process remaining messages if necessary */
857 if (num_left) {
858 ret = mxt_read_and_process_messages(data, num_left);
859 if (ret < 0)
860 goto end;
861 else if (ret != num_left)
862 dev_warn(dev, "Unexpected invalid message\n");
863 }
864
865 end:
866 if (data->update_input) {
867 mxt_input_sync(data);
868 data->update_input = false;
869 }
870
871 return IRQ_HANDLED;
872 }
873
874 static int mxt_process_messages_until_invalid(struct mxt_data *data)
875 {
876 struct device *dev = &data->client->dev;
877 int count, read;
878 u8 tries = 2;
879
880 count = data->max_reportid;
881
882 /* Read messages until we force an invalid */
883 do {
884 read = mxt_read_and_process_messages(data, count);
885 if (read < count)
886 return 0;
887 } while (--tries);
888
889 if (data->update_input) {
890 mxt_input_sync(data);
891 data->update_input = false;
892 }
893
894 dev_err(dev, "CHG pin isn't cleared\n");
895 return -EBUSY;
896 }
897
898 static irqreturn_t mxt_process_messages(struct mxt_data *data)
899 {
900 int total_handled, num_handled;
901 u8 count = data->last_message_count;
902
903 if (count < 1 || count > data->max_reportid)
904 count = 1;
905
906 /* include final invalid message */
907 total_handled = mxt_read_and_process_messages(data, count + 1);
908 if (total_handled < 0)
909 return IRQ_NONE;
910 /* if there were invalid messages, then we are done */
911 else if (total_handled <= count)
912 goto update_count;
913
914 /* keep reading two msgs until one is invalid or reportid limit */
915 do {
916 num_handled = mxt_read_and_process_messages(data, 2);
917 if (num_handled < 0)
918 return IRQ_NONE;
919
920 total_handled += num_handled;
921
922 if (num_handled < 2)
923 break;
924 } while (total_handled < data->num_touchids);
925
926 update_count:
927 data->last_message_count = total_handled;
928
929 if (data->update_input) {
930 mxt_input_sync(data);
931 data->update_input = false;
932 }
933
934 return IRQ_HANDLED;
935 }
936
937 static irqreturn_t mxt_interrupt(int irq, void *dev_id)
938 {
939 struct mxt_data *data = dev_id;
940
941 if (data->in_bootloader) {
942 /* bootloader state transition completion */
943 complete(&data->bl_completion);
944 return IRQ_HANDLED;
945 }
946
947 if (!data->object_table)
948 return IRQ_HANDLED;
949
950 if (data->T44_address) {
951 return mxt_process_messages_t44(data);
952 } else {
953 return mxt_process_messages(data);
954 }
955 }
956
957 static int mxt_t6_command(struct mxt_data *data, u16 cmd_offset,
958 u8 value, bool wait)
959 {
960 u16 reg;
961 u8 command_register;
962 int timeout_counter = 0;
963 int ret;
964
965 reg = data->T6_address + cmd_offset;
966
967 ret = mxt_write_reg(data->client, reg, value);
968 if (ret)
969 return ret;
970
971 if (!wait)
972 return 0;
973
974 do {
975 msleep(20);
976 ret = __mxt_read_reg(data->client, reg, 1, &command_register);
977 if (ret)
978 return ret;
979 } while (command_register != 0 && timeout_counter++ <= 100);
980
981 if (timeout_counter > 100) {
982 dev_err(&data->client->dev, "Command failed!\n");
983 return -EIO;
984 }
985
986 return 0;
987 }
988
989 static int mxt_soft_reset(struct mxt_data *data)
990 {
991 struct device *dev = &data->client->dev;
992 int ret = 0;
993
994 dev_info(dev, "Resetting chip\n");
995
996 reinit_completion(&data->reset_completion);
997
998 ret = mxt_t6_command(data, MXT_COMMAND_RESET, MXT_RESET_VALUE, false);
999 if (ret)
1000 return ret;
1001
1002 ret = mxt_wait_for_completion(data, &data->reset_completion,
1003 MXT_RESET_TIMEOUT);
1004 if (ret)
1005 return ret;
1006
1007 return 0;
1008 }
1009
1010 static void mxt_update_crc(struct mxt_data *data, u8 cmd, u8 value)
1011 {
1012 /*
1013 * On failure, CRC is set to 0 and config will always be
1014 * downloaded.
1015 */
1016 data->config_crc = 0;
1017 reinit_completion(&data->crc_completion);
1018
1019 mxt_t6_command(data, cmd, value, true);
1020
1021 /*
1022 * Wait for crc message. On failure, CRC is set to 0 and config will
1023 * always be downloaded.
1024 */
1025 mxt_wait_for_completion(data, &data->crc_completion, MXT_CRC_TIMEOUT);
1026 }
1027
1028 static void mxt_calc_crc24(u32 *crc, u8 firstbyte, u8 secondbyte)
1029 {
1030 static const unsigned int crcpoly = 0x80001B;
1031 u32 result;
1032 u32 data_word;
1033
1034 data_word = (secondbyte << 8) | firstbyte;
1035 result = ((*crc << 1) ^ data_word);
1036
1037 if (result & 0x1000000)
1038 result ^= crcpoly;
1039
1040 *crc = result;
1041 }
1042
1043 static u32 mxt_calculate_crc(u8 *base, off_t start_off, off_t end_off)
1044 {
1045 u32 crc = 0;
1046 u8 *ptr = base + start_off;
1047 u8 *last_val = base + end_off - 1;
1048
1049 if (end_off < start_off)
1050 return -EINVAL;
1051
1052 while (ptr < last_val) {
1053 mxt_calc_crc24(&crc, *ptr, *(ptr + 1));
1054 ptr += 2;
1055 }
1056
1057 /* if len is odd, fill the last byte with 0 */
1058 if (ptr == last_val)
1059 mxt_calc_crc24(&crc, *ptr, 0);
1060
1061 /* Mask to 24-bit */
1062 crc &= 0x00FFFFFF;
1063
1064 return crc;
1065 }
1066
1067 static int mxt_prepare_cfg_mem(struct mxt_data *data,
1068 const struct firmware *cfg,
1069 unsigned int data_pos,
1070 unsigned int cfg_start_ofs,
1071 u8 *config_mem,
1072 size_t config_mem_size)
1073 {
1074 struct device *dev = &data->client->dev;
1075 struct mxt_object *object;
1076 unsigned int type, instance, size, byte_offset;
1077 int offset;
1078 int ret;
1079 int i;
1080 u16 reg;
1081 u8 val;
1082
1083 while (data_pos < cfg->size) {
1084 /* Read type, instance, length */
1085 ret = sscanf(cfg->data + data_pos, "%x %x %x%n",
1086 &type, &instance, &size, &offset);
1087 if (ret == 0) {
1088 /* EOF */
1089 break;
1090 } else if (ret != 3) {
1091 dev_err(dev, "Bad format: failed to parse object\n");
1092 return -EINVAL;
1093 }
1094 data_pos += offset;
1095
1096 object = mxt_get_object(data, type);
1097 if (!object) {
1098 /* Skip object */
1099 for (i = 0; i < size; i++) {
1100 ret = sscanf(cfg->data + data_pos, "%hhx%n",
1101 &val,
1102 &offset);
1103 data_pos += offset;
1104 }
1105 continue;
1106 }
1107
1108 if (size > mxt_obj_size(object)) {
1109 /*
1110 * Either we are in fallback mode due to wrong
1111 * config or config from a later fw version,
1112 * or the file is corrupt or hand-edited.
1113 */
1114 dev_warn(dev, "Discarding %zu byte(s) in T%u\n",
1115 size - mxt_obj_size(object), type);
1116 } else if (mxt_obj_size(object) > size) {
1117 /*
1118 * If firmware is upgraded, new bytes may be added to
1119 * end of objects. It is generally forward compatible
1120 * to zero these bytes - previous behaviour will be
1121 * retained. However this does invalidate the CRC and
1122 * will force fallback mode until the configuration is
1123 * updated. We warn here but do nothing else - the
1124 * malloc has zeroed the entire configuration.
1125 */
1126 dev_warn(dev, "Zeroing %zu byte(s) in T%d\n",
1127 mxt_obj_size(object) - size, type);
1128 }
1129
1130 if (instance >= mxt_obj_instances(object)) {
1131 dev_err(dev, "Object instances exceeded!\n");
1132 return -EINVAL;
1133 }
1134
1135 reg = object->start_address + mxt_obj_size(object) * instance;
1136
1137 for (i = 0; i < size; i++) {
1138 ret = sscanf(cfg->data + data_pos, "%hhx%n",
1139 &val,
1140 &offset);
1141 if (ret != 1) {
1142 dev_err(dev, "Bad format in T%d\n", type);
1143 return -EINVAL;
1144 }
1145 data_pos += offset;
1146
1147 if (i > mxt_obj_size(object))
1148 continue;
1149
1150 byte_offset = reg + i - cfg_start_ofs;
1151
1152 if (byte_offset >= 0 &&
1153 byte_offset <= config_mem_size) {
1154 *(config_mem + byte_offset) = val;
1155 } else {
1156 dev_err(dev, "Bad object: reg:%d, T%d, ofs=%d\n",
1157 reg, object->type, byte_offset);
1158 return -EINVAL;
1159 }
1160 }
1161 }
1162
1163 return 0;
1164 }
1165
1166 static int mxt_upload_cfg_mem(struct mxt_data *data, unsigned int cfg_start,
1167 u8 *config_mem, size_t config_mem_size)
1168 {
1169 unsigned int byte_offset = 0;
1170 int error;
1171
1172 /* Write configuration as blocks */
1173 while (byte_offset < config_mem_size) {
1174 unsigned int size = config_mem_size - byte_offset;
1175
1176 if (size > MXT_MAX_BLOCK_WRITE)
1177 size = MXT_MAX_BLOCK_WRITE;
1178
1179 error = __mxt_write_reg(data->client,
1180 cfg_start + byte_offset,
1181 size, config_mem + byte_offset);
1182 if (error) {
1183 dev_err(&data->client->dev,
1184 "Config write error, ret=%d\n", error);
1185 return error;
1186 }
1187
1188 byte_offset += size;
1189 }
1190
1191 return 0;
1192 }
1193
1194 /*
1195 * mxt_update_cfg - download configuration to chip
1196 *
1197 * Atmel Raw Config File Format
1198 *
1199 * The first four lines of the raw config file contain:
1200 * 1) Version
1201 * 2) Chip ID Information (first 7 bytes of device memory)
1202 * 3) Chip Information Block 24-bit CRC Checksum
1203 * 4) Chip Configuration 24-bit CRC Checksum
1204 *
1205 * The rest of the file consists of one line per object instance:
1206 * <TYPE> <INSTANCE> <SIZE> <CONTENTS>
1207 *
1208 * <TYPE> - 2-byte object type as hex
1209 * <INSTANCE> - 2-byte object instance number as hex
1210 * <SIZE> - 2-byte object size as hex
1211 * <CONTENTS> - array of <SIZE> 1-byte hex values
1212 */
1213 static int mxt_update_cfg(struct mxt_data *data, const struct firmware *cfg)
1214 {
1215 struct device *dev = &data->client->dev;
1216 struct mxt_info cfg_info;
1217 int ret;
1218 int offset;
1219 int data_pos;
1220 int i;
1221 int cfg_start_ofs;
1222 u32 info_crc, config_crc, calculated_crc;
1223 u8 *config_mem;
1224 size_t config_mem_size;
1225
1226 mxt_update_crc(data, MXT_COMMAND_REPORTALL, 1);
1227
1228 if (strncmp(cfg->data, MXT_CFG_MAGIC, strlen(MXT_CFG_MAGIC))) {
1229 dev_err(dev, "Unrecognised config file\n");
1230 return -EINVAL;
1231 }
1232
1233 data_pos = strlen(MXT_CFG_MAGIC);
1234
1235 /* Load information block and check */
1236 for (i = 0; i < sizeof(struct mxt_info); i++) {
1237 ret = sscanf(cfg->data + data_pos, "%hhx%n",
1238 (unsigned char *)&cfg_info + i,
1239 &offset);
1240 if (ret != 1) {
1241 dev_err(dev, "Bad format\n");
1242 return -EINVAL;
1243 }
1244
1245 data_pos += offset;
1246 }
1247
1248 if (cfg_info.family_id != data->info.family_id) {
1249 dev_err(dev, "Family ID mismatch!\n");
1250 return -EINVAL;
1251 }
1252
1253 if (cfg_info.variant_id != data->info.variant_id) {
1254 dev_err(dev, "Variant ID mismatch!\n");
1255 return -EINVAL;
1256 }
1257
1258 /* Read CRCs */
1259 ret = sscanf(cfg->data + data_pos, "%x%n", &info_crc, &offset);
1260 if (ret != 1) {
1261 dev_err(dev, "Bad format: failed to parse Info CRC\n");
1262 return -EINVAL;
1263 }
1264 data_pos += offset;
1265
1266 ret = sscanf(cfg->data + data_pos, "%x%n", &config_crc, &offset);
1267 if (ret != 1) {
1268 dev_err(dev, "Bad format: failed to parse Config CRC\n");
1269 return -EINVAL;
1270 }
1271 data_pos += offset;
1272
1273 /*
1274 * The Info Block CRC is calculated over mxt_info and the object
1275 * table. If it does not match then we are trying to load the
1276 * configuration from a different chip or firmware version, so
1277 * the configuration CRC is invalid anyway.
1278 */
1279 if (info_crc == data->info_crc) {
1280 if (config_crc == 0 || data->config_crc == 0) {
1281 dev_info(dev, "CRC zero, attempting to apply config\n");
1282 } else if (config_crc == data->config_crc) {
1283 dev_dbg(dev, "Config CRC 0x%06X: OK\n",
1284 data->config_crc);
1285 return 0;
1286 } else {
1287 dev_info(dev, "Config CRC 0x%06X: does not match file 0x%06X\n",
1288 data->config_crc, config_crc);
1289 }
1290 } else {
1291 dev_warn(dev,
1292 "Warning: Info CRC error - device=0x%06X file=0x%06X\n",
1293 data->info_crc, info_crc);
1294 }
1295
1296 /* Malloc memory to store configuration */
1297 cfg_start_ofs = MXT_OBJECT_START +
1298 data->info.object_num * sizeof(struct mxt_object) +
1299 MXT_INFO_CHECKSUM_SIZE;
1300 config_mem_size = data->mem_size - cfg_start_ofs;
1301 config_mem = kzalloc(config_mem_size, GFP_KERNEL);
1302 if (!config_mem) {
1303 dev_err(dev, "Failed to allocate memory\n");
1304 return -ENOMEM;
1305 }
1306
1307 ret = mxt_prepare_cfg_mem(data, cfg, data_pos, cfg_start_ofs,
1308 config_mem, config_mem_size);
1309 if (ret)
1310 goto release_mem;
1311
1312 /* Calculate crc of the received configs (not the raw config file) */
1313 if (data->T7_address < cfg_start_ofs) {
1314 dev_err(dev, "Bad T7 address, T7addr = %x, config offset %x\n",
1315 data->T7_address, cfg_start_ofs);
1316 ret = 0;
1317 goto release_mem;
1318 }
1319
1320 calculated_crc = mxt_calculate_crc(config_mem,
1321 data->T7_address - cfg_start_ofs,
1322 config_mem_size);
1323
1324 if (config_crc > 0 && config_crc != calculated_crc)
1325 dev_warn(dev, "Config CRC error, calculated=%06X, file=%06X\n",
1326 calculated_crc, config_crc);
1327
1328 ret = mxt_upload_cfg_mem(data, cfg_start_ofs,
1329 config_mem, config_mem_size);
1330 if (ret)
1331 goto release_mem;
1332
1333 mxt_update_crc(data, MXT_COMMAND_BACKUPNV, MXT_BACKUP_VALUE);
1334
1335 ret = mxt_soft_reset(data);
1336 if (ret)
1337 goto release_mem;
1338
1339 dev_info(dev, "Config successfully updated\n");
1340
1341 release_mem:
1342 kfree(config_mem);
1343 return ret;
1344 }
1345
1346 static int mxt_acquire_irq(struct mxt_data *data)
1347 {
1348 int error;
1349
1350 enable_irq(data->irq);
1351
1352 error = mxt_process_messages_until_invalid(data);
1353 if (error)
1354 return error;
1355
1356 return 0;
1357 }
1358
1359 static int mxt_get_info(struct mxt_data *data)
1360 {
1361 struct i2c_client *client = data->client;
1362 struct mxt_info *info = &data->info;
1363 int error;
1364
1365 /* Read 7-byte info block starting at address 0 */
1366 error = __mxt_read_reg(client, MXT_INFO, sizeof(*info), info);
1367 if (error)
1368 return error;
1369
1370 return 0;
1371 }
1372
1373 static void mxt_free_object_table(struct mxt_data *data)
1374 {
1375 input_unregister_device(data->input_dev);
1376 data->input_dev = NULL;
1377
1378 kfree(data->object_table);
1379 data->object_table = NULL;
1380 kfree(data->msg_buf);
1381 data->msg_buf = NULL;
1382 data->T5_address = 0;
1383 data->T5_msg_size = 0;
1384 data->T6_reportid = 0;
1385 data->T7_address = 0;
1386 data->T9_reportid_min = 0;
1387 data->T9_reportid_max = 0;
1388 data->T19_reportid = 0;
1389 data->T44_address = 0;
1390 data->max_reportid = 0;
1391 }
1392
1393 static int mxt_get_object_table(struct mxt_data *data)
1394 {
1395 struct i2c_client *client = data->client;
1396 size_t table_size;
1397 struct mxt_object *object_table;
1398 int error;
1399 int i;
1400 u8 reportid;
1401 u16 end_address;
1402
1403 table_size = data->info.object_num * sizeof(struct mxt_object);
1404 object_table = kzalloc(table_size, GFP_KERNEL);
1405 if (!object_table) {
1406 dev_err(&data->client->dev, "Failed to allocate memory\n");
1407 return -ENOMEM;
1408 }
1409
1410 error = __mxt_read_reg(client, MXT_OBJECT_START, table_size,
1411 object_table);
1412 if (error) {
1413 kfree(object_table);
1414 return error;
1415 }
1416
1417 /* Valid Report IDs start counting from 1 */
1418 reportid = 1;
1419 data->mem_size = 0;
1420 for (i = 0; i < data->info.object_num; i++) {
1421 struct mxt_object *object = object_table + i;
1422 u8 min_id, max_id;
1423
1424 le16_to_cpus(&object->start_address);
1425
1426 if (object->num_report_ids) {
1427 min_id = reportid;
1428 reportid += object->num_report_ids *
1429 mxt_obj_instances(object);
1430 max_id = reportid - 1;
1431 } else {
1432 min_id = 0;
1433 max_id = 0;
1434 }
1435
1436 dev_dbg(&data->client->dev,
1437 "T%u Start:%u Size:%zu Instances:%zu Report IDs:%u-%u\n",
1438 object->type, object->start_address,
1439 mxt_obj_size(object), mxt_obj_instances(object),
1440 min_id, max_id);
1441
1442 switch (object->type) {
1443 case MXT_GEN_MESSAGE_T5:
1444 if (data->info.family_id == 0x80 &&
1445 data->info.version < 0x20) {
1446 /*
1447 * On mXT224 firmware versions prior to V2.0
1448 * read and discard unused CRC byte otherwise
1449 * DMA reads are misaligned.
1450 */
1451 data->T5_msg_size = mxt_obj_size(object);
1452 } else {
1453 /* CRC not enabled, so skip last byte */
1454 data->T5_msg_size = mxt_obj_size(object) - 1;
1455 }
1456 data->T5_address = object->start_address;
1457 case MXT_GEN_COMMAND_T6:
1458 data->T6_reportid = min_id;
1459 data->T6_address = object->start_address;
1460 break;
1461 case MXT_GEN_POWER_T7:
1462 data->T7_address = object->start_address;
1463 break;
1464 case MXT_TOUCH_MULTI_T9:
1465 data->T9_reportid_min = min_id;
1466 data->T9_reportid_max = max_id;
1467 data->num_touchids = object->num_report_ids
1468 * mxt_obj_instances(object);
1469 break;
1470 case MXT_SPT_MESSAGECOUNT_T44:
1471 data->T44_address = object->start_address;
1472 break;
1473 case MXT_SPT_GPIOPWM_T19:
1474 data->T19_reportid = min_id;
1475 break;
1476 }
1477
1478 end_address = object->start_address
1479 + mxt_obj_size(object) * mxt_obj_instances(object) - 1;
1480
1481 if (end_address >= data->mem_size)
1482 data->mem_size = end_address + 1;
1483 }
1484
1485 /* Store maximum reportid */
1486 data->max_reportid = reportid;
1487
1488 /* If T44 exists, T5 position has to be directly after */
1489 if (data->T44_address && (data->T5_address != data->T44_address + 1)) {
1490 dev_err(&client->dev, "Invalid T44 position\n");
1491 error = -EINVAL;
1492 goto free_object_table;
1493 }
1494
1495 data->msg_buf = kcalloc(data->max_reportid,
1496 data->T5_msg_size, GFP_KERNEL);
1497 if (!data->msg_buf) {
1498 dev_err(&client->dev, "Failed to allocate message buffer\n");
1499 error = -ENOMEM;
1500 goto free_object_table;
1501 }
1502
1503 data->object_table = object_table;
1504
1505 return 0;
1506
1507 free_object_table:
1508 mxt_free_object_table(data);
1509 return error;
1510 }
1511
1512 static int mxt_read_t9_resolution(struct mxt_data *data)
1513 {
1514 struct i2c_client *client = data->client;
1515 int error;
1516 struct t9_range range;
1517 unsigned char orient;
1518 struct mxt_object *object;
1519
1520 object = mxt_get_object(data, MXT_TOUCH_MULTI_T9);
1521 if (!object)
1522 return -EINVAL;
1523
1524 error = __mxt_read_reg(client,
1525 object->start_address + MXT_T9_RANGE,
1526 sizeof(range), &range);
1527 if (error)
1528 return error;
1529
1530 le16_to_cpus(&range.x);
1531 le16_to_cpus(&range.y);
1532
1533 error = __mxt_read_reg(client,
1534 object->start_address + MXT_T9_ORIENT,
1535 1, &orient);
1536 if (error)
1537 return error;
1538
1539 /* Handle default values */
1540 if (range.x == 0)
1541 range.x = 1023;
1542
1543 if (range.y == 0)
1544 range.y = 1023;
1545
1546 if (orient & MXT_T9_ORIENT_SWITCH) {
1547 data->max_x = range.y;
1548 data->max_y = range.x;
1549 } else {
1550 data->max_x = range.x;
1551 data->max_y = range.y;
1552 }
1553
1554 dev_dbg(&client->dev,
1555 "Touchscreen size X%uY%u\n", data->max_x, data->max_y);
1556
1557 return 0;
1558 }
1559
1560 static int mxt_input_open(struct input_dev *dev);
1561 static void mxt_input_close(struct input_dev *dev);
1562
1563 static int mxt_initialize_t9_input_device(struct mxt_data *data)
1564 {
1565 struct device *dev = &data->client->dev;
1566 const struct mxt_platform_data *pdata = data->pdata;
1567 struct input_dev *input_dev;
1568 int error;
1569 unsigned int num_mt_slots;
1570 unsigned int mt_flags = 0;
1571 int i;
1572
1573 error = mxt_read_t9_resolution(data);
1574 if (error)
1575 dev_warn(dev, "Failed to initialize T9 resolution\n");
1576
1577 input_dev = input_allocate_device();
1578 if (!input_dev) {
1579 dev_err(dev, "Failed to allocate memory\n");
1580 return -ENOMEM;
1581 }
1582
1583 input_dev->name = "Atmel maXTouch Touchscreen";
1584 input_dev->phys = data->phys;
1585 input_dev->id.bustype = BUS_I2C;
1586 input_dev->dev.parent = dev;
1587 input_dev->open = mxt_input_open;
1588 input_dev->close = mxt_input_close;
1589
1590 __set_bit(EV_ABS, input_dev->evbit);
1591 __set_bit(EV_KEY, input_dev->evbit);
1592 __set_bit(BTN_TOUCH, input_dev->keybit);
1593
1594 if (pdata->t19_num_keys) {
1595 __set_bit(INPUT_PROP_BUTTONPAD, input_dev->propbit);
1596
1597 for (i = 0; i < pdata->t19_num_keys; i++)
1598 if (pdata->t19_keymap[i] != KEY_RESERVED)
1599 input_set_capability(input_dev, EV_KEY,
1600 pdata->t19_keymap[i]);
1601
1602 mt_flags |= INPUT_MT_POINTER;
1603
1604 input_abs_set_res(input_dev, ABS_X, MXT_PIXELS_PER_MM);
1605 input_abs_set_res(input_dev, ABS_Y, MXT_PIXELS_PER_MM);
1606 input_abs_set_res(input_dev, ABS_MT_POSITION_X,
1607 MXT_PIXELS_PER_MM);
1608 input_abs_set_res(input_dev, ABS_MT_POSITION_Y,
1609 MXT_PIXELS_PER_MM);
1610
1611 input_dev->name = "Atmel maXTouch Touchpad";
1612 }
1613
1614 /* For single touch */
1615 input_set_abs_params(input_dev, ABS_X,
1616 0, data->max_x, 0, 0);
1617 input_set_abs_params(input_dev, ABS_Y,
1618 0, data->max_y, 0, 0);
1619 input_set_abs_params(input_dev, ABS_PRESSURE,
1620 0, 255, 0, 0);
1621
1622 /* For multi touch */
1623 num_mt_slots = data->T9_reportid_max - data->T9_reportid_min + 1;
1624 error = input_mt_init_slots(input_dev, num_mt_slots, mt_flags);
1625 if (error) {
1626 dev_err(dev, "Error %d initialising slots\n", error);
1627 goto err_free_mem;
1628 }
1629
1630 input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR,
1631 0, MXT_MAX_AREA, 0, 0);
1632 input_set_abs_params(input_dev, ABS_MT_POSITION_X,
1633 0, data->max_x, 0, 0);
1634 input_set_abs_params(input_dev, ABS_MT_POSITION_Y,
1635 0, data->max_y, 0, 0);
1636 input_set_abs_params(input_dev, ABS_MT_PRESSURE,
1637 0, 255, 0, 0);
1638
1639 input_set_drvdata(input_dev, data);
1640
1641 error = input_register_device(input_dev);
1642 if (error) {
1643 dev_err(dev, "Error %d registering input device\n", error);
1644 goto err_free_mem;
1645 }
1646
1647 data->input_dev = input_dev;
1648
1649 return 0;
1650
1651 err_free_mem:
1652 input_free_device(input_dev);
1653 return error;
1654 }
1655
1656 static int mxt_configure_objects(struct mxt_data *data,
1657 const struct firmware *cfg);
1658
1659 static void mxt_config_cb(const struct firmware *cfg, void *ctx)
1660 {
1661 mxt_configure_objects(ctx, cfg);
1662 release_firmware(cfg);
1663 }
1664
1665 static int mxt_initialize(struct mxt_data *data)
1666 {
1667 struct i2c_client *client = data->client;
1668 int recovery_attempts = 0;
1669 int error;
1670
1671 while (1) {
1672 error = mxt_get_info(data);
1673 if (!error)
1674 break;
1675
1676 /* Check bootloader state */
1677 error = mxt_probe_bootloader(data, false);
1678 if (error) {
1679 dev_info(&client->dev, "Trying alternate bootloader address\n");
1680 error = mxt_probe_bootloader(data, true);
1681 if (error) {
1682 /* Chip is not in appmode or bootloader mode */
1683 return error;
1684 }
1685 }
1686
1687 /* OK, we are in bootloader, see if we can recover */
1688 if (++recovery_attempts > 1) {
1689 dev_err(&client->dev, "Could not recover from bootloader mode\n");
1690 /*
1691 * We can reflash from this state, so do not
1692 * abort initialization.
1693 */
1694 data->in_bootloader = true;
1695 return 0;
1696 }
1697
1698 /* Attempt to exit bootloader into app mode */
1699 mxt_send_bootloader_cmd(data, false);
1700 msleep(MXT_FW_RESET_TIME);
1701 }
1702
1703 /* Get object table information */
1704 error = mxt_get_object_table(data);
1705 if (error) {
1706 dev_err(&client->dev, "Error %d reading object table\n", error);
1707 return error;
1708 }
1709
1710 mxt_acquire_irq(data);
1711 if (error)
1712 goto err_free_object_table;
1713
1714 error = request_firmware_nowait(THIS_MODULE, true, MXT_CFG_NAME,
1715 &client->dev, GFP_KERNEL, data,
1716 mxt_config_cb);
1717 if (error) {
1718 dev_err(&client->dev, "Failed to invoke firmware loader: %d\n",
1719 error);
1720 goto err_free_object_table;
1721 }
1722
1723 return 0;
1724
1725 err_free_object_table:
1726 mxt_free_object_table(data);
1727 return error;
1728 }
1729
1730 static int mxt_set_t7_power_cfg(struct mxt_data *data, u8 sleep)
1731 {
1732 struct device *dev = &data->client->dev;
1733 int error;
1734 struct t7_config *new_config;
1735 struct t7_config deepsleep = { .active = 0, .idle = 0 };
1736
1737 if (sleep == MXT_POWER_CFG_DEEPSLEEP)
1738 new_config = &deepsleep;
1739 else
1740 new_config = &data->t7_cfg;
1741
1742 error = __mxt_write_reg(data->client, data->T7_address,
1743 sizeof(data->t7_cfg), new_config);
1744 if (error)
1745 return error;
1746
1747 dev_dbg(dev, "Set T7 ACTV:%d IDLE:%d\n",
1748 new_config->active, new_config->idle);
1749
1750 return 0;
1751 }
1752
1753 static int mxt_init_t7_power_cfg(struct mxt_data *data)
1754 {
1755 struct device *dev = &data->client->dev;
1756 int error;
1757 bool retry = false;
1758
1759 recheck:
1760 error = __mxt_read_reg(data->client, data->T7_address,
1761 sizeof(data->t7_cfg), &data->t7_cfg);
1762 if (error)
1763 return error;
1764
1765 if (data->t7_cfg.active == 0 || data->t7_cfg.idle == 0) {
1766 if (!retry) {
1767 dev_dbg(dev, "T7 cfg zero, resetting\n");
1768 mxt_soft_reset(data);
1769 retry = true;
1770 goto recheck;
1771 } else {
1772 dev_dbg(dev, "T7 cfg zero after reset, overriding\n");
1773 data->t7_cfg.active = 20;
1774 data->t7_cfg.idle = 100;
1775 return mxt_set_t7_power_cfg(data, MXT_POWER_CFG_RUN);
1776 }
1777 }
1778
1779 dev_dbg(dev, "Initialized power cfg: ACTV %d, IDLE %d\n",
1780 data->t7_cfg.active, data->t7_cfg.idle);
1781 return 0;
1782 }
1783
1784 static int mxt_configure_objects(struct mxt_data *data,
1785 const struct firmware *cfg)
1786 {
1787 struct device *dev = &data->client->dev;
1788 struct mxt_info *info = &data->info;
1789 int error;
1790
1791 if (cfg) {
1792 error = mxt_update_cfg(data, cfg);
1793 if (error)
1794 dev_warn(dev, "Error %d updating config\n", error);
1795 }
1796
1797 error = mxt_init_t7_power_cfg(data);
1798 if (error) {
1799 dev_err(dev, "Failed to initialize power cfg\n");
1800 return error;
1801 }
1802
1803 error = mxt_initialize_t9_input_device(data);
1804 if (error)
1805 return error;
1806
1807 dev_info(dev,
1808 "Family: %u Variant: %u Firmware V%u.%u.%02X Objects: %u\n",
1809 info->family_id, info->variant_id, info->version >> 4,
1810 info->version & 0xf, info->build, info->object_num);
1811
1812 return 0;
1813 }
1814
1815 /* Firmware Version is returned as Major.Minor.Build */
1816 static ssize_t mxt_fw_version_show(struct device *dev,
1817 struct device_attribute *attr, char *buf)
1818 {
1819 struct mxt_data *data = dev_get_drvdata(dev);
1820 struct mxt_info *info = &data->info;
1821 return scnprintf(buf, PAGE_SIZE, "%u.%u.%02X\n",
1822 info->version >> 4, info->version & 0xf, info->build);
1823 }
1824
1825 /* Hardware Version is returned as FamilyID.VariantID */
1826 static ssize_t mxt_hw_version_show(struct device *dev,
1827 struct device_attribute *attr, char *buf)
1828 {
1829 struct mxt_data *data = dev_get_drvdata(dev);
1830 struct mxt_info *info = &data->info;
1831 return scnprintf(buf, PAGE_SIZE, "%u.%u\n",
1832 info->family_id, info->variant_id);
1833 }
1834
1835 static ssize_t mxt_show_instance(char *buf, int count,
1836 struct mxt_object *object, int instance,
1837 const u8 *val)
1838 {
1839 int i;
1840
1841 if (mxt_obj_instances(object) > 1)
1842 count += scnprintf(buf + count, PAGE_SIZE - count,
1843 "Instance %u\n", instance);
1844
1845 for (i = 0; i < mxt_obj_size(object); i++)
1846 count += scnprintf(buf + count, PAGE_SIZE - count,
1847 "\t[%2u]: %02x (%d)\n", i, val[i], val[i]);
1848 count += scnprintf(buf + count, PAGE_SIZE - count, "\n");
1849
1850 return count;
1851 }
1852
1853 static ssize_t mxt_object_show(struct device *dev,
1854 struct device_attribute *attr, char *buf)
1855 {
1856 struct mxt_data *data = dev_get_drvdata(dev);
1857 struct mxt_object *object;
1858 int count = 0;
1859 int i, j;
1860 int error;
1861 u8 *obuf;
1862
1863 /* Pre-allocate buffer large enough to hold max sized object. */
1864 obuf = kmalloc(256, GFP_KERNEL);
1865 if (!obuf)
1866 return -ENOMEM;
1867
1868 error = 0;
1869 for (i = 0; i < data->info.object_num; i++) {
1870 object = data->object_table + i;
1871
1872 if (!mxt_object_readable(object->type))
1873 continue;
1874
1875 count += scnprintf(buf + count, PAGE_SIZE - count,
1876 "T%u:\n", object->type);
1877
1878 for (j = 0; j < mxt_obj_instances(object); j++) {
1879 u16 size = mxt_obj_size(object);
1880 u16 addr = object->start_address + j * size;
1881
1882 error = __mxt_read_reg(data->client, addr, size, obuf);
1883 if (error)
1884 goto done;
1885
1886 count = mxt_show_instance(buf, count, object, j, obuf);
1887 }
1888 }
1889
1890 done:
1891 kfree(obuf);
1892 return error ?: count;
1893 }
1894
1895 static int mxt_check_firmware_format(struct device *dev,
1896 const struct firmware *fw)
1897 {
1898 unsigned int pos = 0;
1899 char c;
1900
1901 while (pos < fw->size) {
1902 c = *(fw->data + pos);
1903
1904 if (c < '0' || (c > '9' && c < 'A') || c > 'F')
1905 return 0;
1906
1907 pos++;
1908 }
1909
1910 /*
1911 * To convert file try:
1912 * xxd -r -p mXTXXX__APP_VX-X-XX.enc > maxtouch.fw
1913 */
1914 dev_err(dev, "Aborting: firmware file must be in binary format\n");
1915
1916 return -EINVAL;
1917 }
1918
1919 static int mxt_load_fw(struct device *dev, const char *fn)
1920 {
1921 struct mxt_data *data = dev_get_drvdata(dev);
1922 const struct firmware *fw = NULL;
1923 unsigned int frame_size;
1924 unsigned int pos = 0;
1925 unsigned int retry = 0;
1926 unsigned int frame = 0;
1927 int ret;
1928
1929 ret = request_firmware(&fw, fn, dev);
1930 if (ret) {
1931 dev_err(dev, "Unable to open firmware %s\n", fn);
1932 return ret;
1933 }
1934
1935 /* Check for incorrect enc file */
1936 ret = mxt_check_firmware_format(dev, fw);
1937 if (ret)
1938 goto release_firmware;
1939
1940 if (!data->in_bootloader) {
1941 /* Change to the bootloader mode */
1942 data->in_bootloader = true;
1943
1944 ret = mxt_t6_command(data, MXT_COMMAND_RESET,
1945 MXT_BOOT_VALUE, false);
1946 if (ret)
1947 goto release_firmware;
1948
1949 msleep(MXT_RESET_TIME);
1950
1951 /* Do not need to scan since we know family ID */
1952 ret = mxt_lookup_bootloader_address(data, 0);
1953 if (ret)
1954 goto release_firmware;
1955 } else {
1956 enable_irq(data->irq);
1957 }
1958
1959 mxt_free_object_table(data);
1960 reinit_completion(&data->bl_completion);
1961
1962 ret = mxt_check_bootloader(data, MXT_WAITING_BOOTLOAD_CMD, false);
1963 if (ret) {
1964 /* Bootloader may still be unlocked from previous attempt */
1965 ret = mxt_check_bootloader(data, MXT_WAITING_FRAME_DATA, false);
1966 if (ret)
1967 goto disable_irq;
1968 } else {
1969 dev_info(dev, "Unlocking bootloader\n");
1970
1971 /* Unlock bootloader */
1972 ret = mxt_send_bootloader_cmd(data, true);
1973 if (ret)
1974 goto disable_irq;
1975 }
1976
1977 while (pos < fw->size) {
1978 ret = mxt_check_bootloader(data, MXT_WAITING_FRAME_DATA, true);
1979 if (ret)
1980 goto disable_irq;
1981
1982 frame_size = ((*(fw->data + pos) << 8) | *(fw->data + pos + 1));
1983
1984 /* Take account of CRC bytes */
1985 frame_size += 2;
1986
1987 /* Write one frame to device */
1988 ret = mxt_bootloader_write(data, fw->data + pos, frame_size);
1989 if (ret)
1990 goto disable_irq;
1991
1992 ret = mxt_check_bootloader(data, MXT_FRAME_CRC_PASS, true);
1993 if (ret) {
1994 retry++;
1995
1996 /* Back off by 20ms per retry */
1997 msleep(retry * 20);
1998
1999 if (retry > 20) {
2000 dev_err(dev, "Retry count exceeded\n");
2001 goto disable_irq;
2002 }
2003 } else {
2004 retry = 0;
2005 pos += frame_size;
2006 frame++;
2007 }
2008
2009 if (frame % 50 == 0)
2010 dev_dbg(dev, "Sent %d frames, %d/%zd bytes\n",
2011 frame, pos, fw->size);
2012 }
2013
2014 /* Wait for flash. */
2015 ret = mxt_wait_for_completion(data, &data->bl_completion,
2016 MXT_FW_RESET_TIME);
2017 if (ret)
2018 goto disable_irq;
2019
2020 dev_dbg(dev, "Sent %d frames, %d bytes\n", frame, pos);
2021
2022 /*
2023 * Wait for device to reset. Some bootloader versions do not assert
2024 * the CHG line after bootloading has finished, so ignore potential
2025 * errors.
2026 */
2027 mxt_wait_for_completion(data, &data->bl_completion, MXT_FW_RESET_TIME);
2028
2029 data->in_bootloader = false;
2030
2031 disable_irq:
2032 disable_irq(data->irq);
2033 release_firmware:
2034 release_firmware(fw);
2035 return ret;
2036 }
2037
2038 static ssize_t mxt_update_fw_store(struct device *dev,
2039 struct device_attribute *attr,
2040 const char *buf, size_t count)
2041 {
2042 struct mxt_data *data = dev_get_drvdata(dev);
2043 int error;
2044
2045 error = mxt_load_fw(dev, MXT_FW_NAME);
2046 if (error) {
2047 dev_err(dev, "The firmware update failed(%d)\n", error);
2048 count = error;
2049 } else {
2050 dev_info(dev, "The firmware update succeeded\n");
2051
2052 error = mxt_initialize(data);
2053 if (error)
2054 return error;
2055 }
2056
2057 return count;
2058 }
2059
2060 static DEVICE_ATTR(fw_version, S_IRUGO, mxt_fw_version_show, NULL);
2061 static DEVICE_ATTR(hw_version, S_IRUGO, mxt_hw_version_show, NULL);
2062 static DEVICE_ATTR(object, S_IRUGO, mxt_object_show, NULL);
2063 static DEVICE_ATTR(update_fw, S_IWUSR, NULL, mxt_update_fw_store);
2064
2065 static struct attribute *mxt_attrs[] = {
2066 &dev_attr_fw_version.attr,
2067 &dev_attr_hw_version.attr,
2068 &dev_attr_object.attr,
2069 &dev_attr_update_fw.attr,
2070 NULL
2071 };
2072
2073 static const struct attribute_group mxt_attr_group = {
2074 .attrs = mxt_attrs,
2075 };
2076
2077 static void mxt_start(struct mxt_data *data)
2078 {
2079 mxt_set_t7_power_cfg(data, MXT_POWER_CFG_RUN);
2080
2081 /* Recalibrate since chip has been in deep sleep */
2082 mxt_t6_command(data, MXT_COMMAND_CALIBRATE, 1, false);
2083 }
2084
2085 static void mxt_stop(struct mxt_data *data)
2086 {
2087 mxt_set_t7_power_cfg(data, MXT_POWER_CFG_DEEPSLEEP);
2088 }
2089
2090 static int mxt_input_open(struct input_dev *dev)
2091 {
2092 struct mxt_data *data = input_get_drvdata(dev);
2093
2094 mxt_start(data);
2095
2096 return 0;
2097 }
2098
2099 static void mxt_input_close(struct input_dev *dev)
2100 {
2101 struct mxt_data *data = input_get_drvdata(dev);
2102
2103 mxt_stop(data);
2104 }
2105
2106 #ifdef CONFIG_OF
2107 static struct mxt_platform_data *mxt_parse_dt(struct i2c_client *client)
2108 {
2109 struct mxt_platform_data *pdata;
2110 u32 *keymap;
2111 u32 keycode;
2112 int proplen, i, ret;
2113
2114 if (!client->dev.of_node)
2115 return ERR_PTR(-ENODEV);
2116
2117 pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
2118 if (!pdata)
2119 return ERR_PTR(-ENOMEM);
2120
2121 if (of_find_property(client->dev.of_node, "linux,gpio-keymap",
2122 &proplen)) {
2123 pdata->t19_num_keys = proplen / sizeof(u32);
2124
2125 keymap = devm_kzalloc(&client->dev,
2126 pdata->t19_num_keys * sizeof(keymap[0]),
2127 GFP_KERNEL);
2128 if (!keymap)
2129 return ERR_PTR(-ENOMEM);
2130
2131 for (i = 0; i < pdata->t19_num_keys; i++) {
2132 ret = of_property_read_u32_index(client->dev.of_node,
2133 "linux,gpio-keymap", i, &keycode);
2134 if (ret)
2135 keycode = KEY_RESERVED;
2136
2137 keymap[i] = keycode;
2138 }
2139
2140 pdata->t19_keymap = keymap;
2141 }
2142
2143 return pdata;
2144 }
2145 #else
2146 static struct mxt_platform_data *mxt_parse_dt(struct i2c_client *client)
2147 {
2148 dev_dbg(&client->dev, "No platform data specified\n");
2149 return ERR_PTR(-EINVAL);
2150 }
2151 #endif
2152
2153 static int mxt_probe(struct i2c_client *client, const struct i2c_device_id *id)
2154 {
2155 struct mxt_data *data;
2156 const struct mxt_platform_data *pdata;
2157 int error;
2158
2159 pdata = dev_get_platdata(&client->dev);
2160 if (!pdata) {
2161 pdata = mxt_parse_dt(client);
2162 if (IS_ERR(pdata))
2163 return PTR_ERR(pdata);
2164 }
2165
2166 data = kzalloc(sizeof(struct mxt_data), GFP_KERNEL);
2167 if (!data) {
2168 dev_err(&client->dev, "Failed to allocate memory\n");
2169 return -ENOMEM;
2170 }
2171
2172 snprintf(data->phys, sizeof(data->phys), "i2c-%u-%04x/input0",
2173 client->adapter->nr, client->addr);
2174
2175 data->client = client;
2176 data->pdata = pdata;
2177 data->irq = client->irq;
2178 i2c_set_clientdata(client, data);
2179
2180 init_completion(&data->bl_completion);
2181 init_completion(&data->reset_completion);
2182 init_completion(&data->crc_completion);
2183
2184 error = request_threaded_irq(client->irq, NULL, mxt_interrupt,
2185 pdata->irqflags | IRQF_ONESHOT,
2186 client->name, data);
2187 if (error) {
2188 dev_err(&client->dev, "Failed to register interrupt\n");
2189 goto err_free_mem;
2190 }
2191
2192 disable_irq(client->irq);
2193
2194 error = mxt_initialize(data);
2195 if (error)
2196 goto err_free_irq;
2197
2198 error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group);
2199 if (error) {
2200 dev_err(&client->dev, "Failure %d creating sysfs group\n",
2201 error);
2202 goto err_free_object;
2203 }
2204
2205 return 0;
2206
2207 err_free_object:
2208 mxt_free_object_table(data);
2209 err_free_irq:
2210 free_irq(client->irq, data);
2211 err_free_mem:
2212 kfree(data);
2213 return error;
2214 }
2215
2216 static int mxt_remove(struct i2c_client *client)
2217 {
2218 struct mxt_data *data = i2c_get_clientdata(client);
2219
2220 sysfs_remove_group(&client->dev.kobj, &mxt_attr_group);
2221 free_irq(data->irq, data);
2222 input_unregister_device(data->input_dev);
2223 mxt_free_object_table(data);
2224 kfree(data);
2225
2226 return 0;
2227 }
2228
2229 #ifdef CONFIG_PM_SLEEP
2230 static int mxt_suspend(struct device *dev)
2231 {
2232 struct i2c_client *client = to_i2c_client(dev);
2233 struct mxt_data *data = i2c_get_clientdata(client);
2234 struct input_dev *input_dev = data->input_dev;
2235
2236 mutex_lock(&input_dev->mutex);
2237
2238 if (input_dev->users)
2239 mxt_stop(data);
2240
2241 mutex_unlock(&input_dev->mutex);
2242
2243 return 0;
2244 }
2245
2246 static int mxt_resume(struct device *dev)
2247 {
2248 struct i2c_client *client = to_i2c_client(dev);
2249 struct mxt_data *data = i2c_get_clientdata(client);
2250 struct input_dev *input_dev = data->input_dev;
2251
2252 mutex_lock(&input_dev->mutex);
2253
2254 if (input_dev->users)
2255 mxt_start(data);
2256
2257 mutex_unlock(&input_dev->mutex);
2258
2259 return 0;
2260 }
2261 #endif
2262
2263 static SIMPLE_DEV_PM_OPS(mxt_pm_ops, mxt_suspend, mxt_resume);
2264
2265 static const struct of_device_id mxt_of_match[] = {
2266 { .compatible = "atmel,maxtouch", },
2267 {},
2268 };
2269 MODULE_DEVICE_TABLE(of, mxt_of_match);
2270
2271 static const struct i2c_device_id mxt_id[] = {
2272 { "qt602240_ts", 0 },
2273 { "atmel_mxt_ts", 0 },
2274 { "atmel_mxt_tp", 0 },
2275 { "mXT224", 0 },
2276 { }
2277 };
2278 MODULE_DEVICE_TABLE(i2c, mxt_id);
2279
2280 static struct i2c_driver mxt_driver = {
2281 .driver = {
2282 .name = "atmel_mxt_ts",
2283 .owner = THIS_MODULE,
2284 .of_match_table = of_match_ptr(mxt_of_match),
2285 .pm = &mxt_pm_ops,
2286 },
2287 .probe = mxt_probe,
2288 .remove = mxt_remove,
2289 .id_table = mxt_id,
2290 };
2291
2292 module_i2c_driver(mxt_driver);
2293
2294 /* Module information */
2295 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
2296 MODULE_DESCRIPTION("Atmel maXTouch Touchscreen driver");
2297 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.112205 seconds and 5 git commands to generate.