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