Commit fdf804210f297b7a114fa7a216c2ab65b0f693da
Committed by
Henrik Rydberg
1 parent
64464ae8e1
Exists in
smarc-l5.0.0_1.0.0-ga
and in
5 other branches
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"); |