atmel_mxt_ts.c 63 KB

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