atmel_mxt_ts.c 75 KB

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