12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239 |
- /*
- * Atmel maXTouch Touchscreen driver
- *
- * Copyright (C) 2010 Samsung Electronics Co.Ltd
- * Copyright (C) 2011-2014 Atmel Corporation
- * Copyright (C) 2012 Google, Inc.
- * Copyright (C) 2016 Zodiac Inflight Innovations
- *
- * Author: Joonyoung Shim <jy0922.shim@samsung.com>
- *
- * This program is free software; you can redistribute it and/or modify it
- * under the terms of the GNU General Public License as published by the
- * Free Software Foundation; either version 2 of the License, or (at your
- * option) any later version.
- *
- */
- #include <linux/acpi.h>
- #include <linux/dmi.h>
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/completion.h>
- #include <linux/delay.h>
- #include <linux/firmware.h>
- #include <linux/i2c.h>
- #include <linux/input/mt.h>
- #include <linux/interrupt.h>
- #include <linux/of.h>
- #include <linux/property.h>
- #include <linux/slab.h>
- #include <linux/gpio/consumer.h>
- #include <linux/property.h>
- #include <asm/unaligned.h>
- #include <media/v4l2-device.h>
- #include <media/v4l2-ioctl.h>
- #include <media/videobuf2-v4l2.h>
- #include <media/videobuf2-vmalloc.h>
- /* Firmware files */
- #define MXT_FW_NAME "maxtouch.fw"
- #define MXT_CFG_NAME "maxtouch.cfg"
- #define MXT_CFG_MAGIC "OBP_RAW V1"
- /* Registers */
- #define MXT_OBJECT_START 0x07
- #define MXT_OBJECT_SIZE 6
- #define MXT_INFO_CHECKSUM_SIZE 3
- #define MXT_MAX_BLOCK_WRITE 256
- /* Object types */
- #define MXT_DEBUG_DIAGNOSTIC_T37 37
- #define MXT_GEN_MESSAGE_T5 5
- #define MXT_GEN_COMMAND_T6 6
- #define MXT_GEN_POWER_T7 7
- #define MXT_GEN_ACQUIRE_T8 8
- #define MXT_GEN_DATASOURCE_T53 53
- #define MXT_TOUCH_MULTI_T9 9
- #define MXT_TOUCH_KEYARRAY_T15 15
- #define MXT_TOUCH_PROXIMITY_T23 23
- #define MXT_TOUCH_PROXKEY_T52 52
- #define MXT_PROCI_GRIPFACE_T20 20
- #define MXT_PROCG_NOISE_T22 22
- #define MXT_PROCI_ONETOUCH_T24 24
- #define MXT_PROCI_TWOTOUCH_T27 27
- #define MXT_PROCI_GRIP_T40 40
- #define MXT_PROCI_PALM_T41 41
- #define MXT_PROCI_TOUCHSUPPRESSION_T42 42
- #define MXT_PROCI_STYLUS_T47 47
- #define MXT_PROCG_NOISESUPPRESSION_T48 48
- #define MXT_SPT_COMMSCONFIG_T18 18
- #define MXT_SPT_GPIOPWM_T19 19
- #define MXT_SPT_SELFTEST_T25 25
- #define MXT_SPT_CTECONFIG_T28 28
- #define MXT_SPT_USERDATA_T38 38
- #define MXT_SPT_DIGITIZER_T43 43
- #define MXT_SPT_MESSAGECOUNT_T44 44
- #define MXT_SPT_CTECONFIG_T46 46
- #define MXT_SPT_DYNAMICCONFIGURATIONCONTAINER_T71 71
- #define MXT_TOUCH_MULTITOUCHSCREEN_T100 100
- /* MXT_GEN_MESSAGE_T5 object */
- #define MXT_RPTID_NOMSG 0xff
- /* MXT_GEN_COMMAND_T6 field */
- #define MXT_COMMAND_RESET 0
- #define MXT_COMMAND_BACKUPNV 1
- #define MXT_COMMAND_CALIBRATE 2
- #define MXT_COMMAND_REPORTALL 3
- #define MXT_COMMAND_DIAGNOSTIC 5
- /* Define for T6 status byte */
- #define MXT_T6_STATUS_RESET BIT(7)
- #define MXT_T6_STATUS_OFL BIT(6)
- #define MXT_T6_STATUS_SIGERR BIT(5)
- #define MXT_T6_STATUS_CAL BIT(4)
- #define MXT_T6_STATUS_CFGERR BIT(3)
- #define MXT_T6_STATUS_COMSERR BIT(2)
- /* MXT_GEN_POWER_T7 field */
- struct t7_config {
- u8 idle;
- u8 active;
- } __packed;
- #define MXT_POWER_CFG_RUN 0
- #define MXT_POWER_CFG_DEEPSLEEP 1
- /* MXT_TOUCH_MULTI_T9 field */
- #define MXT_T9_CTRL 0
- #define MXT_T9_XSIZE 3
- #define MXT_T9_YSIZE 4
- #define MXT_T9_ORIENT 9
- #define MXT_T9_RANGE 18
- /* MXT_TOUCH_MULTI_T9 status */
- #define MXT_T9_UNGRIP BIT(0)
- #define MXT_T9_SUPPRESS BIT(1)
- #define MXT_T9_AMP BIT(2)
- #define MXT_T9_VECTOR BIT(3)
- #define MXT_T9_MOVE BIT(4)
- #define MXT_T9_RELEASE BIT(5)
- #define MXT_T9_PRESS BIT(6)
- #define MXT_T9_DETECT BIT(7)
- struct t9_range {
- __le16 x;
- __le16 y;
- } __packed;
- /* MXT_TOUCH_MULTI_T9 orient */
- #define MXT_T9_ORIENT_SWITCH BIT(0)
- #define MXT_T9_ORIENT_INVERTX BIT(1)
- #define MXT_T9_ORIENT_INVERTY BIT(2)
- /* MXT_SPT_COMMSCONFIG_T18 */
- #define MXT_COMMS_CTRL 0
- #define MXT_COMMS_CMD 1
- /* MXT_DEBUG_DIAGNOSTIC_T37 */
- #define MXT_DIAGNOSTIC_PAGEUP 0x01
- #define MXT_DIAGNOSTIC_DELTAS 0x10
- #define MXT_DIAGNOSTIC_REFS 0x11
- #define MXT_DIAGNOSTIC_SIZE 128
- #define MXT_FAMILY_1386 160
- #define MXT1386_COLUMNS 3
- #define MXT1386_PAGES_PER_COLUMN 8
- struct t37_debug {
- #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
- u8 mode;
- u8 page;
- u8 data[MXT_DIAGNOSTIC_SIZE];
- #endif
- };
- /* Define for MXT_GEN_COMMAND_T6 */
- #define MXT_BOOT_VALUE 0xa5
- #define MXT_RESET_VALUE 0x01
- #define MXT_BACKUP_VALUE 0x55
- /* T100 Multiple Touch Touchscreen */
- #define MXT_T100_CTRL 0
- #define MXT_T100_CFG1 1
- #define MXT_T100_TCHAUX 3
- #define MXT_T100_XSIZE 9
- #define MXT_T100_XRANGE 13
- #define MXT_T100_YSIZE 20
- #define MXT_T100_YRANGE 24
- #define MXT_T100_CFG_SWITCHXY BIT(5)
- #define MXT_T100_CFG_INVERTY BIT(6)
- #define MXT_T100_CFG_INVERTX BIT(7)
- #define MXT_T100_TCHAUX_VECT BIT(0)
- #define MXT_T100_TCHAUX_AMPL BIT(1)
- #define MXT_T100_TCHAUX_AREA BIT(2)
- #define MXT_T100_DETECT BIT(7)
- #define MXT_T100_TYPE_MASK 0x70
- enum t100_type {
- MXT_T100_TYPE_FINGER = 1,
- MXT_T100_TYPE_PASSIVE_STYLUS = 2,
- MXT_T100_TYPE_HOVERING_FINGER = 4,
- MXT_T100_TYPE_GLOVE = 5,
- MXT_T100_TYPE_LARGE_TOUCH = 6,
- };
- #define MXT_DISTANCE_ACTIVE_TOUCH 0
- #define MXT_DISTANCE_HOVERING 1
- #define MXT_TOUCH_MAJOR_DEFAULT 1
- #define MXT_PRESSURE_DEFAULT 1
- /* Delay times */
- #define MXT_BACKUP_TIME 50 /* msec */
- #define MXT_RESET_GPIO_TIME 20 /* msec */
- #define MXT_RESET_INVALID_CHG 100 /* msec */
- #define MXT_RESET_TIME 200 /* msec */
- #define MXT_RESET_TIMEOUT 3000 /* msec */
- #define MXT_CRC_TIMEOUT 1000 /* msec */
- #define MXT_FW_RESET_TIME 3000 /* msec */
- #define MXT_FW_CHG_TIMEOUT 300 /* msec */
- /* Command to unlock bootloader */
- #define MXT_UNLOCK_CMD_MSB 0xaa
- #define MXT_UNLOCK_CMD_LSB 0xdc
- /* Bootloader mode status */
- #define MXT_WAITING_BOOTLOAD_CMD 0xc0 /* valid 7 6 bit only */
- #define MXT_WAITING_FRAME_DATA 0x80 /* valid 7 6 bit only */
- #define MXT_FRAME_CRC_CHECK 0x02
- #define MXT_FRAME_CRC_FAIL 0x03
- #define MXT_FRAME_CRC_PASS 0x04
- #define MXT_APP_CRC_FAIL 0x40 /* valid 7 8 bit only */
- #define MXT_BOOT_STATUS_MASK 0x3f
- #define MXT_BOOT_EXTENDED_ID BIT(5)
- #define MXT_BOOT_ID_MASK 0x1f
- /* Touchscreen absolute values */
- #define MXT_MAX_AREA 0xff
- #define MXT_PIXELS_PER_MM 20
- struct mxt_info {
- u8 family_id;
- u8 variant_id;
- u8 version;
- u8 build;
- u8 matrix_xsize;
- u8 matrix_ysize;
- u8 object_num;
- };
- struct mxt_object {
- u8 type;
- u16 start_address;
- u8 size_minus_one;
- u8 instances_minus_one;
- u8 num_report_ids;
- } __packed;
- struct mxt_dbg {
- u16 t37_address;
- u16 diag_cmd_address;
- struct t37_debug *t37_buf;
- unsigned int t37_pages;
- unsigned int t37_nodes;
- struct v4l2_device v4l2;
- struct v4l2_pix_format format;
- struct video_device vdev;
- struct vb2_queue queue;
- struct mutex lock;
- int input;
- };
- enum v4l_dbg_inputs {
- MXT_V4L_INPUT_DELTAS,
- MXT_V4L_INPUT_REFS,
- MXT_V4L_INPUT_MAX,
- };
- static const struct v4l2_file_operations mxt_video_fops = {
- .owner = THIS_MODULE,
- .open = v4l2_fh_open,
- .release = vb2_fop_release,
- .unlocked_ioctl = video_ioctl2,
- .read = vb2_fop_read,
- .mmap = vb2_fop_mmap,
- .poll = vb2_fop_poll,
- };
- enum mxt_suspend_mode {
- MXT_SUSPEND_DEEP_SLEEP = 0,
- MXT_SUSPEND_T9_CTRL = 1,
- };
- /* Config update context */
- struct mxt_cfg {
- u8 *raw;
- size_t raw_size;
- off_t raw_pos;
- u8 *mem;
- size_t mem_size;
- int start_ofs;
- struct mxt_info info;
- };
- /* Each client has this additional data */
- struct mxt_data {
- struct i2c_client *client;
- struct input_dev *input_dev;
- char phys[64]; /* device physical location */
- struct mxt_object *object_table;
- struct mxt_info *info;
- void *raw_info_block;
- unsigned int irq;
- unsigned int max_x;
- unsigned int max_y;
- bool invertx;
- bool inverty;
- bool xy_switch;
- u8 xsize;
- u8 ysize;
- bool in_bootloader;
- u16 mem_size;
- u8 t100_aux_ampl;
- u8 t100_aux_area;
- u8 t100_aux_vect;
- u8 max_reportid;
- u32 config_crc;
- u32 info_crc;
- u8 bootloader_addr;
- u8 *msg_buf;
- u8 t6_status;
- bool update_input;
- u8 last_message_count;
- u8 num_touchids;
- u8 multitouch;
- struct t7_config t7_cfg;
- struct mxt_dbg dbg;
- struct gpio_desc *reset_gpio;
- /* Cached parameters from object table */
- u16 T5_address;
- u8 T5_msg_size;
- u8 T6_reportid;
- u16 T6_address;
- u16 T7_address;
- u16 T71_address;
- u8 T9_reportid_min;
- u8 T9_reportid_max;
- u8 T19_reportid;
- u16 T44_address;
- u8 T100_reportid_min;
- u8 T100_reportid_max;
- /* for fw update in bootloader */
- struct completion bl_completion;
- /* for reset handling */
- struct completion reset_completion;
- /* for config update handling */
- struct completion crc_completion;
- u32 *t19_keymap;
- unsigned int t19_num_keys;
- enum mxt_suspend_mode suspend_mode;
- };
- struct mxt_vb2_buffer {
- struct vb2_buffer vb;
- struct list_head list;
- };
- static size_t mxt_obj_size(const struct mxt_object *obj)
- {
- return obj->size_minus_one + 1;
- }
- static size_t mxt_obj_instances(const struct mxt_object *obj)
- {
- return obj->instances_minus_one + 1;
- }
- static bool mxt_object_readable(unsigned int type)
- {
- switch (type) {
- case MXT_GEN_COMMAND_T6:
- case MXT_GEN_POWER_T7:
- case MXT_GEN_ACQUIRE_T8:
- case MXT_GEN_DATASOURCE_T53:
- case MXT_TOUCH_MULTI_T9:
- case MXT_TOUCH_KEYARRAY_T15:
- case MXT_TOUCH_PROXIMITY_T23:
- case MXT_TOUCH_PROXKEY_T52:
- case MXT_TOUCH_MULTITOUCHSCREEN_T100:
- case MXT_PROCI_GRIPFACE_T20:
- case MXT_PROCG_NOISE_T22:
- case MXT_PROCI_ONETOUCH_T24:
- case MXT_PROCI_TWOTOUCH_T27:
- case MXT_PROCI_GRIP_T40:
- case MXT_PROCI_PALM_T41:
- case MXT_PROCI_TOUCHSUPPRESSION_T42:
- case MXT_PROCI_STYLUS_T47:
- case MXT_PROCG_NOISESUPPRESSION_T48:
- case MXT_SPT_COMMSCONFIG_T18:
- case MXT_SPT_GPIOPWM_T19:
- case MXT_SPT_SELFTEST_T25:
- case MXT_SPT_CTECONFIG_T28:
- case MXT_SPT_USERDATA_T38:
- case MXT_SPT_DIGITIZER_T43:
- case MXT_SPT_CTECONFIG_T46:
- case MXT_SPT_DYNAMICCONFIGURATIONCONTAINER_T71:
- return true;
- default:
- return false;
- }
- }
- static void mxt_dump_message(struct mxt_data *data, u8 *message)
- {
- dev_dbg(&data->client->dev, "message: %*ph\n",
- data->T5_msg_size, message);
- }
- static int mxt_wait_for_completion(struct mxt_data *data,
- struct completion *comp,
- unsigned int timeout_ms)
- {
- struct device *dev = &data->client->dev;
- unsigned long timeout = msecs_to_jiffies(timeout_ms);
- long ret;
- ret = wait_for_completion_interruptible_timeout(comp, timeout);
- if (ret < 0) {
- return ret;
- } else if (ret == 0) {
- dev_err(dev, "Wait for completion timed out.\n");
- return -ETIMEDOUT;
- }
- return 0;
- }
- static int mxt_bootloader_read(struct mxt_data *data,
- u8 *val, unsigned int count)
- {
- int ret;
- struct i2c_msg msg;
- msg.addr = data->bootloader_addr;
- msg.flags = data->client->flags & I2C_M_TEN;
- msg.flags |= I2C_M_RD;
- msg.len = count;
- msg.buf = val;
- ret = i2c_transfer(data->client->adapter, &msg, 1);
- if (ret == 1) {
- ret = 0;
- } else {
- ret = ret < 0 ? ret : -EIO;
- dev_err(&data->client->dev, "%s: i2c recv failed (%d)\n",
- __func__, ret);
- }
- return ret;
- }
- static int mxt_bootloader_write(struct mxt_data *data,
- const u8 * const val, unsigned int count)
- {
- int ret;
- struct i2c_msg msg;
- msg.addr = data->bootloader_addr;
- msg.flags = data->client->flags & I2C_M_TEN;
- msg.len = count;
- msg.buf = (u8 *)val;
- ret = i2c_transfer(data->client->adapter, &msg, 1);
- if (ret == 1) {
- ret = 0;
- } else {
- ret = ret < 0 ? ret : -EIO;
- dev_err(&data->client->dev, "%s: i2c send failed (%d)\n",
- __func__, ret);
- }
- return ret;
- }
- static int mxt_lookup_bootloader_address(struct mxt_data *data, bool retry)
- {
- u8 appmode = data->client->addr;
- u8 bootloader;
- u8 family_id = data->info ? data->info->family_id : 0;
- switch (appmode) {
- case 0x4a:
- case 0x4b:
- /* Chips after 1664S use different scheme */
- if (retry || family_id >= 0xa2) {
- bootloader = appmode - 0x24;
- break;
- }
- /* Fall through for normal case */
- case 0x4c:
- case 0x4d:
- case 0x5a:
- case 0x5b:
- bootloader = appmode - 0x26;
- break;
- default:
- dev_err(&data->client->dev,
- "Appmode i2c address 0x%02x not found\n",
- appmode);
- return -EINVAL;
- }
- data->bootloader_addr = bootloader;
- return 0;
- }
- static int mxt_probe_bootloader(struct mxt_data *data, bool alt_address)
- {
- struct device *dev = &data->client->dev;
- int error;
- u8 val;
- bool crc_failure;
- error = mxt_lookup_bootloader_address(data, alt_address);
- if (error)
- return error;
- error = mxt_bootloader_read(data, &val, 1);
- if (error)
- return error;
- /* Check app crc fail mode */
- crc_failure = (val & ~MXT_BOOT_STATUS_MASK) == MXT_APP_CRC_FAIL;
- dev_err(dev, "Detected bootloader, status:%02X%s\n",
- val, crc_failure ? ", APP_CRC_FAIL" : "");
- return 0;
- }
- static u8 mxt_get_bootloader_version(struct mxt_data *data, u8 val)
- {
- struct device *dev = &data->client->dev;
- u8 buf[3];
- if (val & MXT_BOOT_EXTENDED_ID) {
- if (mxt_bootloader_read(data, &buf[0], 3) != 0) {
- dev_err(dev, "%s: i2c failure\n", __func__);
- return val;
- }
- dev_dbg(dev, "Bootloader ID:%d Version:%d\n", buf[1], buf[2]);
- return buf[0];
- } else {
- dev_dbg(dev, "Bootloader ID:%d\n", val & MXT_BOOT_ID_MASK);
- return val;
- }
- }
- static int mxt_check_bootloader(struct mxt_data *data, unsigned int state,
- bool wait)
- {
- struct device *dev = &data->client->dev;
- u8 val;
- int ret;
- recheck:
- if (wait) {
- /*
- * In application update mode, the interrupt
- * line signals state transitions. We must wait for the
- * CHG assertion before reading the status byte.
- * Once the status byte has been read, the line is deasserted.
- */
- ret = mxt_wait_for_completion(data, &data->bl_completion,
- MXT_FW_CHG_TIMEOUT);
- if (ret) {
- /*
- * TODO: handle -ERESTARTSYS better by terminating
- * fw update process before returning to userspace
- * by writing length 0x000 to device (iff we are in
- * WAITING_FRAME_DATA state).
- */
- dev_err(dev, "Update wait error %d\n", ret);
- return ret;
- }
- }
- ret = mxt_bootloader_read(data, &val, 1);
- if (ret)
- return ret;
- if (state == MXT_WAITING_BOOTLOAD_CMD)
- val = mxt_get_bootloader_version(data, val);
- switch (state) {
- case MXT_WAITING_BOOTLOAD_CMD:
- case MXT_WAITING_FRAME_DATA:
- case MXT_APP_CRC_FAIL:
- val &= ~MXT_BOOT_STATUS_MASK;
- break;
- case MXT_FRAME_CRC_PASS:
- if (val == MXT_FRAME_CRC_CHECK) {
- goto recheck;
- } else if (val == MXT_FRAME_CRC_FAIL) {
- dev_err(dev, "Bootloader CRC fail\n");
- return -EINVAL;
- }
- break;
- default:
- return -EINVAL;
- }
- if (val != state) {
- dev_err(dev, "Invalid bootloader state %02X != %02X\n",
- val, state);
- return -EINVAL;
- }
- return 0;
- }
- static int mxt_send_bootloader_cmd(struct mxt_data *data, bool unlock)
- {
- int ret;
- u8 buf[2];
- if (unlock) {
- buf[0] = MXT_UNLOCK_CMD_LSB;
- buf[1] = MXT_UNLOCK_CMD_MSB;
- } else {
- buf[0] = 0x01;
- buf[1] = 0x01;
- }
- ret = mxt_bootloader_write(data, buf, 2);
- if (ret)
- return ret;
- return 0;
- }
- static int __mxt_read_reg(struct i2c_client *client,
- u16 reg, u16 len, void *val)
- {
- struct i2c_msg xfer[2];
- u8 buf[2];
- int ret;
- buf[0] = reg & 0xff;
- buf[1] = (reg >> 8) & 0xff;
- /* Write register */
- xfer[0].addr = client->addr;
- xfer[0].flags = 0;
- xfer[0].len = 2;
- xfer[0].buf = buf;
- /* Read data */
- xfer[1].addr = client->addr;
- xfer[1].flags = I2C_M_RD;
- xfer[1].len = len;
- xfer[1].buf = val;
- ret = i2c_transfer(client->adapter, xfer, 2);
- if (ret == 2) {
- ret = 0;
- } else {
- if (ret >= 0)
- ret = -EIO;
- dev_err(&client->dev, "%s: i2c transfer failed (%d)\n",
- __func__, ret);
- }
- return ret;
- }
- static int __mxt_write_reg(struct i2c_client *client, u16 reg, u16 len,
- const void *val)
- {
- u8 *buf;
- size_t count;
- int ret;
- count = len + 2;
- buf = kmalloc(count, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- buf[0] = reg & 0xff;
- buf[1] = (reg >> 8) & 0xff;
- memcpy(&buf[2], val, len);
- ret = i2c_master_send(client, buf, count);
- if (ret == count) {
- ret = 0;
- } else {
- if (ret >= 0)
- ret = -EIO;
- dev_err(&client->dev, "%s: i2c send failed (%d)\n",
- __func__, ret);
- }
- kfree(buf);
- return ret;
- }
- static int mxt_write_reg(struct i2c_client *client, u16 reg, u8 val)
- {
- return __mxt_write_reg(client, reg, 1, &val);
- }
- static struct mxt_object *
- mxt_get_object(struct mxt_data *data, u8 type)
- {
- struct mxt_object *object;
- int i;
- for (i = 0; i < data->info->object_num; i++) {
- object = data->object_table + i;
- if (object->type == type)
- return object;
- }
- dev_warn(&data->client->dev, "Invalid object type T%u\n", type);
- return NULL;
- }
- static void mxt_proc_t6_messages(struct mxt_data *data, u8 *msg)
- {
- struct device *dev = &data->client->dev;
- u8 status = msg[1];
- u32 crc = msg[2] | (msg[3] << 8) | (msg[4] << 16);
- if (crc != data->config_crc) {
- data->config_crc = crc;
- dev_dbg(dev, "T6 Config Checksum: 0x%06X\n", crc);
- }
- complete(&data->crc_completion);
- /* Detect reset */
- if (status & MXT_T6_STATUS_RESET)
- complete(&data->reset_completion);
- /* Output debug if status has changed */
- if (status != data->t6_status)
- dev_dbg(dev, "T6 Status 0x%02X%s%s%s%s%s%s%s\n",
- status,
- status == 0 ? " OK" : "",
- status & MXT_T6_STATUS_RESET ? " RESET" : "",
- status & MXT_T6_STATUS_OFL ? " OFL" : "",
- status & MXT_T6_STATUS_SIGERR ? " SIGERR" : "",
- status & MXT_T6_STATUS_CAL ? " CAL" : "",
- status & MXT_T6_STATUS_CFGERR ? " CFGERR" : "",
- status & MXT_T6_STATUS_COMSERR ? " COMSERR" : "");
- /* Save current status */
- data->t6_status = status;
- }
- static int mxt_write_object(struct mxt_data *data,
- u8 type, u8 offset, u8 val)
- {
- struct mxt_object *object;
- u16 reg;
- object = mxt_get_object(data, type);
- if (!object || offset >= mxt_obj_size(object))
- return -EINVAL;
- reg = object->start_address;
- return mxt_write_reg(data->client, reg + offset, val);
- }
- static void mxt_input_button(struct mxt_data *data, u8 *message)
- {
- struct input_dev *input = data->input_dev;
- int i;
- for (i = 0; i < data->t19_num_keys; i++) {
- if (data->t19_keymap[i] == KEY_RESERVED)
- continue;
- /* Active-low switch */
- input_report_key(input, data->t19_keymap[i],
- !(message[1] & BIT(i)));
- }
- }
- static void mxt_input_sync(struct mxt_data *data)
- {
- input_mt_report_pointer_emulation(data->input_dev,
- data->t19_num_keys);
- input_sync(data->input_dev);
- }
- static void mxt_proc_t9_message(struct mxt_data *data, u8 *message)
- {
- struct device *dev = &data->client->dev;
- struct input_dev *input_dev = data->input_dev;
- int id;
- u8 status;
- int x;
- int y;
- int area;
- int amplitude;
- id = message[0] - data->T9_reportid_min;
- status = message[1];
- x = (message[2] << 4) | ((message[4] >> 4) & 0xf);
- y = (message[3] << 4) | ((message[4] & 0xf));
- /* Handle 10/12 bit switching */
- if (data->max_x < 1024)
- x >>= 2;
- if (data->max_y < 1024)
- y >>= 2;
- area = message[5];
- amplitude = message[6];
- dev_dbg(dev,
- "[%u] %c%c%c%c%c%c%c%c x: %5u y: %5u area: %3u amp: %3u\n",
- id,
- (status & MXT_T9_DETECT) ? 'D' : '.',
- (status & MXT_T9_PRESS) ? 'P' : '.',
- (status & MXT_T9_RELEASE) ? 'R' : '.',
- (status & MXT_T9_MOVE) ? 'M' : '.',
- (status & MXT_T9_VECTOR) ? 'V' : '.',
- (status & MXT_T9_AMP) ? 'A' : '.',
- (status & MXT_T9_SUPPRESS) ? 'S' : '.',
- (status & MXT_T9_UNGRIP) ? 'U' : '.',
- x, y, area, amplitude);
- input_mt_slot(input_dev, id);
- if (status & MXT_T9_DETECT) {
- /*
- * Multiple bits may be set if the host is slow to read
- * the status messages, indicating all the events that
- * have happened.
- */
- if (status & MXT_T9_RELEASE) {
- input_mt_report_slot_state(input_dev,
- MT_TOOL_FINGER, 0);
- mxt_input_sync(data);
- }
- /* if active, pressure must be non-zero */
- if (!amplitude)
- amplitude = MXT_PRESSURE_DEFAULT;
- /* Touch active */
- input_mt_report_slot_state(input_dev, MT_TOOL_FINGER, 1);
- input_report_abs(input_dev, ABS_MT_POSITION_X, x);
- input_report_abs(input_dev, ABS_MT_POSITION_Y, y);
- input_report_abs(input_dev, ABS_MT_PRESSURE, amplitude);
- input_report_abs(input_dev, ABS_MT_TOUCH_MAJOR, area);
- } else {
- /* Touch no longer active, close out slot */
- input_mt_report_slot_state(input_dev, MT_TOOL_FINGER, 0);
- }
- data->update_input = true;
- }
- static void mxt_proc_t100_message(struct mxt_data *data, u8 *message)
- {
- struct device *dev = &data->client->dev;
- struct input_dev *input_dev = data->input_dev;
- int id;
- u8 status;
- u8 type = 0;
- u16 x;
- u16 y;
- int distance = 0;
- int tool = 0;
- u8 major = 0;
- u8 pressure = 0;
- u8 orientation = 0;
- id = message[0] - data->T100_reportid_min - 2;
- /* ignore SCRSTATUS events */
- if (id < 0)
- return;
- status = message[1];
- x = get_unaligned_le16(&message[2]);
- y = get_unaligned_le16(&message[4]);
- if (status & MXT_T100_DETECT) {
- type = (status & MXT_T100_TYPE_MASK) >> 4;
- switch (type) {
- case MXT_T100_TYPE_HOVERING_FINGER:
- tool = MT_TOOL_FINGER;
- distance = MXT_DISTANCE_HOVERING;
- if (data->t100_aux_vect)
- orientation = message[data->t100_aux_vect];
- break;
- case MXT_T100_TYPE_FINGER:
- case MXT_T100_TYPE_GLOVE:
- tool = MT_TOOL_FINGER;
- distance = MXT_DISTANCE_ACTIVE_TOUCH;
- if (data->t100_aux_area)
- major = message[data->t100_aux_area];
- if (data->t100_aux_ampl)
- pressure = message[data->t100_aux_ampl];
- if (data->t100_aux_vect)
- orientation = message[data->t100_aux_vect];
- break;
- case MXT_T100_TYPE_PASSIVE_STYLUS:
- tool = MT_TOOL_PEN;
- /*
- * Passive stylus is reported with size zero so
- * hardcode.
- */
- major = MXT_TOUCH_MAJOR_DEFAULT;
- if (data->t100_aux_ampl)
- pressure = message[data->t100_aux_ampl];
- break;
- case MXT_T100_TYPE_LARGE_TOUCH:
- /* Ignore suppressed touch */
- break;
- default:
- dev_dbg(dev, "Unexpected T100 type\n");
- return;
- }
- }
- /*
- * Values reported should be non-zero if tool is touching the
- * device
- */
- if (!pressure && type != MXT_T100_TYPE_HOVERING_FINGER)
- pressure = MXT_PRESSURE_DEFAULT;
- input_mt_slot(input_dev, id);
- if (status & MXT_T100_DETECT) {
- dev_dbg(dev, "[%u] type:%u x:%u y:%u a:%02X p:%02X v:%02X\n",
- id, type, x, y, major, pressure, orientation);
- input_mt_report_slot_state(input_dev, tool, 1);
- input_report_abs(input_dev, ABS_MT_POSITION_X, x);
- input_report_abs(input_dev, ABS_MT_POSITION_Y, y);
- input_report_abs(input_dev, ABS_MT_TOUCH_MAJOR, major);
- input_report_abs(input_dev, ABS_MT_PRESSURE, pressure);
- input_report_abs(input_dev, ABS_MT_DISTANCE, distance);
- input_report_abs(input_dev, ABS_MT_ORIENTATION, orientation);
- } else {
- dev_dbg(dev, "[%u] release\n", id);
- /* close out slot */
- input_mt_report_slot_state(input_dev, 0, 0);
- }
- data->update_input = true;
- }
- static int mxt_proc_message(struct mxt_data *data, u8 *message)
- {
- u8 report_id = message[0];
- if (report_id == MXT_RPTID_NOMSG)
- return 0;
- if (report_id == data->T6_reportid) {
- mxt_proc_t6_messages(data, message);
- } else if (!data->input_dev) {
- /*
- * Do not report events if input device
- * is not yet registered.
- */
- mxt_dump_message(data, message);
- } else if (report_id >= data->T9_reportid_min &&
- report_id <= data->T9_reportid_max) {
- mxt_proc_t9_message(data, message);
- } else if (report_id >= data->T100_reportid_min &&
- report_id <= data->T100_reportid_max) {
- mxt_proc_t100_message(data, message);
- } else if (report_id == data->T19_reportid) {
- mxt_input_button(data, message);
- data->update_input = true;
- } else {
- mxt_dump_message(data, message);
- }
- return 1;
- }
- static int mxt_read_and_process_messages(struct mxt_data *data, u8 count)
- {
- struct device *dev = &data->client->dev;
- int ret;
- int i;
- u8 num_valid = 0;
- /* Safety check for msg_buf */
- if (count > data->max_reportid)
- return -EINVAL;
- /* Process remaining messages if necessary */
- ret = __mxt_read_reg(data->client, data->T5_address,
- data->T5_msg_size * count, data->msg_buf);
- if (ret) {
- dev_err(dev, "Failed to read %u messages (%d)\n", count, ret);
- return ret;
- }
- for (i = 0; i < count; i++) {
- ret = mxt_proc_message(data,
- data->msg_buf + data->T5_msg_size * i);
- if (ret == 1)
- num_valid++;
- }
- /* return number of messages read */
- return num_valid;
- }
- static irqreturn_t mxt_process_messages_t44(struct mxt_data *data)
- {
- struct device *dev = &data->client->dev;
- int ret;
- u8 count, num_left;
- /* Read T44 and T5 together */
- ret = __mxt_read_reg(data->client, data->T44_address,
- data->T5_msg_size + 1, data->msg_buf);
- if (ret) {
- dev_err(dev, "Failed to read T44 and T5 (%d)\n", ret);
- return IRQ_NONE;
- }
- count = data->msg_buf[0];
- /*
- * This condition may be caused by the CHG line being configured in
- * Mode 0. It results in unnecessary I2C operations but it is benign.
- */
- if (count == 0)
- return IRQ_NONE;
- if (count > data->max_reportid) {
- dev_warn(dev, "T44 count %d exceeded max report id\n", count);
- count = data->max_reportid;
- }
- /* Process first message */
- ret = mxt_proc_message(data, data->msg_buf + 1);
- if (ret < 0) {
- dev_warn(dev, "Unexpected invalid message\n");
- return IRQ_NONE;
- }
- num_left = count - 1;
- /* Process remaining messages if necessary */
- if (num_left) {
- ret = mxt_read_and_process_messages(data, num_left);
- if (ret < 0)
- goto end;
- else if (ret != num_left)
- dev_warn(dev, "Unexpected invalid message\n");
- }
- end:
- if (data->update_input) {
- mxt_input_sync(data);
- data->update_input = false;
- }
- return IRQ_HANDLED;
- }
- static int mxt_process_messages_until_invalid(struct mxt_data *data)
- {
- struct device *dev = &data->client->dev;
- int count, read;
- u8 tries = 2;
- count = data->max_reportid;
- /* Read messages until we force an invalid */
- do {
- read = mxt_read_and_process_messages(data, count);
- if (read < count)
- return 0;
- } while (--tries);
- if (data->update_input) {
- mxt_input_sync(data);
- data->update_input = false;
- }
- dev_err(dev, "CHG pin isn't cleared\n");
- return -EBUSY;
- }
- static irqreturn_t mxt_process_messages(struct mxt_data *data)
- {
- int total_handled, num_handled;
- u8 count = data->last_message_count;
- if (count < 1 || count > data->max_reportid)
- count = 1;
- /* include final invalid message */
- total_handled = mxt_read_and_process_messages(data, count + 1);
- if (total_handled < 0)
- return IRQ_NONE;
- /* if there were invalid messages, then we are done */
- else if (total_handled <= count)
- goto update_count;
- /* keep reading two msgs until one is invalid or reportid limit */
- do {
- num_handled = mxt_read_and_process_messages(data, 2);
- if (num_handled < 0)
- return IRQ_NONE;
- total_handled += num_handled;
- if (num_handled < 2)
- break;
- } while (total_handled < data->num_touchids);
- update_count:
- data->last_message_count = total_handled;
- if (data->update_input) {
- mxt_input_sync(data);
- data->update_input = false;
- }
- return IRQ_HANDLED;
- }
- static irqreturn_t mxt_interrupt(int irq, void *dev_id)
- {
- struct mxt_data *data = dev_id;
- if (data->in_bootloader) {
- /* bootloader state transition completion */
- complete(&data->bl_completion);
- return IRQ_HANDLED;
- }
- if (!data->object_table)
- return IRQ_HANDLED;
- if (data->T44_address) {
- return mxt_process_messages_t44(data);
- } else {
- return mxt_process_messages(data);
- }
- }
- static int mxt_t6_command(struct mxt_data *data, u16 cmd_offset,
- u8 value, bool wait)
- {
- u16 reg;
- u8 command_register;
- int timeout_counter = 0;
- int ret;
- reg = data->T6_address + cmd_offset;
- ret = mxt_write_reg(data->client, reg, value);
- if (ret)
- return ret;
- if (!wait)
- return 0;
- do {
- msleep(20);
- ret = __mxt_read_reg(data->client, reg, 1, &command_register);
- if (ret)
- return ret;
- } while (command_register != 0 && timeout_counter++ <= 100);
- if (timeout_counter > 100) {
- dev_err(&data->client->dev, "Command failed!\n");
- return -EIO;
- }
- return 0;
- }
- static int mxt_acquire_irq(struct mxt_data *data)
- {
- int error;
- enable_irq(data->irq);
- error = mxt_process_messages_until_invalid(data);
- if (error)
- return error;
- return 0;
- }
- static int mxt_soft_reset(struct mxt_data *data)
- {
- struct device *dev = &data->client->dev;
- int ret = 0;
- dev_info(dev, "Resetting device\n");
- disable_irq(data->irq);
- reinit_completion(&data->reset_completion);
- ret = mxt_t6_command(data, MXT_COMMAND_RESET, MXT_RESET_VALUE, false);
- if (ret)
- return ret;
- /* Ignore CHG line for 100ms after reset */
- msleep(MXT_RESET_INVALID_CHG);
- mxt_acquire_irq(data);
- ret = mxt_wait_for_completion(data, &data->reset_completion,
- MXT_RESET_TIMEOUT);
- if (ret)
- return ret;
- return 0;
- }
- static void mxt_update_crc(struct mxt_data *data, u8 cmd, u8 value)
- {
- /*
- * On failure, CRC is set to 0 and config will always be
- * downloaded.
- */
- data->config_crc = 0;
- reinit_completion(&data->crc_completion);
- mxt_t6_command(data, cmd, value, true);
- /*
- * Wait for crc message. On failure, CRC is set to 0 and config will
- * always be downloaded.
- */
- mxt_wait_for_completion(data, &data->crc_completion, MXT_CRC_TIMEOUT);
- }
- static void mxt_calc_crc24(u32 *crc, u8 firstbyte, u8 secondbyte)
- {
- static const unsigned int crcpoly = 0x80001B;
- u32 result;
- u32 data_word;
- data_word = (secondbyte << 8) | firstbyte;
- result = ((*crc << 1) ^ data_word);
- if (result & 0x1000000)
- result ^= crcpoly;
- *crc = result;
- }
- static u32 mxt_calculate_crc(u8 *base, off_t start_off, off_t end_off)
- {
- u32 crc = 0;
- u8 *ptr = base + start_off;
- u8 *last_val = base + end_off - 1;
- if (end_off < start_off)
- return -EINVAL;
- while (ptr < last_val) {
- mxt_calc_crc24(&crc, *ptr, *(ptr + 1));
- ptr += 2;
- }
- /* if len is odd, fill the last byte with 0 */
- if (ptr == last_val)
- mxt_calc_crc24(&crc, *ptr, 0);
- /* Mask to 24-bit */
- crc &= 0x00FFFFFF;
- return crc;
- }
- static int mxt_prepare_cfg_mem(struct mxt_data *data, struct mxt_cfg *cfg)
- {
- struct device *dev = &data->client->dev;
- struct mxt_object *object;
- unsigned int type, instance, size, byte_offset;
- int offset;
- int ret;
- int i;
- u16 reg;
- u8 val;
- while (cfg->raw_pos < cfg->raw_size) {
- /* Read type, instance, length */
- ret = sscanf(cfg->raw + cfg->raw_pos, "%x %x %x%n",
- &type, &instance, &size, &offset);
- if (ret == 0) {
- /* EOF */
- break;
- } else if (ret != 3) {
- dev_err(dev, "Bad format: failed to parse object\n");
- return -EINVAL;
- }
- cfg->raw_pos += offset;
- object = mxt_get_object(data, type);
- if (!object) {
- /* Skip object */
- for (i = 0; i < size; i++) {
- ret = sscanf(cfg->raw + cfg->raw_pos, "%hhx%n",
- &val, &offset);
- if (ret != 1) {
- dev_err(dev, "Bad format in T%d at %d\n",
- type, i);
- return -EINVAL;
- }
- cfg->raw_pos += offset;
- }
- continue;
- }
- if (size > mxt_obj_size(object)) {
- /*
- * Either we are in fallback mode due to wrong
- * config or config from a later fw version,
- * or the file is corrupt or hand-edited.
- */
- dev_warn(dev, "Discarding %zu byte(s) in T%u\n",
- size - mxt_obj_size(object), type);
- } else if (mxt_obj_size(object) > size) {
- /*
- * If firmware is upgraded, new bytes may be added to
- * end of objects. It is generally forward compatible
- * to zero these bytes - previous behaviour will be
- * retained. However this does invalidate the CRC and
- * will force fallback mode until the configuration is
- * updated. We warn here but do nothing else - the
- * malloc has zeroed the entire configuration.
- */
- dev_warn(dev, "Zeroing %zu byte(s) in T%d\n",
- mxt_obj_size(object) - size, type);
- }
- if (instance >= mxt_obj_instances(object)) {
- dev_err(dev, "Object instances exceeded!\n");
- return -EINVAL;
- }
- reg = object->start_address + mxt_obj_size(object) * instance;
- for (i = 0; i < size; i++) {
- ret = sscanf(cfg->raw + cfg->raw_pos, "%hhx%n",
- &val,
- &offset);
- if (ret != 1) {
- dev_err(dev, "Bad format in T%d at %d\n",
- type, i);
- return -EINVAL;
- }
- cfg->raw_pos += offset;
- if (i > mxt_obj_size(object))
- continue;
- byte_offset = reg + i - cfg->start_ofs;
- if (byte_offset >= 0 && byte_offset < cfg->mem_size) {
- *(cfg->mem + byte_offset) = val;
- } else {
- dev_err(dev, "Bad object: reg:%d, T%d, ofs=%d\n",
- reg, object->type, byte_offset);
- return -EINVAL;
- }
- }
- }
- return 0;
- }
- static int mxt_upload_cfg_mem(struct mxt_data *data, struct mxt_cfg *cfg)
- {
- unsigned int byte_offset = 0;
- int error;
- /* Write configuration as blocks */
- while (byte_offset < cfg->mem_size) {
- unsigned int size = cfg->mem_size - byte_offset;
- if (size > MXT_MAX_BLOCK_WRITE)
- size = MXT_MAX_BLOCK_WRITE;
- error = __mxt_write_reg(data->client,
- cfg->start_ofs + byte_offset,
- size, cfg->mem + byte_offset);
- if (error) {
- dev_err(&data->client->dev,
- "Config write error, ret=%d\n", error);
- return error;
- }
- byte_offset += size;
- }
- return 0;
- }
- static int mxt_init_t7_power_cfg(struct mxt_data *data);
- /*
- * mxt_update_cfg - download configuration to chip
- *
- * Atmel Raw Config File Format
- *
- * The first four lines of the raw config file contain:
- * 1) Version
- * 2) Chip ID Information (first 7 bytes of device memory)
- * 3) Chip Information Block 24-bit CRC Checksum
- * 4) Chip Configuration 24-bit CRC Checksum
- *
- * The rest of the file consists of one line per object instance:
- * <TYPE> <INSTANCE> <SIZE> <CONTENTS>
- *
- * <TYPE> - 2-byte object type as hex
- * <INSTANCE> - 2-byte object instance number as hex
- * <SIZE> - 2-byte object size as hex
- * <CONTENTS> - array of <SIZE> 1-byte hex values
- */
- static int mxt_update_cfg(struct mxt_data *data, const struct firmware *fw)
- {
- struct device *dev = &data->client->dev;
- struct mxt_cfg cfg;
- int ret;
- int offset;
- int i;
- u32 info_crc, config_crc, calculated_crc;
- u16 crc_start = 0;
- /* Make zero terminated copy of the OBP_RAW file */
- cfg.raw = kmemdup_nul(fw->data, fw->size, GFP_KERNEL);
- if (!cfg.raw)
- return -ENOMEM;
- cfg.raw_size = fw->size;
- mxt_update_crc(data, MXT_COMMAND_REPORTALL, 1);
- if (strncmp(cfg.raw, MXT_CFG_MAGIC, strlen(MXT_CFG_MAGIC))) {
- dev_err(dev, "Unrecognised config file\n");
- ret = -EINVAL;
- goto release_raw;
- }
- cfg.raw_pos = strlen(MXT_CFG_MAGIC);
- /* Load information block and check */
- for (i = 0; i < sizeof(struct mxt_info); i++) {
- ret = sscanf(cfg.raw + cfg.raw_pos, "%hhx%n",
- (unsigned char *)&cfg.info + i,
- &offset);
- if (ret != 1) {
- dev_err(dev, "Bad format\n");
- ret = -EINVAL;
- goto release_raw;
- }
- cfg.raw_pos += offset;
- }
- if (cfg.info.family_id != data->info->family_id) {
- dev_err(dev, "Family ID mismatch!\n");
- ret = -EINVAL;
- goto release_raw;
- }
- if (cfg.info.variant_id != data->info->variant_id) {
- dev_err(dev, "Variant ID mismatch!\n");
- ret = -EINVAL;
- goto release_raw;
- }
- /* Read CRCs */
- ret = sscanf(cfg.raw + cfg.raw_pos, "%x%n", &info_crc, &offset);
- if (ret != 1) {
- dev_err(dev, "Bad format: failed to parse Info CRC\n");
- ret = -EINVAL;
- goto release_raw;
- }
- cfg.raw_pos += offset;
- ret = sscanf(cfg.raw + cfg.raw_pos, "%x%n", &config_crc, &offset);
- if (ret != 1) {
- dev_err(dev, "Bad format: failed to parse Config CRC\n");
- ret = -EINVAL;
- goto release_raw;
- }
- cfg.raw_pos += offset;
- /*
- * The Info Block CRC is calculated over mxt_info and the object
- * table. If it does not match then we are trying to load the
- * configuration from a different chip or firmware version, so
- * the configuration CRC is invalid anyway.
- */
- if (info_crc == data->info_crc) {
- if (config_crc == 0 || data->config_crc == 0) {
- dev_info(dev, "CRC zero, attempting to apply config\n");
- } else if (config_crc == data->config_crc) {
- dev_dbg(dev, "Config CRC 0x%06X: OK\n",
- data->config_crc);
- return 0;
- } else {
- dev_info(dev, "Config CRC 0x%06X: does not match file 0x%06X\n",
- data->config_crc, config_crc);
- }
- } else {
- dev_warn(dev,
- "Warning: Info CRC error - device=0x%06X file=0x%06X\n",
- data->info_crc, info_crc);
- }
- /* Malloc memory to store configuration */
- cfg.start_ofs = MXT_OBJECT_START +
- data->info->object_num * sizeof(struct mxt_object) +
- MXT_INFO_CHECKSUM_SIZE;
- cfg.mem_size = data->mem_size - cfg.start_ofs;
- cfg.mem = kzalloc(cfg.mem_size, GFP_KERNEL);
- if (!cfg.mem) {
- ret = -ENOMEM;
- goto release_raw;
- }
- ret = mxt_prepare_cfg_mem(data, &cfg);
- if (ret)
- goto release_mem;
- /* Calculate crc of the received configs (not the raw config file) */
- if (data->T71_address)
- crc_start = data->T71_address;
- else if (data->T7_address)
- crc_start = data->T7_address;
- else
- dev_warn(dev, "Could not find CRC start\n");
- if (crc_start > cfg.start_ofs) {
- calculated_crc = mxt_calculate_crc(cfg.mem,
- crc_start - cfg.start_ofs,
- cfg.mem_size);
- if (config_crc > 0 && config_crc != calculated_crc)
- dev_warn(dev, "Config CRC in file inconsistent, calculated=%06X, file=%06X\n",
- calculated_crc, config_crc);
- }
- ret = mxt_upload_cfg_mem(data, &cfg);
- if (ret)
- goto release_mem;
- mxt_update_crc(data, MXT_COMMAND_BACKUPNV, MXT_BACKUP_VALUE);
- ret = mxt_soft_reset(data);
- if (ret)
- goto release_mem;
- dev_info(dev, "Config successfully updated\n");
- /* T7 config may have changed */
- mxt_init_t7_power_cfg(data);
- release_mem:
- kfree(cfg.mem);
- release_raw:
- kfree(cfg.raw);
- return ret;
- }
- static void mxt_free_input_device(struct mxt_data *data)
- {
- if (data->input_dev) {
- input_unregister_device(data->input_dev);
- data->input_dev = NULL;
- }
- }
- static void mxt_free_object_table(struct mxt_data *data)
- {
- #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
- video_unregister_device(&data->dbg.vdev);
- v4l2_device_unregister(&data->dbg.v4l2);
- #endif
- data->object_table = NULL;
- data->info = NULL;
- kfree(data->raw_info_block);
- data->raw_info_block = NULL;
- kfree(data->msg_buf);
- data->msg_buf = NULL;
- data->T5_address = 0;
- data->T5_msg_size = 0;
- data->T6_reportid = 0;
- data->T7_address = 0;
- data->T71_address = 0;
- data->T9_reportid_min = 0;
- data->T9_reportid_max = 0;
- data->T19_reportid = 0;
- data->T44_address = 0;
- data->T100_reportid_min = 0;
- data->T100_reportid_max = 0;
- data->max_reportid = 0;
- }
- static int mxt_parse_object_table(struct mxt_data *data,
- struct mxt_object *object_table)
- {
- struct i2c_client *client = data->client;
- int i;
- u8 reportid;
- u16 end_address;
- /* Valid Report IDs start counting from 1 */
- reportid = 1;
- data->mem_size = 0;
- for (i = 0; i < data->info->object_num; i++) {
- struct mxt_object *object = object_table + i;
- u8 min_id, max_id;
- le16_to_cpus(&object->start_address);
- if (object->num_report_ids) {
- min_id = reportid;
- reportid += object->num_report_ids *
- mxt_obj_instances(object);
- max_id = reportid - 1;
- } else {
- min_id = 0;
- max_id = 0;
- }
- dev_dbg(&data->client->dev,
- "T%u Start:%u Size:%zu Instances:%zu Report IDs:%u-%u\n",
- object->type, object->start_address,
- mxt_obj_size(object), mxt_obj_instances(object),
- min_id, max_id);
- switch (object->type) {
- case MXT_GEN_MESSAGE_T5:
- if (data->info->family_id == 0x80 &&
- data->info->version < 0x20) {
- /*
- * On mXT224 firmware versions prior to V2.0
- * read and discard unused CRC byte otherwise
- * DMA reads are misaligned.
- */
- data->T5_msg_size = mxt_obj_size(object);
- } else {
- /* CRC not enabled, so skip last byte */
- data->T5_msg_size = mxt_obj_size(object) - 1;
- }
- data->T5_address = object->start_address;
- break;
- case MXT_GEN_COMMAND_T6:
- data->T6_reportid = min_id;
- data->T6_address = object->start_address;
- break;
- case MXT_GEN_POWER_T7:
- data->T7_address = object->start_address;
- break;
- case MXT_SPT_DYNAMICCONFIGURATIONCONTAINER_T71:
- data->T71_address = object->start_address;
- break;
- case MXT_TOUCH_MULTI_T9:
- data->multitouch = MXT_TOUCH_MULTI_T9;
- /* Only handle messages from first T9 instance */
- data->T9_reportid_min = min_id;
- data->T9_reportid_max = min_id +
- object->num_report_ids - 1;
- data->num_touchids = object->num_report_ids;
- break;
- case MXT_SPT_MESSAGECOUNT_T44:
- data->T44_address = object->start_address;
- break;
- case MXT_SPT_GPIOPWM_T19:
- data->T19_reportid = min_id;
- break;
- case MXT_TOUCH_MULTITOUCHSCREEN_T100:
- data->multitouch = MXT_TOUCH_MULTITOUCHSCREEN_T100;
- data->T100_reportid_min = min_id;
- data->T100_reportid_max = max_id;
- /* first two report IDs reserved */
- data->num_touchids = object->num_report_ids - 2;
- break;
- }
- end_address = object->start_address
- + mxt_obj_size(object) * mxt_obj_instances(object) - 1;
- if (end_address >= data->mem_size)
- data->mem_size = end_address + 1;
- }
- /* Store maximum reportid */
- data->max_reportid = reportid;
- /* If T44 exists, T5 position has to be directly after */
- if (data->T44_address && (data->T5_address != data->T44_address + 1)) {
- dev_err(&client->dev, "Invalid T44 position\n");
- return -EINVAL;
- }
- data->msg_buf = kcalloc(data->max_reportid,
- data->T5_msg_size, GFP_KERNEL);
- if (!data->msg_buf)
- return -ENOMEM;
- return 0;
- }
- static int mxt_read_info_block(struct mxt_data *data)
- {
- struct i2c_client *client = data->client;
- int error;
- size_t size;
- void *id_buf, *buf;
- uint8_t num_objects;
- u32 calculated_crc;
- u8 *crc_ptr;
- /* If info block already allocated, free it */
- if (data->raw_info_block)
- mxt_free_object_table(data);
- /* Read 7-byte ID information block starting at address 0 */
- size = sizeof(struct mxt_info);
- id_buf = kzalloc(size, GFP_KERNEL);
- if (!id_buf)
- return -ENOMEM;
- error = __mxt_read_reg(client, 0, size, id_buf);
- if (error)
- goto err_free_mem;
- /* Resize buffer to give space for rest of info block */
- num_objects = ((struct mxt_info *)id_buf)->object_num;
- size += (num_objects * sizeof(struct mxt_object))
- + MXT_INFO_CHECKSUM_SIZE;
- buf = krealloc(id_buf, size, GFP_KERNEL);
- if (!buf) {
- error = -ENOMEM;
- goto err_free_mem;
- }
- id_buf = buf;
- /* Read rest of info block */
- error = __mxt_read_reg(client, MXT_OBJECT_START,
- size - MXT_OBJECT_START,
- id_buf + MXT_OBJECT_START);
- if (error)
- goto err_free_mem;
- /* Extract & calculate checksum */
- crc_ptr = id_buf + size - MXT_INFO_CHECKSUM_SIZE;
- data->info_crc = crc_ptr[0] | (crc_ptr[1] << 8) | (crc_ptr[2] << 16);
- calculated_crc = mxt_calculate_crc(id_buf, 0,
- size - MXT_INFO_CHECKSUM_SIZE);
- /*
- * CRC mismatch can be caused by data corruption due to I2C comms
- * issue or else device is not using Object Based Protocol (eg i2c-hid)
- */
- if ((data->info_crc == 0) || (data->info_crc != calculated_crc)) {
- dev_err(&client->dev,
- "Info Block CRC error calculated=0x%06X read=0x%06X\n",
- calculated_crc, data->info_crc);
- error = -EIO;
- goto err_free_mem;
- }
- data->raw_info_block = id_buf;
- data->info = (struct mxt_info *)id_buf;
- dev_info(&client->dev,
- "Family: %u Variant: %u Firmware V%u.%u.%02X Objects: %u\n",
- data->info->family_id, data->info->variant_id,
- data->info->version >> 4, data->info->version & 0xf,
- data->info->build, data->info->object_num);
- /* Parse object table information */
- error = mxt_parse_object_table(data, id_buf + MXT_OBJECT_START);
- if (error) {
- dev_err(&client->dev, "Error %d parsing object table\n", error);
- mxt_free_object_table(data);
- goto err_free_mem;
- }
- data->object_table = (struct mxt_object *)(id_buf + MXT_OBJECT_START);
- return 0;
- err_free_mem:
- kfree(id_buf);
- return error;
- }
- static int mxt_read_t9_resolution(struct mxt_data *data)
- {
- struct i2c_client *client = data->client;
- int error;
- struct t9_range range;
- unsigned char orient;
- struct mxt_object *object;
- object = mxt_get_object(data, MXT_TOUCH_MULTI_T9);
- if (!object)
- return -EINVAL;
- error = __mxt_read_reg(client,
- object->start_address + MXT_T9_XSIZE,
- sizeof(data->xsize), &data->xsize);
- if (error)
- return error;
- error = __mxt_read_reg(client,
- object->start_address + MXT_T9_YSIZE,
- sizeof(data->ysize), &data->ysize);
- if (error)
- return error;
- error = __mxt_read_reg(client,
- object->start_address + MXT_T9_RANGE,
- sizeof(range), &range);
- if (error)
- return error;
- data->max_x = get_unaligned_le16(&range.x);
- data->max_y = get_unaligned_le16(&range.y);
- error = __mxt_read_reg(client,
- object->start_address + MXT_T9_ORIENT,
- 1, &orient);
- if (error)
- return error;
- data->xy_switch = orient & MXT_T9_ORIENT_SWITCH;
- data->invertx = orient & MXT_T9_ORIENT_INVERTX;
- data->inverty = orient & MXT_T9_ORIENT_INVERTY;
- return 0;
- }
- static int mxt_read_t100_config(struct mxt_data *data)
- {
- struct i2c_client *client = data->client;
- int error;
- struct mxt_object *object;
- u16 range_x, range_y;
- u8 cfg, tchaux;
- u8 aux;
- object = mxt_get_object(data, MXT_TOUCH_MULTITOUCHSCREEN_T100);
- if (!object)
- return -EINVAL;
- /* read touchscreen dimensions */
- error = __mxt_read_reg(client,
- object->start_address + MXT_T100_XRANGE,
- sizeof(range_x), &range_x);
- if (error)
- return error;
- data->max_x = get_unaligned_le16(&range_x);
- error = __mxt_read_reg(client,
- object->start_address + MXT_T100_YRANGE,
- sizeof(range_y), &range_y);
- if (error)
- return error;
- data->max_y = get_unaligned_le16(&range_y);
- error = __mxt_read_reg(client,
- object->start_address + MXT_T100_XSIZE,
- sizeof(data->xsize), &data->xsize);
- if (error)
- return error;
- error = __mxt_read_reg(client,
- object->start_address + MXT_T100_YSIZE,
- sizeof(data->ysize), &data->ysize);
- if (error)
- return error;
- /* read orientation config */
- error = __mxt_read_reg(client,
- object->start_address + MXT_T100_CFG1,
- 1, &cfg);
- if (error)
- return error;
- data->xy_switch = cfg & MXT_T100_CFG_SWITCHXY;
- data->invertx = cfg & MXT_T100_CFG_INVERTX;
- data->inverty = cfg & MXT_T100_CFG_INVERTY;
- /* allocate aux bytes */
- error = __mxt_read_reg(client,
- object->start_address + MXT_T100_TCHAUX,
- 1, &tchaux);
- if (error)
- return error;
- aux = 6;
- if (tchaux & MXT_T100_TCHAUX_VECT)
- data->t100_aux_vect = aux++;
- if (tchaux & MXT_T100_TCHAUX_AMPL)
- data->t100_aux_ampl = aux++;
- if (tchaux & MXT_T100_TCHAUX_AREA)
- data->t100_aux_area = aux++;
- dev_dbg(&client->dev,
- "T100 aux mappings vect:%u ampl:%u area:%u\n",
- data->t100_aux_vect, data->t100_aux_ampl, data->t100_aux_area);
- return 0;
- }
- static int mxt_input_open(struct input_dev *dev);
- static void mxt_input_close(struct input_dev *dev);
- static void mxt_set_up_as_touchpad(struct input_dev *input_dev,
- struct mxt_data *data)
- {
- int i;
- input_dev->name = "Atmel maXTouch Touchpad";
- __set_bit(INPUT_PROP_BUTTONPAD, input_dev->propbit);
- input_abs_set_res(input_dev, ABS_X, MXT_PIXELS_PER_MM);
- input_abs_set_res(input_dev, ABS_Y, MXT_PIXELS_PER_MM);
- input_abs_set_res(input_dev, ABS_MT_POSITION_X,
- MXT_PIXELS_PER_MM);
- input_abs_set_res(input_dev, ABS_MT_POSITION_Y,
- MXT_PIXELS_PER_MM);
- for (i = 0; i < data->t19_num_keys; i++)
- if (data->t19_keymap[i] != KEY_RESERVED)
- input_set_capability(input_dev, EV_KEY,
- data->t19_keymap[i]);
- }
- static int mxt_initialize_input_device(struct mxt_data *data)
- {
- struct device *dev = &data->client->dev;
- struct input_dev *input_dev;
- int error;
- unsigned int num_mt_slots;
- unsigned int mt_flags = 0;
- switch (data->multitouch) {
- case MXT_TOUCH_MULTI_T9:
- num_mt_slots = data->T9_reportid_max - data->T9_reportid_min + 1;
- error = mxt_read_t9_resolution(data);
- if (error)
- dev_warn(dev, "Failed to initialize T9 resolution\n");
- break;
- case MXT_TOUCH_MULTITOUCHSCREEN_T100:
- num_mt_slots = data->num_touchids;
- error = mxt_read_t100_config(data);
- if (error)
- dev_warn(dev, "Failed to read T100 config\n");
- break;
- default:
- dev_err(dev, "Invalid multitouch object\n");
- return -EINVAL;
- }
- /* Handle default values and orientation switch */
- if (data->max_x == 0)
- data->max_x = 1023;
- if (data->max_y == 0)
- data->max_y = 1023;
- if (data->xy_switch)
- swap(data->max_x, data->max_y);
- dev_info(dev, "Touchscreen size X%uY%u\n", data->max_x, data->max_y);
- /* Register input device */
- input_dev = input_allocate_device();
- if (!input_dev)
- return -ENOMEM;
- input_dev->name = "Atmel maXTouch Touchscreen";
- input_dev->phys = data->phys;
- input_dev->id.bustype = BUS_I2C;
- input_dev->dev.parent = dev;
- input_dev->open = mxt_input_open;
- input_dev->close = mxt_input_close;
- input_set_capability(input_dev, EV_KEY, BTN_TOUCH);
- /* For single touch */
- input_set_abs_params(input_dev, ABS_X, 0, data->max_x, 0, 0);
- input_set_abs_params(input_dev, ABS_Y, 0, data->max_y, 0, 0);
- if (data->multitouch == MXT_TOUCH_MULTI_T9 ||
- (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
- data->t100_aux_ampl)) {
- input_set_abs_params(input_dev, ABS_PRESSURE, 0, 255, 0, 0);
- }
- /* If device has buttons we assume it is a touchpad */
- if (data->t19_num_keys) {
- mxt_set_up_as_touchpad(input_dev, data);
- mt_flags |= INPUT_MT_POINTER;
- } else {
- mt_flags |= INPUT_MT_DIRECT;
- }
- /* For multi touch */
- error = input_mt_init_slots(input_dev, num_mt_slots, mt_flags);
- if (error) {
- dev_err(dev, "Error %d initialising slots\n", error);
- goto err_free_mem;
- }
- if (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100) {
- input_set_abs_params(input_dev, ABS_MT_TOOL_TYPE,
- 0, MT_TOOL_MAX, 0, 0);
- input_set_abs_params(input_dev, ABS_MT_DISTANCE,
- MXT_DISTANCE_ACTIVE_TOUCH,
- MXT_DISTANCE_HOVERING,
- 0, 0);
- }
- input_set_abs_params(input_dev, ABS_MT_POSITION_X,
- 0, data->max_x, 0, 0);
- input_set_abs_params(input_dev, ABS_MT_POSITION_Y,
- 0, data->max_y, 0, 0);
- if (data->multitouch == MXT_TOUCH_MULTI_T9 ||
- (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
- data->t100_aux_area)) {
- input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR,
- 0, MXT_MAX_AREA, 0, 0);
- }
- if (data->multitouch == MXT_TOUCH_MULTI_T9 ||
- (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
- data->t100_aux_ampl)) {
- input_set_abs_params(input_dev, ABS_MT_PRESSURE,
- 0, 255, 0, 0);
- }
- if (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
- data->t100_aux_vect) {
- input_set_abs_params(input_dev, ABS_MT_ORIENTATION,
- 0, 255, 0, 0);
- }
- if (data->multitouch == MXT_TOUCH_MULTITOUCHSCREEN_T100 &&
- data->t100_aux_vect) {
- input_set_abs_params(input_dev, ABS_MT_ORIENTATION,
- 0, 255, 0, 0);
- }
- input_set_drvdata(input_dev, data);
- error = input_register_device(input_dev);
- if (error) {
- dev_err(dev, "Error %d registering input device\n", error);
- goto err_free_mem;
- }
- data->input_dev = input_dev;
- return 0;
- err_free_mem:
- input_free_device(input_dev);
- return error;
- }
- static int mxt_configure_objects(struct mxt_data *data,
- const struct firmware *cfg);
- static void mxt_config_cb(const struct firmware *cfg, void *ctx)
- {
- mxt_configure_objects(ctx, cfg);
- release_firmware(cfg);
- }
- static int mxt_initialize(struct mxt_data *data)
- {
- struct i2c_client *client = data->client;
- int recovery_attempts = 0;
- int error;
- while (1) {
- error = mxt_read_info_block(data);
- if (!error)
- break;
- /* Check bootloader state */
- error = mxt_probe_bootloader(data, false);
- if (error) {
- dev_info(&client->dev, "Trying alternate bootloader address\n");
- error = mxt_probe_bootloader(data, true);
- if (error) {
- /* Chip is not in appmode or bootloader mode */
- return error;
- }
- }
- /* OK, we are in bootloader, see if we can recover */
- if (++recovery_attempts > 1) {
- dev_err(&client->dev, "Could not recover from bootloader mode\n");
- /*
- * We can reflash from this state, so do not
- * abort initialization.
- */
- data->in_bootloader = true;
- return 0;
- }
- /* Attempt to exit bootloader into app mode */
- mxt_send_bootloader_cmd(data, false);
- msleep(MXT_FW_RESET_TIME);
- }
- error = mxt_acquire_irq(data);
- if (error)
- return error;
- error = request_firmware_nowait(THIS_MODULE, true, MXT_CFG_NAME,
- &client->dev, GFP_KERNEL, data,
- mxt_config_cb);
- if (error) {
- dev_err(&client->dev, "Failed to invoke firmware loader: %d\n",
- error);
- return error;
- }
- return 0;
- }
- static int mxt_set_t7_power_cfg(struct mxt_data *data, u8 sleep)
- {
- struct device *dev = &data->client->dev;
- int error;
- struct t7_config *new_config;
- struct t7_config deepsleep = { .active = 0, .idle = 0 };
- if (sleep == MXT_POWER_CFG_DEEPSLEEP)
- new_config = &deepsleep;
- else
- new_config = &data->t7_cfg;
- error = __mxt_write_reg(data->client, data->T7_address,
- sizeof(data->t7_cfg), new_config);
- if (error)
- return error;
- dev_dbg(dev, "Set T7 ACTV:%d IDLE:%d\n",
- new_config->active, new_config->idle);
- return 0;
- }
- static int mxt_init_t7_power_cfg(struct mxt_data *data)
- {
- struct device *dev = &data->client->dev;
- int error;
- bool retry = false;
- recheck:
- error = __mxt_read_reg(data->client, data->T7_address,
- sizeof(data->t7_cfg), &data->t7_cfg);
- if (error)
- return error;
- if (data->t7_cfg.active == 0 || data->t7_cfg.idle == 0) {
- if (!retry) {
- dev_dbg(dev, "T7 cfg zero, resetting\n");
- mxt_soft_reset(data);
- retry = true;
- goto recheck;
- } else {
- dev_dbg(dev, "T7 cfg zero after reset, overriding\n");
- data->t7_cfg.active = 20;
- data->t7_cfg.idle = 100;
- return mxt_set_t7_power_cfg(data, MXT_POWER_CFG_RUN);
- }
- }
- dev_dbg(dev, "Initialized power cfg: ACTV %d, IDLE %d\n",
- data->t7_cfg.active, data->t7_cfg.idle);
- return 0;
- }
- #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
- static u16 mxt_get_debug_value(struct mxt_data *data, unsigned int x,
- unsigned int y)
- {
- struct mxt_info *info = data->info;
- struct mxt_dbg *dbg = &data->dbg;
- unsigned int ofs, page;
- unsigned int col = 0;
- unsigned int col_width;
- if (info->family_id == MXT_FAMILY_1386) {
- col_width = info->matrix_ysize / MXT1386_COLUMNS;
- col = y / col_width;
- y = y % col_width;
- } else {
- col_width = info->matrix_ysize;
- }
- ofs = (y + (x * col_width)) * sizeof(u16);
- page = ofs / MXT_DIAGNOSTIC_SIZE;
- ofs %= MXT_DIAGNOSTIC_SIZE;
- if (info->family_id == MXT_FAMILY_1386)
- page += col * MXT1386_PAGES_PER_COLUMN;
- return get_unaligned_le16(&dbg->t37_buf[page].data[ofs]);
- }
- static int mxt_convert_debug_pages(struct mxt_data *data, u16 *outbuf)
- {
- struct mxt_dbg *dbg = &data->dbg;
- unsigned int x = 0;
- unsigned int y = 0;
- unsigned int i, rx, ry;
- for (i = 0; i < dbg->t37_nodes; i++) {
- /* Handle orientation */
- rx = data->xy_switch ? y : x;
- ry = data->xy_switch ? x : y;
- rx = data->invertx ? (data->xsize - 1 - rx) : rx;
- ry = data->inverty ? (data->ysize - 1 - ry) : ry;
- outbuf[i] = mxt_get_debug_value(data, rx, ry);
- /* Next value */
- if (++x >= (data->xy_switch ? data->ysize : data->xsize)) {
- x = 0;
- y++;
- }
- }
- return 0;
- }
- static int mxt_read_diagnostic_debug(struct mxt_data *data, u8 mode,
- u16 *outbuf)
- {
- struct mxt_dbg *dbg = &data->dbg;
- int retries = 0;
- int page;
- int ret;
- u8 cmd = mode;
- struct t37_debug *p;
- u8 cmd_poll;
- for (page = 0; page < dbg->t37_pages; page++) {
- p = dbg->t37_buf + page;
- ret = mxt_write_reg(data->client, dbg->diag_cmd_address,
- cmd);
- if (ret)
- return ret;
- retries = 0;
- msleep(20);
- wait_cmd:
- /* Read back command byte */
- ret = __mxt_read_reg(data->client, dbg->diag_cmd_address,
- sizeof(cmd_poll), &cmd_poll);
- if (ret)
- return ret;
- /* Field is cleared once the command has been processed */
- if (cmd_poll) {
- if (retries++ > 100)
- return -EINVAL;
- msleep(20);
- goto wait_cmd;
- }
- /* Read T37 page */
- ret = __mxt_read_reg(data->client, dbg->t37_address,
- sizeof(struct t37_debug), p);
- if (ret)
- return ret;
- if (p->mode != mode || p->page != page) {
- dev_err(&data->client->dev, "T37 page mismatch\n");
- return -EINVAL;
- }
- dev_dbg(&data->client->dev, "%s page:%d retries:%d\n",
- __func__, page, retries);
- /* For remaining pages, write PAGEUP rather than mode */
- cmd = MXT_DIAGNOSTIC_PAGEUP;
- }
- return mxt_convert_debug_pages(data, outbuf);
- }
- static int mxt_queue_setup(struct vb2_queue *q,
- unsigned int *nbuffers, unsigned int *nplanes,
- unsigned int sizes[], struct device *alloc_devs[])
- {
- struct mxt_data *data = q->drv_priv;
- size_t size = data->dbg.t37_nodes * sizeof(u16);
- if (*nplanes)
- return sizes[0] < size ? -EINVAL : 0;
- *nplanes = 1;
- sizes[0] = size;
- return 0;
- }
- static void mxt_buffer_queue(struct vb2_buffer *vb)
- {
- struct mxt_data *data = vb2_get_drv_priv(vb->vb2_queue);
- u16 *ptr;
- int ret;
- u8 mode;
- ptr = vb2_plane_vaddr(vb, 0);
- if (!ptr) {
- dev_err(&data->client->dev, "Error acquiring frame ptr\n");
- goto fault;
- }
- switch (data->dbg.input) {
- case MXT_V4L_INPUT_DELTAS:
- default:
- mode = MXT_DIAGNOSTIC_DELTAS;
- break;
- case MXT_V4L_INPUT_REFS:
- mode = MXT_DIAGNOSTIC_REFS;
- break;
- }
- ret = mxt_read_diagnostic_debug(data, mode, ptr);
- if (ret)
- goto fault;
- vb2_set_plane_payload(vb, 0, data->dbg.t37_nodes * sizeof(u16));
- vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
- return;
- fault:
- vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
- }
- /* V4L2 structures */
- static const struct vb2_ops mxt_queue_ops = {
- .queue_setup = mxt_queue_setup,
- .buf_queue = mxt_buffer_queue,
- .wait_prepare = vb2_ops_wait_prepare,
- .wait_finish = vb2_ops_wait_finish,
- };
- static const struct vb2_queue mxt_queue = {
- .type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
- .io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF | VB2_READ,
- .buf_struct_size = sizeof(struct mxt_vb2_buffer),
- .ops = &mxt_queue_ops,
- .mem_ops = &vb2_vmalloc_memops,
- .timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC,
- .min_buffers_needed = 1,
- };
- static int mxt_vidioc_querycap(struct file *file, void *priv,
- struct v4l2_capability *cap)
- {
- struct mxt_data *data = video_drvdata(file);
- strlcpy(cap->driver, "atmel_mxt_ts", sizeof(cap->driver));
- strlcpy(cap->card, "atmel_mxt_ts touch", sizeof(cap->card));
- snprintf(cap->bus_info, sizeof(cap->bus_info),
- "I2C:%s", dev_name(&data->client->dev));
- return 0;
- }
- static int mxt_vidioc_enum_input(struct file *file, void *priv,
- struct v4l2_input *i)
- {
- if (i->index >= MXT_V4L_INPUT_MAX)
- return -EINVAL;
- i->type = V4L2_INPUT_TYPE_TOUCH;
- switch (i->index) {
- case MXT_V4L_INPUT_REFS:
- strlcpy(i->name, "Mutual Capacitance References",
- sizeof(i->name));
- break;
- case MXT_V4L_INPUT_DELTAS:
- strlcpy(i->name, "Mutual Capacitance Deltas", sizeof(i->name));
- break;
- }
- return 0;
- }
- static int mxt_set_input(struct mxt_data *data, unsigned int i)
- {
- struct v4l2_pix_format *f = &data->dbg.format;
- if (i >= MXT_V4L_INPUT_MAX)
- return -EINVAL;
- if (i == MXT_V4L_INPUT_DELTAS)
- f->pixelformat = V4L2_TCH_FMT_DELTA_TD16;
- else
- f->pixelformat = V4L2_TCH_FMT_TU16;
- f->width = data->xy_switch ? data->ysize : data->xsize;
- f->height = data->xy_switch ? data->xsize : data->ysize;
- f->field = V4L2_FIELD_NONE;
- f->colorspace = V4L2_COLORSPACE_RAW;
- f->bytesperline = f->width * sizeof(u16);
- f->sizeimage = f->width * f->height * sizeof(u16);
- data->dbg.input = i;
- return 0;
- }
- static int mxt_vidioc_s_input(struct file *file, void *priv, unsigned int i)
- {
- return mxt_set_input(video_drvdata(file), i);
- }
- static int mxt_vidioc_g_input(struct file *file, void *priv, unsigned int *i)
- {
- struct mxt_data *data = video_drvdata(file);
- *i = data->dbg.input;
- return 0;
- }
- static int mxt_vidioc_fmt(struct file *file, void *priv, struct v4l2_format *f)
- {
- struct mxt_data *data = video_drvdata(file);
- f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
- f->fmt.pix = data->dbg.format;
- return 0;
- }
- static int mxt_vidioc_enum_fmt(struct file *file, void *priv,
- struct v4l2_fmtdesc *fmt)
- {
- if (fmt->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- switch (fmt->index) {
- case 0:
- fmt->pixelformat = V4L2_TCH_FMT_TU16;
- break;
- case 1:
- fmt->pixelformat = V4L2_TCH_FMT_DELTA_TD16;
- break;
- default:
- return -EINVAL;
- }
- return 0;
- }
- static int mxt_vidioc_g_parm(struct file *file, void *fh,
- struct v4l2_streamparm *a)
- {
- if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- a->parm.capture.readbuffers = 1;
- a->parm.capture.timeperframe.numerator = 1;
- a->parm.capture.timeperframe.denominator = 10;
- return 0;
- }
- static const struct v4l2_ioctl_ops mxt_video_ioctl_ops = {
- .vidioc_querycap = mxt_vidioc_querycap,
- .vidioc_enum_fmt_vid_cap = mxt_vidioc_enum_fmt,
- .vidioc_s_fmt_vid_cap = mxt_vidioc_fmt,
- .vidioc_g_fmt_vid_cap = mxt_vidioc_fmt,
- .vidioc_try_fmt_vid_cap = mxt_vidioc_fmt,
- .vidioc_g_parm = mxt_vidioc_g_parm,
- .vidioc_enum_input = mxt_vidioc_enum_input,
- .vidioc_g_input = mxt_vidioc_g_input,
- .vidioc_s_input = mxt_vidioc_s_input,
- .vidioc_reqbufs = vb2_ioctl_reqbufs,
- .vidioc_create_bufs = vb2_ioctl_create_bufs,
- .vidioc_querybuf = vb2_ioctl_querybuf,
- .vidioc_qbuf = vb2_ioctl_qbuf,
- .vidioc_dqbuf = vb2_ioctl_dqbuf,
- .vidioc_expbuf = vb2_ioctl_expbuf,
- .vidioc_streamon = vb2_ioctl_streamon,
- .vidioc_streamoff = vb2_ioctl_streamoff,
- };
- static const struct video_device mxt_video_device = {
- .name = "Atmel maxTouch",
- .fops = &mxt_video_fops,
- .ioctl_ops = &mxt_video_ioctl_ops,
- .release = video_device_release_empty,
- .device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_TOUCH |
- V4L2_CAP_READWRITE | V4L2_CAP_STREAMING,
- };
- static void mxt_debug_init(struct mxt_data *data)
- {
- struct mxt_info *info = data->info;
- struct mxt_dbg *dbg = &data->dbg;
- struct mxt_object *object;
- int error;
- object = mxt_get_object(data, MXT_GEN_COMMAND_T6);
- if (!object)
- goto error;
- dbg->diag_cmd_address = object->start_address + MXT_COMMAND_DIAGNOSTIC;
- object = mxt_get_object(data, MXT_DEBUG_DIAGNOSTIC_T37);
- if (!object)
- goto error;
- if (mxt_obj_size(object) != sizeof(struct t37_debug)) {
- dev_warn(&data->client->dev, "Bad T37 size");
- goto error;
- }
- dbg->t37_address = object->start_address;
- /* Calculate size of data and allocate buffer */
- dbg->t37_nodes = data->xsize * data->ysize;
- if (info->family_id == MXT_FAMILY_1386)
- dbg->t37_pages = MXT1386_COLUMNS * MXT1386_PAGES_PER_COLUMN;
- else
- dbg->t37_pages = DIV_ROUND_UP(data->xsize *
- info->matrix_ysize *
- sizeof(u16),
- sizeof(dbg->t37_buf->data));
- dbg->t37_buf = devm_kmalloc_array(&data->client->dev, dbg->t37_pages,
- sizeof(struct t37_debug), GFP_KERNEL);
- if (!dbg->t37_buf)
- goto error;
- /* init channel to zero */
- mxt_set_input(data, 0);
- /* register video device */
- snprintf(dbg->v4l2.name, sizeof(dbg->v4l2.name), "%s", "atmel_mxt_ts");
- error = v4l2_device_register(&data->client->dev, &dbg->v4l2);
- if (error)
- goto error;
- /* initialize the queue */
- mutex_init(&dbg->lock);
- dbg->queue = mxt_queue;
- dbg->queue.drv_priv = data;
- dbg->queue.lock = &dbg->lock;
- dbg->queue.dev = &data->client->dev;
- error = vb2_queue_init(&dbg->queue);
- if (error)
- goto error_unreg_v4l2;
- dbg->vdev = mxt_video_device;
- dbg->vdev.v4l2_dev = &dbg->v4l2;
- dbg->vdev.lock = &dbg->lock;
- dbg->vdev.vfl_dir = VFL_DIR_RX;
- dbg->vdev.queue = &dbg->queue;
- video_set_drvdata(&dbg->vdev, data);
- error = video_register_device(&dbg->vdev, VFL_TYPE_TOUCH, -1);
- if (error)
- goto error_unreg_v4l2;
- return;
- error_unreg_v4l2:
- v4l2_device_unregister(&dbg->v4l2);
- error:
- dev_warn(&data->client->dev, "Error initializing T37\n");
- }
- #else
- static void mxt_debug_init(struct mxt_data *data)
- {
- }
- #endif
- static int mxt_configure_objects(struct mxt_data *data,
- const struct firmware *cfg)
- {
- struct device *dev = &data->client->dev;
- int error;
- error = mxt_init_t7_power_cfg(data);
- if (error) {
- dev_err(dev, "Failed to initialize power cfg\n");
- return error;
- }
- if (cfg) {
- error = mxt_update_cfg(data, cfg);
- if (error)
- dev_warn(dev, "Error %d updating config\n", error);
- }
- if (data->multitouch) {
- error = mxt_initialize_input_device(data);
- if (error)
- return error;
- } else {
- dev_warn(dev, "No touch object detected\n");
- }
- mxt_debug_init(data);
- return 0;
- }
- /* Firmware Version is returned as Major.Minor.Build */
- static ssize_t mxt_fw_version_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct mxt_data *data = dev_get_drvdata(dev);
- struct mxt_info *info = data->info;
- return scnprintf(buf, PAGE_SIZE, "%u.%u.%02X\n",
- info->version >> 4, info->version & 0xf, info->build);
- }
- /* Hardware Version is returned as FamilyID.VariantID */
- static ssize_t mxt_hw_version_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct mxt_data *data = dev_get_drvdata(dev);
- struct mxt_info *info = data->info;
- return scnprintf(buf, PAGE_SIZE, "%u.%u\n",
- info->family_id, info->variant_id);
- }
- static ssize_t mxt_show_instance(char *buf, int count,
- struct mxt_object *object, int instance,
- const u8 *val)
- {
- int i;
- if (mxt_obj_instances(object) > 1)
- count += scnprintf(buf + count, PAGE_SIZE - count,
- "Instance %u\n", instance);
- for (i = 0; i < mxt_obj_size(object); i++)
- count += scnprintf(buf + count, PAGE_SIZE - count,
- "\t[%2u]: %02x (%d)\n", i, val[i], val[i]);
- count += scnprintf(buf + count, PAGE_SIZE - count, "\n");
- return count;
- }
- static ssize_t mxt_object_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct mxt_data *data = dev_get_drvdata(dev);
- struct mxt_object *object;
- int count = 0;
- int i, j;
- int error;
- u8 *obuf;
- /* Pre-allocate buffer large enough to hold max sized object. */
- obuf = kmalloc(256, GFP_KERNEL);
- if (!obuf)
- return -ENOMEM;
- error = 0;
- for (i = 0; i < data->info->object_num; i++) {
- object = data->object_table + i;
- if (!mxt_object_readable(object->type))
- continue;
- count += scnprintf(buf + count, PAGE_SIZE - count,
- "T%u:\n", object->type);
- for (j = 0; j < mxt_obj_instances(object); j++) {
- u16 size = mxt_obj_size(object);
- u16 addr = object->start_address + j * size;
- error = __mxt_read_reg(data->client, addr, size, obuf);
- if (error)
- goto done;
- count = mxt_show_instance(buf, count, object, j, obuf);
- }
- }
- done:
- kfree(obuf);
- return error ?: count;
- }
- static int mxt_check_firmware_format(struct device *dev,
- const struct firmware *fw)
- {
- unsigned int pos = 0;
- char c;
- while (pos < fw->size) {
- c = *(fw->data + pos);
- if (c < '0' || (c > '9' && c < 'A') || c > 'F')
- return 0;
- pos++;
- }
- /*
- * To convert file try:
- * xxd -r -p mXTXXX__APP_VX-X-XX.enc > maxtouch.fw
- */
- dev_err(dev, "Aborting: firmware file must be in binary format\n");
- return -EINVAL;
- }
- static int mxt_load_fw(struct device *dev, const char *fn)
- {
- struct mxt_data *data = dev_get_drvdata(dev);
- const struct firmware *fw = NULL;
- unsigned int frame_size;
- unsigned int pos = 0;
- unsigned int retry = 0;
- unsigned int frame = 0;
- int ret;
- ret = request_firmware(&fw, fn, dev);
- if (ret)
- return ret;
- /* Check for incorrect enc file */
- ret = mxt_check_firmware_format(dev, fw);
- if (ret)
- goto release_firmware;
- if (!data->in_bootloader) {
- /* Change to the bootloader mode */
- data->in_bootloader = true;
- ret = mxt_t6_command(data, MXT_COMMAND_RESET,
- MXT_BOOT_VALUE, false);
- if (ret)
- goto release_firmware;
- msleep(MXT_RESET_TIME);
- /* Do not need to scan since we know family ID */
- ret = mxt_lookup_bootloader_address(data, 0);
- if (ret)
- goto release_firmware;
- mxt_free_input_device(data);
- mxt_free_object_table(data);
- } else {
- enable_irq(data->irq);
- }
- reinit_completion(&data->bl_completion);
- ret = mxt_check_bootloader(data, MXT_WAITING_BOOTLOAD_CMD, false);
- if (ret) {
- /* Bootloader may still be unlocked from previous attempt */
- ret = mxt_check_bootloader(data, MXT_WAITING_FRAME_DATA, false);
- if (ret)
- goto disable_irq;
- } else {
- dev_info(dev, "Unlocking bootloader\n");
- /* Unlock bootloader */
- ret = mxt_send_bootloader_cmd(data, true);
- if (ret)
- goto disable_irq;
- }
- while (pos < fw->size) {
- ret = mxt_check_bootloader(data, MXT_WAITING_FRAME_DATA, true);
- if (ret)
- goto disable_irq;
- frame_size = ((*(fw->data + pos) << 8) | *(fw->data + pos + 1));
- /* Take account of CRC bytes */
- frame_size += 2;
- /* Write one frame to device */
- ret = mxt_bootloader_write(data, fw->data + pos, frame_size);
- if (ret)
- goto disable_irq;
- ret = mxt_check_bootloader(data, MXT_FRAME_CRC_PASS, true);
- if (ret) {
- retry++;
- /* Back off by 20ms per retry */
- msleep(retry * 20);
- if (retry > 20) {
- dev_err(dev, "Retry count exceeded\n");
- goto disable_irq;
- }
- } else {
- retry = 0;
- pos += frame_size;
- frame++;
- }
- if (frame % 50 == 0)
- dev_dbg(dev, "Sent %d frames, %d/%zd bytes\n",
- frame, pos, fw->size);
- }
- /* Wait for flash. */
- ret = mxt_wait_for_completion(data, &data->bl_completion,
- MXT_FW_RESET_TIME);
- if (ret)
- goto disable_irq;
- dev_dbg(dev, "Sent %d frames, %d bytes\n", frame, pos);
- /*
- * Wait for device to reset. Some bootloader versions do not assert
- * the CHG line after bootloading has finished, so ignore potential
- * errors.
- */
- mxt_wait_for_completion(data, &data->bl_completion, MXT_FW_RESET_TIME);
- data->in_bootloader = false;
- disable_irq:
- disable_irq(data->irq);
- release_firmware:
- release_firmware(fw);
- return ret;
- }
- static ssize_t mxt_update_fw_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct mxt_data *data = dev_get_drvdata(dev);
- int error;
- error = mxt_load_fw(dev, MXT_FW_NAME);
- if (error) {
- dev_err(dev, "The firmware update failed(%d)\n", error);
- count = error;
- } else {
- dev_info(dev, "The firmware update succeeded\n");
- error = mxt_initialize(data);
- if (error)
- return error;
- }
- return count;
- }
- static DEVICE_ATTR(fw_version, S_IRUGO, mxt_fw_version_show, NULL);
- static DEVICE_ATTR(hw_version, S_IRUGO, mxt_hw_version_show, NULL);
- static DEVICE_ATTR(object, S_IRUGO, mxt_object_show, NULL);
- static DEVICE_ATTR(update_fw, S_IWUSR, NULL, mxt_update_fw_store);
- static struct attribute *mxt_attrs[] = {
- &dev_attr_fw_version.attr,
- &dev_attr_hw_version.attr,
- &dev_attr_object.attr,
- &dev_attr_update_fw.attr,
- NULL
- };
- static const struct attribute_group mxt_attr_group = {
- .attrs = mxt_attrs,
- };
- static void mxt_start(struct mxt_data *data)
- {
- switch (data->suspend_mode) {
- case MXT_SUSPEND_T9_CTRL:
- mxt_soft_reset(data);
- /* Touch enable */
- /* 0x83 = SCANEN | RPTEN | ENABLE */
- mxt_write_object(data,
- MXT_TOUCH_MULTI_T9, MXT_T9_CTRL, 0x83);
- break;
- case MXT_SUSPEND_DEEP_SLEEP:
- default:
- mxt_set_t7_power_cfg(data, MXT_POWER_CFG_RUN);
- /* Recalibrate since chip has been in deep sleep */
- mxt_t6_command(data, MXT_COMMAND_CALIBRATE, 1, false);
- break;
- }
- }
- static void mxt_stop(struct mxt_data *data)
- {
- switch (data->suspend_mode) {
- case MXT_SUSPEND_T9_CTRL:
- /* Touch disable */
- mxt_write_object(data,
- MXT_TOUCH_MULTI_T9, MXT_T9_CTRL, 0);
- break;
- case MXT_SUSPEND_DEEP_SLEEP:
- default:
- mxt_set_t7_power_cfg(data, MXT_POWER_CFG_DEEPSLEEP);
- break;
- }
- }
- static int mxt_input_open(struct input_dev *dev)
- {
- struct mxt_data *data = input_get_drvdata(dev);
- mxt_start(data);
- return 0;
- }
- static void mxt_input_close(struct input_dev *dev)
- {
- struct mxt_data *data = input_get_drvdata(dev);
- mxt_stop(data);
- }
- static int mxt_parse_device_properties(struct mxt_data *data)
- {
- static const char keymap_property[] = "linux,gpio-keymap";
- struct device *dev = &data->client->dev;
- u32 *keymap;
- int n_keys;
- int error;
- if (device_property_present(dev, keymap_property)) {
- n_keys = device_property_read_u32_array(dev, keymap_property,
- NULL, 0);
- if (n_keys <= 0) {
- error = n_keys < 0 ? n_keys : -EINVAL;
- dev_err(dev, "invalid/malformed '%s' property: %d\n",
- keymap_property, error);
- return error;
- }
- keymap = devm_kmalloc_array(dev, n_keys, sizeof(*keymap),
- GFP_KERNEL);
- if (!keymap)
- return -ENOMEM;
- error = device_property_read_u32_array(dev, keymap_property,
- keymap, n_keys);
- if (error) {
- dev_err(dev, "failed to parse '%s' property: %d\n",
- keymap_property, error);
- return error;
- }
- data->t19_keymap = keymap;
- data->t19_num_keys = n_keys;
- }
- return 0;
- }
- static const struct dmi_system_id chromebook_T9_suspend_dmi[] = {
- {
- .matches = {
- DMI_MATCH(DMI_SYS_VENDOR, "GOOGLE"),
- DMI_MATCH(DMI_PRODUCT_NAME, "Link"),
- },
- },
- {
- .matches = {
- DMI_MATCH(DMI_PRODUCT_NAME, "Peppy"),
- },
- },
- { }
- };
- static int mxt_probe(struct i2c_client *client, const struct i2c_device_id *id)
- {
- struct mxt_data *data;
- int error;
- /*
- * Ignore devices that do not have device properties attached to
- * them, as we need help determining whether we are dealing with
- * touch screen or touchpad.
- *
- * So far on x86 the only users of Atmel touch controllers are
- * Chromebooks, and chromeos_laptop driver will ensure that
- * necessary properties are provided (if firmware does not do that).
- */
- if (!device_property_present(&client->dev, "compatible"))
- return -ENXIO;
- /*
- * Ignore ACPI devices representing bootloader mode.
- *
- * This is a bit of a hack: Google Chromebook BIOS creates ACPI
- * devices for both application and bootloader modes, but we are
- * interested in application mode only (if device is in bootloader
- * mode we'll end up switching into application anyway). So far
- * application mode addresses were all above 0x40, so we'll use it
- * as a threshold.
- */
- if (ACPI_COMPANION(&client->dev) && client->addr < 0x40)
- return -ENXIO;
- data = devm_kzalloc(&client->dev, sizeof(struct mxt_data), GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- snprintf(data->phys, sizeof(data->phys), "i2c-%u-%04x/input0",
- client->adapter->nr, client->addr);
- data->client = client;
- data->irq = client->irq;
- i2c_set_clientdata(client, data);
- init_completion(&data->bl_completion);
- init_completion(&data->reset_completion);
- init_completion(&data->crc_completion);
- data->suspend_mode = dmi_check_system(chromebook_T9_suspend_dmi) ?
- MXT_SUSPEND_T9_CTRL : MXT_SUSPEND_DEEP_SLEEP;
- error = mxt_parse_device_properties(data);
- if (error)
- return error;
- data->reset_gpio = devm_gpiod_get_optional(&client->dev,
- "reset", GPIOD_OUT_LOW);
- if (IS_ERR(data->reset_gpio)) {
- error = PTR_ERR(data->reset_gpio);
- dev_err(&client->dev, "Failed to get reset gpio: %d\n", error);
- return error;
- }
- error = devm_request_threaded_irq(&client->dev, client->irq,
- NULL, mxt_interrupt, IRQF_ONESHOT,
- client->name, data);
- if (error) {
- dev_err(&client->dev, "Failed to register interrupt\n");
- return error;
- }
- disable_irq(client->irq);
- if (data->reset_gpio) {
- msleep(MXT_RESET_GPIO_TIME);
- gpiod_set_value(data->reset_gpio, 1);
- msleep(MXT_RESET_INVALID_CHG);
- }
- error = mxt_initialize(data);
- if (error)
- return error;
- error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group);
- if (error) {
- dev_err(&client->dev, "Failure %d creating sysfs group\n",
- error);
- goto err_free_object;
- }
- return 0;
- err_free_object:
- mxt_free_input_device(data);
- mxt_free_object_table(data);
- return error;
- }
- static int mxt_remove(struct i2c_client *client)
- {
- struct mxt_data *data = i2c_get_clientdata(client);
- disable_irq(data->irq);
- sysfs_remove_group(&client->dev.kobj, &mxt_attr_group);
- mxt_free_input_device(data);
- mxt_free_object_table(data);
- return 0;
- }
- static int __maybe_unused mxt_suspend(struct device *dev)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct mxt_data *data = i2c_get_clientdata(client);
- struct input_dev *input_dev = data->input_dev;
- if (!input_dev)
- return 0;
- mutex_lock(&input_dev->mutex);
- if (input_dev->users)
- mxt_stop(data);
- mutex_unlock(&input_dev->mutex);
- disable_irq(data->irq);
- return 0;
- }
- static int __maybe_unused mxt_resume(struct device *dev)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct mxt_data *data = i2c_get_clientdata(client);
- struct input_dev *input_dev = data->input_dev;
- if (!input_dev)
- return 0;
- enable_irq(data->irq);
- mutex_lock(&input_dev->mutex);
- if (input_dev->users)
- mxt_start(data);
- mutex_unlock(&input_dev->mutex);
- return 0;
- }
- static SIMPLE_DEV_PM_OPS(mxt_pm_ops, mxt_suspend, mxt_resume);
- static const struct of_device_id mxt_of_match[] = {
- { .compatible = "atmel,maxtouch", },
- /* Compatibles listed below are deprecated */
- { .compatible = "atmel,qt602240_ts", },
- { .compatible = "atmel,atmel_mxt_ts", },
- { .compatible = "atmel,atmel_mxt_tp", },
- { .compatible = "atmel,mXT224", },
- {},
- };
- MODULE_DEVICE_TABLE(of, mxt_of_match);
- #ifdef CONFIG_ACPI
- static const struct acpi_device_id mxt_acpi_id[] = {
- { "ATML0000", 0 }, /* Touchpad */
- { "ATML0001", 0 }, /* Touchscreen */
- { }
- };
- MODULE_DEVICE_TABLE(acpi, mxt_acpi_id);
- #endif
- static const struct i2c_device_id mxt_id[] = {
- { "qt602240_ts", 0 },
- { "atmel_mxt_ts", 0 },
- { "atmel_mxt_tp", 0 },
- { "maxtouch", 0 },
- { "mXT224", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, mxt_id);
- static struct i2c_driver mxt_driver = {
- .driver = {
- .name = "atmel_mxt_ts",
- .of_match_table = mxt_of_match,
- .acpi_match_table = ACPI_PTR(mxt_acpi_id),
- .pm = &mxt_pm_ops,
- },
- .probe = mxt_probe,
- .remove = mxt_remove,
- .id_table = mxt_id,
- };
- module_i2c_driver(mxt_driver);
- /* Module information */
- MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
- MODULE_DESCRIPTION("Atmel maXTouch Touchscreen driver");
- MODULE_LICENSE("GPL");
|