Commit fdf804210f297b7a114fa7a216c2ab65b0f693da

Authored by Daniel Kurtz
Committed by Henrik Rydberg
1 parent 64464ae8e1

Input: atmel_mxt_ts - parse T6 reports

The normal messages sent after boot or NVRAM update are T6 reports,
containing a status, and the config memory checksum.  Parse them and dump
a useful info message.

This patch tested on an MXT224E.

Signed-off-by: Daniel Kurtz <djkurtz@chromium.org>
Signed-off-by: Henrik Rydberg <rydberg@euromail.se>

Showing 1 changed file with 19 additions and 4 deletions Inline Diff

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