sdhci.c 91 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516
  1. /*
  2. * linux/drivers/mmc/host/sdhci.c - Secure Digital Host Controller Interface driver
  3. *
  4. * Copyright (C) 2005-2008 Pierre Ossman, All Rights Reserved.
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or (at
  9. * your option) any later version.
  10. *
  11. * Thanks to the following companies for their support:
  12. *
  13. * - JMicron (hardware and technical support)
  14. */
  15. #include <linux/delay.h>
  16. #include <linux/highmem.h>
  17. #include <linux/io.h>
  18. #include <linux/module.h>
  19. #include <linux/dma-mapping.h>
  20. #include <linux/slab.h>
  21. #include <linux/scatterlist.h>
  22. #include <linux/regulator/consumer.h>
  23. #include <linux/pm_runtime.h>
  24. #include <linux/leds.h>
  25. #include <linux/mmc/mmc.h>
  26. #include <linux/mmc/host.h>
  27. #include <linux/mmc/card.h>
  28. #include <linux/mmc/sdio.h>
  29. #include <linux/mmc/slot-gpio.h>
  30. #include "sdhci.h"
  31. #define DRIVER_NAME "sdhci"
  32. #define DBG(f, x...) \
  33. pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
  34. #if defined(CONFIG_LEDS_CLASS) || (defined(CONFIG_LEDS_CLASS_MODULE) && \
  35. defined(CONFIG_MMC_SDHCI_MODULE))
  36. #define SDHCI_USE_LEDS_CLASS
  37. #endif
  38. #define MAX_TUNING_LOOP 40
  39. static unsigned int debug_quirks = 0;
  40. static unsigned int debug_quirks2;
  41. static void sdhci_finish_data(struct sdhci_host *);
  42. static void sdhci_finish_command(struct sdhci_host *);
  43. static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode);
  44. static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
  45. static int sdhci_pre_dma_transfer(struct sdhci_host *host,
  46. struct mmc_data *data);
  47. static int sdhci_do_get_cd(struct sdhci_host *host);
  48. #ifdef CONFIG_PM
  49. static int sdhci_runtime_pm_get(struct sdhci_host *host);
  50. static int sdhci_runtime_pm_put(struct sdhci_host *host);
  51. static void sdhci_runtime_pm_bus_on(struct sdhci_host *host);
  52. static void sdhci_runtime_pm_bus_off(struct sdhci_host *host);
  53. #else
  54. static inline int sdhci_runtime_pm_get(struct sdhci_host *host)
  55. {
  56. return 0;
  57. }
  58. static inline int sdhci_runtime_pm_put(struct sdhci_host *host)
  59. {
  60. return 0;
  61. }
  62. static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
  63. {
  64. }
  65. static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
  66. {
  67. }
  68. #endif
  69. static void sdhci_dumpregs(struct sdhci_host *host)
  70. {
  71. pr_debug(DRIVER_NAME ": =========== REGISTER DUMP (%s)===========\n",
  72. mmc_hostname(host->mmc));
  73. pr_debug(DRIVER_NAME ": Sys addr: 0x%08x | Version: 0x%08x\n",
  74. sdhci_readl(host, SDHCI_DMA_ADDRESS),
  75. sdhci_readw(host, SDHCI_HOST_VERSION));
  76. pr_debug(DRIVER_NAME ": Blk size: 0x%08x | Blk cnt: 0x%08x\n",
  77. sdhci_readw(host, SDHCI_BLOCK_SIZE),
  78. sdhci_readw(host, SDHCI_BLOCK_COUNT));
  79. pr_debug(DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
  80. sdhci_readl(host, SDHCI_ARGUMENT),
  81. sdhci_readw(host, SDHCI_TRANSFER_MODE));
  82. pr_debug(DRIVER_NAME ": Present: 0x%08x | Host ctl: 0x%08x\n",
  83. sdhci_readl(host, SDHCI_PRESENT_STATE),
  84. sdhci_readb(host, SDHCI_HOST_CONTROL));
  85. pr_debug(DRIVER_NAME ": Power: 0x%08x | Blk gap: 0x%08x\n",
  86. sdhci_readb(host, SDHCI_POWER_CONTROL),
  87. sdhci_readb(host, SDHCI_BLOCK_GAP_CONTROL));
  88. pr_debug(DRIVER_NAME ": Wake-up: 0x%08x | Clock: 0x%08x\n",
  89. sdhci_readb(host, SDHCI_WAKE_UP_CONTROL),
  90. sdhci_readw(host, SDHCI_CLOCK_CONTROL));
  91. pr_debug(DRIVER_NAME ": Timeout: 0x%08x | Int stat: 0x%08x\n",
  92. sdhci_readb(host, SDHCI_TIMEOUT_CONTROL),
  93. sdhci_readl(host, SDHCI_INT_STATUS));
  94. pr_debug(DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
  95. sdhci_readl(host, SDHCI_INT_ENABLE),
  96. sdhci_readl(host, SDHCI_SIGNAL_ENABLE));
  97. pr_debug(DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
  98. sdhci_readw(host, SDHCI_ACMD12_ERR),
  99. sdhci_readw(host, SDHCI_SLOT_INT_STATUS));
  100. pr_debug(DRIVER_NAME ": Caps: 0x%08x | Caps_1: 0x%08x\n",
  101. sdhci_readl(host, SDHCI_CAPABILITIES),
  102. sdhci_readl(host, SDHCI_CAPABILITIES_1));
  103. pr_debug(DRIVER_NAME ": Cmd: 0x%08x | Max curr: 0x%08x\n",
  104. sdhci_readw(host, SDHCI_COMMAND),
  105. sdhci_readl(host, SDHCI_MAX_CURRENT));
  106. pr_debug(DRIVER_NAME ": Host ctl2: 0x%08x\n",
  107. sdhci_readw(host, SDHCI_HOST_CONTROL2));
  108. if (host->flags & SDHCI_USE_ADMA) {
  109. if (host->flags & SDHCI_USE_64_BIT_DMA)
  110. pr_debug(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x%08x\n",
  111. readl(host->ioaddr + SDHCI_ADMA_ERROR),
  112. readl(host->ioaddr + SDHCI_ADMA_ADDRESS_HI),
  113. readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
  114. else
  115. pr_debug(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x\n",
  116. readl(host->ioaddr + SDHCI_ADMA_ERROR),
  117. readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
  118. }
  119. pr_debug(DRIVER_NAME ": ===========================================\n");
  120. }
  121. /*****************************************************************************\
  122. * *
  123. * Low level functions *
  124. * *
  125. \*****************************************************************************/
  126. static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)
  127. {
  128. u32 present;
  129. if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
  130. (host->mmc->caps & MMC_CAP_NONREMOVABLE))
  131. return;
  132. if (enable) {
  133. present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
  134. SDHCI_CARD_PRESENT;
  135. host->ier |= present ? SDHCI_INT_CARD_REMOVE :
  136. SDHCI_INT_CARD_INSERT;
  137. } else {
  138. host->ier &= ~(SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT);
  139. }
  140. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  141. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  142. }
  143. static void sdhci_enable_card_detection(struct sdhci_host *host)
  144. {
  145. sdhci_set_card_detection(host, true);
  146. }
  147. static void sdhci_disable_card_detection(struct sdhci_host *host)
  148. {
  149. sdhci_set_card_detection(host, false);
  150. }
  151. void sdhci_reset(struct sdhci_host *host, u8 mask)
  152. {
  153. unsigned long timeout;
  154. sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
  155. if (mask & SDHCI_RESET_ALL) {
  156. host->clock = 0;
  157. /* Reset-all turns off SD Bus Power */
  158. if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
  159. sdhci_runtime_pm_bus_off(host);
  160. }
  161. /* Wait max 100 ms */
  162. timeout = 100;
  163. /* hw clears the bit when it's done */
  164. while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
  165. if (timeout == 0) {
  166. pr_err("%s: Reset 0x%x never completed.\n",
  167. mmc_hostname(host->mmc), (int)mask);
  168. sdhci_dumpregs(host);
  169. return;
  170. }
  171. timeout--;
  172. mdelay(1);
  173. }
  174. }
  175. EXPORT_SYMBOL_GPL(sdhci_reset);
  176. static void sdhci_do_reset(struct sdhci_host *host, u8 mask)
  177. {
  178. if (host->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
  179. if (!sdhci_do_get_cd(host))
  180. return;
  181. }
  182. host->ops->reset(host, mask);
  183. if (mask & SDHCI_RESET_ALL) {
  184. if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
  185. if (host->ops->enable_dma)
  186. host->ops->enable_dma(host);
  187. }
  188. /* Resetting the controller clears many */
  189. host->preset_enabled = false;
  190. }
  191. }
  192. static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios);
  193. static void sdhci_init(struct sdhci_host *host, int soft)
  194. {
  195. if (soft)
  196. sdhci_do_reset(host, SDHCI_RESET_CMD|SDHCI_RESET_DATA);
  197. else
  198. sdhci_do_reset(host, SDHCI_RESET_ALL);
  199. host->ier = SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
  200. SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT |
  201. SDHCI_INT_INDEX | SDHCI_INT_END_BIT | SDHCI_INT_CRC |
  202. SDHCI_INT_TIMEOUT | SDHCI_INT_DATA_END |
  203. SDHCI_INT_RESPONSE;
  204. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  205. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  206. if (soft) {
  207. /* force clock reconfiguration */
  208. host->clock = 0;
  209. sdhci_set_ios(host->mmc, &host->mmc->ios);
  210. }
  211. }
  212. static void sdhci_reinit(struct sdhci_host *host)
  213. {
  214. sdhci_init(host, 0);
  215. sdhci_enable_card_detection(host);
  216. }
  217. static void sdhci_activate_led(struct sdhci_host *host)
  218. {
  219. u8 ctrl;
  220. ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
  221. ctrl |= SDHCI_CTRL_LED;
  222. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  223. }
  224. static void sdhci_deactivate_led(struct sdhci_host *host)
  225. {
  226. u8 ctrl;
  227. ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
  228. ctrl &= ~SDHCI_CTRL_LED;
  229. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  230. }
  231. #ifdef SDHCI_USE_LEDS_CLASS
  232. static void sdhci_led_control(struct led_classdev *led,
  233. enum led_brightness brightness)
  234. {
  235. struct sdhci_host *host = container_of(led, struct sdhci_host, led);
  236. unsigned long flags;
  237. spin_lock_irqsave(&host->lock, flags);
  238. if (host->runtime_suspended)
  239. goto out;
  240. if (brightness == LED_OFF)
  241. sdhci_deactivate_led(host);
  242. else
  243. sdhci_activate_led(host);
  244. out:
  245. spin_unlock_irqrestore(&host->lock, flags);
  246. }
  247. #endif
  248. /*****************************************************************************\
  249. * *
  250. * Core functions *
  251. * *
  252. \*****************************************************************************/
  253. static void sdhci_read_block_pio(struct sdhci_host *host)
  254. {
  255. unsigned long flags;
  256. size_t blksize, len, chunk;
  257. u32 uninitialized_var(scratch);
  258. u8 *buf;
  259. DBG("PIO reading\n");
  260. blksize = host->data->blksz;
  261. chunk = 0;
  262. local_irq_save(flags);
  263. while (blksize) {
  264. BUG_ON(!sg_miter_next(&host->sg_miter));
  265. len = min(host->sg_miter.length, blksize);
  266. blksize -= len;
  267. host->sg_miter.consumed = len;
  268. buf = host->sg_miter.addr;
  269. while (len) {
  270. if (chunk == 0) {
  271. scratch = sdhci_readl(host, SDHCI_BUFFER);
  272. chunk = 4;
  273. }
  274. *buf = scratch & 0xFF;
  275. buf++;
  276. scratch >>= 8;
  277. chunk--;
  278. len--;
  279. }
  280. }
  281. sg_miter_stop(&host->sg_miter);
  282. local_irq_restore(flags);
  283. }
  284. static void sdhci_write_block_pio(struct sdhci_host *host)
  285. {
  286. unsigned long flags;
  287. size_t blksize, len, chunk;
  288. u32 scratch;
  289. u8 *buf;
  290. DBG("PIO writing\n");
  291. blksize = host->data->blksz;
  292. chunk = 0;
  293. scratch = 0;
  294. local_irq_save(flags);
  295. while (blksize) {
  296. BUG_ON(!sg_miter_next(&host->sg_miter));
  297. len = min(host->sg_miter.length, blksize);
  298. blksize -= len;
  299. host->sg_miter.consumed = len;
  300. buf = host->sg_miter.addr;
  301. while (len) {
  302. scratch |= (u32)*buf << (chunk * 8);
  303. buf++;
  304. chunk++;
  305. len--;
  306. if ((chunk == 4) || ((len == 0) && (blksize == 0))) {
  307. sdhci_writel(host, scratch, SDHCI_BUFFER);
  308. chunk = 0;
  309. scratch = 0;
  310. }
  311. }
  312. }
  313. sg_miter_stop(&host->sg_miter);
  314. local_irq_restore(flags);
  315. }
  316. static void sdhci_transfer_pio(struct sdhci_host *host)
  317. {
  318. u32 mask;
  319. BUG_ON(!host->data);
  320. if (host->blocks == 0)
  321. return;
  322. if (host->data->flags & MMC_DATA_READ)
  323. mask = SDHCI_DATA_AVAILABLE;
  324. else
  325. mask = SDHCI_SPACE_AVAILABLE;
  326. /*
  327. * Some controllers (JMicron JMB38x) mess up the buffer bits
  328. * for transfers < 4 bytes. As long as it is just one block,
  329. * we can ignore the bits.
  330. */
  331. if ((host->quirks & SDHCI_QUIRK_BROKEN_SMALL_PIO) &&
  332. (host->data->blocks == 1))
  333. mask = ~0;
  334. while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
  335. if (host->quirks & SDHCI_QUIRK_PIO_NEEDS_DELAY)
  336. udelay(100);
  337. if (host->data->flags & MMC_DATA_READ)
  338. sdhci_read_block_pio(host);
  339. else
  340. sdhci_write_block_pio(host);
  341. host->blocks--;
  342. if (host->blocks == 0)
  343. break;
  344. }
  345. DBG("PIO transfer complete.\n");
  346. }
  347. static char *sdhci_kmap_atomic(struct scatterlist *sg, unsigned long *flags)
  348. {
  349. local_irq_save(*flags);
  350. return kmap_atomic(sg_page(sg)) + sg->offset;
  351. }
  352. static void sdhci_kunmap_atomic(void *buffer, unsigned long *flags)
  353. {
  354. kunmap_atomic(buffer);
  355. local_irq_restore(*flags);
  356. }
  357. static void sdhci_adma_write_desc(struct sdhci_host *host, void *desc,
  358. dma_addr_t addr, int len, unsigned cmd)
  359. {
  360. struct sdhci_adma2_64_desc *dma_desc = desc;
  361. /* 32-bit and 64-bit descriptors have these members in same position */
  362. dma_desc->cmd = cpu_to_le16(cmd);
  363. dma_desc->len = cpu_to_le16(len);
  364. dma_desc->addr_lo = cpu_to_le32((u32)addr);
  365. if (host->flags & SDHCI_USE_64_BIT_DMA)
  366. dma_desc->addr_hi = cpu_to_le32((u64)addr >> 32);
  367. }
  368. static void sdhci_adma_mark_end(void *desc)
  369. {
  370. struct sdhci_adma2_64_desc *dma_desc = desc;
  371. /* 32-bit and 64-bit descriptors have 'cmd' in same position */
  372. dma_desc->cmd |= cpu_to_le16(ADMA2_END);
  373. }
  374. static int sdhci_adma_table_pre(struct sdhci_host *host,
  375. struct mmc_data *data)
  376. {
  377. int direction;
  378. void *desc;
  379. void *align;
  380. dma_addr_t addr;
  381. dma_addr_t align_addr;
  382. int len, offset;
  383. struct scatterlist *sg;
  384. int i;
  385. char *buffer;
  386. unsigned long flags;
  387. /*
  388. * The spec does not specify endianness of descriptor table.
  389. * We currently guess that it is LE.
  390. */
  391. if (data->flags & MMC_DATA_READ)
  392. direction = DMA_FROM_DEVICE;
  393. else
  394. direction = DMA_TO_DEVICE;
  395. host->align_addr = dma_map_single(mmc_dev(host->mmc),
  396. host->align_buffer, host->align_buffer_sz, direction);
  397. if (dma_mapping_error(mmc_dev(host->mmc), host->align_addr))
  398. goto fail;
  399. BUG_ON(host->align_addr & host->align_mask);
  400. host->sg_count = sdhci_pre_dma_transfer(host, data);
  401. if (host->sg_count < 0)
  402. goto unmap_align;
  403. desc = host->adma_table;
  404. align = host->align_buffer;
  405. align_addr = host->align_addr;
  406. for_each_sg(data->sg, sg, host->sg_count, i) {
  407. addr = sg_dma_address(sg);
  408. len = sg_dma_len(sg);
  409. /*
  410. * The SDHCI specification states that ADMA
  411. * addresses must be 32-bit aligned. If they
  412. * aren't, then we use a bounce buffer for
  413. * the (up to three) bytes that screw up the
  414. * alignment.
  415. */
  416. offset = (host->align_sz - (addr & host->align_mask)) &
  417. host->align_mask;
  418. if (offset) {
  419. if (data->flags & MMC_DATA_WRITE) {
  420. buffer = sdhci_kmap_atomic(sg, &flags);
  421. memcpy(align, buffer, offset);
  422. sdhci_kunmap_atomic(buffer, &flags);
  423. }
  424. /* tran, valid */
  425. sdhci_adma_write_desc(host, desc, align_addr, offset,
  426. ADMA2_TRAN_VALID);
  427. BUG_ON(offset > 65536);
  428. align += host->align_sz;
  429. align_addr += host->align_sz;
  430. desc += host->desc_sz;
  431. addr += offset;
  432. len -= offset;
  433. }
  434. BUG_ON(len > 65536);
  435. /* tran, valid */
  436. sdhci_adma_write_desc(host, desc, addr, len, ADMA2_TRAN_VALID);
  437. desc += host->desc_sz;
  438. /*
  439. * If this triggers then we have a calculation bug
  440. * somewhere. :/
  441. */
  442. WARN_ON((desc - host->adma_table) >= host->adma_table_sz);
  443. }
  444. if (host->quirks & SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC) {
  445. /*
  446. * Mark the last descriptor as the terminating descriptor
  447. */
  448. if (desc != host->adma_table) {
  449. desc -= host->desc_sz;
  450. sdhci_adma_mark_end(desc);
  451. }
  452. } else {
  453. /*
  454. * Add a terminating entry.
  455. */
  456. /* nop, end, valid */
  457. sdhci_adma_write_desc(host, desc, 0, 0, ADMA2_NOP_END_VALID);
  458. }
  459. /*
  460. * Resync align buffer as we might have changed it.
  461. */
  462. if (data->flags & MMC_DATA_WRITE) {
  463. dma_sync_single_for_device(mmc_dev(host->mmc),
  464. host->align_addr, host->align_buffer_sz, direction);
  465. }
  466. return 0;
  467. unmap_align:
  468. dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
  469. host->align_buffer_sz, direction);
  470. fail:
  471. return -EINVAL;
  472. }
  473. static void sdhci_adma_table_post(struct sdhci_host *host,
  474. struct mmc_data *data)
  475. {
  476. int direction;
  477. struct scatterlist *sg;
  478. int i, size;
  479. void *align;
  480. char *buffer;
  481. unsigned long flags;
  482. bool has_unaligned;
  483. if (data->flags & MMC_DATA_READ)
  484. direction = DMA_FROM_DEVICE;
  485. else
  486. direction = DMA_TO_DEVICE;
  487. dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
  488. host->align_buffer_sz, direction);
  489. /* Do a quick scan of the SG list for any unaligned mappings */
  490. has_unaligned = false;
  491. for_each_sg(data->sg, sg, host->sg_count, i)
  492. if (sg_dma_address(sg) & host->align_mask) {
  493. has_unaligned = true;
  494. break;
  495. }
  496. if (has_unaligned && data->flags & MMC_DATA_READ) {
  497. dma_sync_sg_for_cpu(mmc_dev(host->mmc), data->sg,
  498. data->sg_len, direction);
  499. align = host->align_buffer;
  500. for_each_sg(data->sg, sg, host->sg_count, i) {
  501. if (sg_dma_address(sg) & host->align_mask) {
  502. size = host->align_sz -
  503. (sg_dma_address(sg) & host->align_mask);
  504. buffer = sdhci_kmap_atomic(sg, &flags);
  505. memcpy(buffer, align, size);
  506. sdhci_kunmap_atomic(buffer, &flags);
  507. align += host->align_sz;
  508. }
  509. }
  510. }
  511. if (data->host_cookie == COOKIE_MAPPED) {
  512. dma_unmap_sg(mmc_dev(host->mmc), data->sg,
  513. data->sg_len, direction);
  514. data->host_cookie = COOKIE_UNMAPPED;
  515. }
  516. }
  517. static u8 sdhci_calc_timeout(struct sdhci_host *host, struct mmc_command *cmd)
  518. {
  519. u8 count;
  520. struct mmc_data *data = cmd->data;
  521. unsigned target_timeout, current_timeout;
  522. /*
  523. * If the host controller provides us with an incorrect timeout
  524. * value, just skip the check and use 0xE. The hardware may take
  525. * longer to time out, but that's much better than having a too-short
  526. * timeout value.
  527. */
  528. if (host->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL)
  529. return 0xE;
  530. /* Unspecified timeout, assume max */
  531. if (!data && !cmd->busy_timeout)
  532. return 0xE;
  533. /* timeout in us */
  534. if (!data)
  535. target_timeout = cmd->busy_timeout * 1000;
  536. else {
  537. target_timeout = data->timeout_ns / 1000;
  538. if (host->clock)
  539. target_timeout += data->timeout_clks / host->clock;
  540. }
  541. /*
  542. * Figure out needed cycles.
  543. * We do this in steps in order to fit inside a 32 bit int.
  544. * The first step is the minimum timeout, which will have a
  545. * minimum resolution of 6 bits:
  546. * (1) 2^13*1000 > 2^22,
  547. * (2) host->timeout_clk < 2^16
  548. * =>
  549. * (1) / (2) > 2^6
  550. */
  551. count = 0;
  552. current_timeout = (1 << 13) * 1000 / host->timeout_clk;
  553. while (current_timeout < target_timeout) {
  554. count++;
  555. current_timeout <<= 1;
  556. if (count >= 0xF)
  557. break;
  558. }
  559. if (count >= 0xF) {
  560. DBG("%s: Too large timeout 0x%x requested for CMD%d!\n",
  561. mmc_hostname(host->mmc), count, cmd->opcode);
  562. count = 0xE;
  563. }
  564. return count;
  565. }
  566. static void sdhci_set_transfer_irqs(struct sdhci_host *host)
  567. {
  568. u32 pio_irqs = SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL;
  569. u32 dma_irqs = SDHCI_INT_DMA_END | SDHCI_INT_ADMA_ERROR;
  570. if (host->flags & SDHCI_REQ_USE_DMA)
  571. host->ier = (host->ier & ~pio_irqs) | dma_irqs;
  572. else
  573. host->ier = (host->ier & ~dma_irqs) | pio_irqs;
  574. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  575. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  576. }
  577. static void sdhci_set_timeout(struct sdhci_host *host, struct mmc_command *cmd)
  578. {
  579. u8 count;
  580. if (host->ops->set_timeout) {
  581. host->ops->set_timeout(host, cmd);
  582. } else {
  583. count = sdhci_calc_timeout(host, cmd);
  584. sdhci_writeb(host, count, SDHCI_TIMEOUT_CONTROL);
  585. }
  586. }
  587. static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_command *cmd)
  588. {
  589. u8 ctrl;
  590. struct mmc_data *data = cmd->data;
  591. int ret;
  592. WARN_ON(host->data);
  593. if (data || (cmd->flags & MMC_RSP_BUSY))
  594. sdhci_set_timeout(host, cmd);
  595. if (!data)
  596. return;
  597. /* Sanity checks */
  598. BUG_ON(data->blksz * data->blocks > 524288);
  599. BUG_ON(data->blksz > host->mmc->max_blk_size);
  600. BUG_ON(data->blocks > 65535);
  601. host->data = data;
  602. host->data_early = 0;
  603. host->data->bytes_xfered = 0;
  604. if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))
  605. host->flags |= SDHCI_REQ_USE_DMA;
  606. /*
  607. * FIXME: This doesn't account for merging when mapping the
  608. * scatterlist.
  609. */
  610. if (host->flags & SDHCI_REQ_USE_DMA) {
  611. int broken, i;
  612. struct scatterlist *sg;
  613. broken = 0;
  614. if (host->flags & SDHCI_USE_ADMA) {
  615. if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
  616. broken = 1;
  617. } else {
  618. if (host->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE)
  619. broken = 1;
  620. }
  621. if (unlikely(broken)) {
  622. for_each_sg(data->sg, sg, data->sg_len, i) {
  623. if (sg->length & 0x3) {
  624. DBG("Reverting to PIO because of "
  625. "transfer size (%d)\n",
  626. sg->length);
  627. host->flags &= ~SDHCI_REQ_USE_DMA;
  628. break;
  629. }
  630. }
  631. }
  632. }
  633. /*
  634. * The assumption here being that alignment is the same after
  635. * translation to device address space.
  636. */
  637. if (host->flags & SDHCI_REQ_USE_DMA) {
  638. int broken, i;
  639. struct scatterlist *sg;
  640. broken = 0;
  641. if (host->flags & SDHCI_USE_ADMA) {
  642. /*
  643. * As we use 3 byte chunks to work around
  644. * alignment problems, we need to check this
  645. * quirk.
  646. */
  647. if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
  648. broken = 1;
  649. } else {
  650. if (host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR)
  651. broken = 1;
  652. }
  653. if (unlikely(broken)) {
  654. for_each_sg(data->sg, sg, data->sg_len, i) {
  655. if (sg->offset & 0x3) {
  656. DBG("Reverting to PIO because of "
  657. "bad alignment\n");
  658. host->flags &= ~SDHCI_REQ_USE_DMA;
  659. break;
  660. }
  661. }
  662. }
  663. }
  664. if (host->flags & SDHCI_REQ_USE_DMA) {
  665. if (host->flags & SDHCI_USE_ADMA) {
  666. ret = sdhci_adma_table_pre(host, data);
  667. if (ret) {
  668. /*
  669. * This only happens when someone fed
  670. * us an invalid request.
  671. */
  672. WARN_ON(1);
  673. host->flags &= ~SDHCI_REQ_USE_DMA;
  674. } else {
  675. sdhci_writel(host, host->adma_addr,
  676. SDHCI_ADMA_ADDRESS);
  677. if (host->flags & SDHCI_USE_64_BIT_DMA)
  678. sdhci_writel(host,
  679. (u64)host->adma_addr >> 32,
  680. SDHCI_ADMA_ADDRESS_HI);
  681. }
  682. } else {
  683. int sg_cnt;
  684. sg_cnt = sdhci_pre_dma_transfer(host, data);
  685. if (sg_cnt <= 0) {
  686. /*
  687. * This only happens when someone fed
  688. * us an invalid request.
  689. */
  690. WARN_ON(1);
  691. host->flags &= ~SDHCI_REQ_USE_DMA;
  692. } else {
  693. WARN_ON(sg_cnt != 1);
  694. sdhci_writel(host, sg_dma_address(data->sg),
  695. SDHCI_DMA_ADDRESS);
  696. }
  697. }
  698. }
  699. /*
  700. * Always adjust the DMA selection as some controllers
  701. * (e.g. JMicron) can't do PIO properly when the selection
  702. * is ADMA.
  703. */
  704. if (host->version >= SDHCI_SPEC_200) {
  705. ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
  706. ctrl &= ~SDHCI_CTRL_DMA_MASK;
  707. if ((host->flags & SDHCI_REQ_USE_DMA) &&
  708. (host->flags & SDHCI_USE_ADMA)) {
  709. if (host->flags & SDHCI_USE_64_BIT_DMA)
  710. ctrl |= SDHCI_CTRL_ADMA64;
  711. else
  712. ctrl |= SDHCI_CTRL_ADMA32;
  713. } else {
  714. ctrl |= SDHCI_CTRL_SDMA;
  715. }
  716. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  717. }
  718. if (!(host->flags & SDHCI_REQ_USE_DMA)) {
  719. int flags;
  720. flags = SG_MITER_ATOMIC;
  721. if (host->data->flags & MMC_DATA_READ)
  722. flags |= SG_MITER_TO_SG;
  723. else
  724. flags |= SG_MITER_FROM_SG;
  725. sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
  726. host->blocks = data->blocks;
  727. }
  728. sdhci_set_transfer_irqs(host);
  729. /* Set the DMA boundary value and block size */
  730. sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
  731. data->blksz), SDHCI_BLOCK_SIZE);
  732. sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
  733. }
  734. static void sdhci_set_transfer_mode(struct sdhci_host *host,
  735. struct mmc_command *cmd)
  736. {
  737. u16 mode = 0;
  738. struct mmc_data *data = cmd->data;
  739. if (data == NULL) {
  740. if (host->quirks2 &
  741. SDHCI_QUIRK2_CLEAR_TRANSFERMODE_REG_BEFORE_CMD) {
  742. sdhci_writew(host, 0x0, SDHCI_TRANSFER_MODE);
  743. } else {
  744. /* clear Auto CMD settings for no data CMDs */
  745. mode = sdhci_readw(host, SDHCI_TRANSFER_MODE);
  746. sdhci_writew(host, mode & ~(SDHCI_TRNS_AUTO_CMD12 |
  747. SDHCI_TRNS_AUTO_CMD23), SDHCI_TRANSFER_MODE);
  748. }
  749. return;
  750. }
  751. WARN_ON(!host->data);
  752. if (!(host->quirks2 & SDHCI_QUIRK2_SUPPORT_SINGLE))
  753. mode = SDHCI_TRNS_BLK_CNT_EN;
  754. if (mmc_op_multi(cmd->opcode) || data->blocks > 1) {
  755. mode = SDHCI_TRNS_BLK_CNT_EN | SDHCI_TRNS_MULTI;
  756. /*
  757. * If we are sending CMD23, CMD12 never gets sent
  758. * on successful completion (so no Auto-CMD12).
  759. */
  760. if (!host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD12) &&
  761. (cmd->opcode != SD_IO_RW_EXTENDED))
  762. mode |= SDHCI_TRNS_AUTO_CMD12;
  763. else if (host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD23)) {
  764. mode |= SDHCI_TRNS_AUTO_CMD23;
  765. sdhci_writel(host, host->mrq->sbc->arg, SDHCI_ARGUMENT2);
  766. }
  767. }
  768. if (data->flags & MMC_DATA_READ)
  769. mode |= SDHCI_TRNS_READ;
  770. if (host->flags & SDHCI_REQ_USE_DMA)
  771. mode |= SDHCI_TRNS_DMA;
  772. sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
  773. }
  774. static void sdhci_finish_data(struct sdhci_host *host)
  775. {
  776. struct mmc_data *data;
  777. BUG_ON(!host->data);
  778. data = host->data;
  779. host->data = NULL;
  780. if (host->flags & SDHCI_REQ_USE_DMA) {
  781. if (host->flags & SDHCI_USE_ADMA)
  782. sdhci_adma_table_post(host, data);
  783. else {
  784. if (data->host_cookie == COOKIE_MAPPED) {
  785. dma_unmap_sg(mmc_dev(host->mmc),
  786. data->sg, data->sg_len,
  787. (data->flags & MMC_DATA_READ) ?
  788. DMA_FROM_DEVICE : DMA_TO_DEVICE);
  789. data->host_cookie = COOKIE_UNMAPPED;
  790. }
  791. }
  792. }
  793. /*
  794. * The specification states that the block count register must
  795. * be updated, but it does not specify at what point in the
  796. * data flow. That makes the register entirely useless to read
  797. * back so we have to assume that nothing made it to the card
  798. * in the event of an error.
  799. */
  800. if (data->error)
  801. data->bytes_xfered = 0;
  802. else
  803. data->bytes_xfered = data->blksz * data->blocks;
  804. /*
  805. * Need to send CMD12 if -
  806. * a) open-ended multiblock transfer (no CMD23)
  807. * b) error in multiblock transfer
  808. */
  809. if (data->stop &&
  810. (data->error ||
  811. !host->mrq->sbc)) {
  812. /*
  813. * The controller needs a reset of internal state machines
  814. * upon error conditions.
  815. */
  816. if (data->error) {
  817. sdhci_do_reset(host, SDHCI_RESET_CMD);
  818. sdhci_do_reset(host, SDHCI_RESET_DATA);
  819. }
  820. sdhci_send_command(host, data->stop);
  821. } else
  822. tasklet_schedule(&host->finish_tasklet);
  823. }
  824. void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
  825. {
  826. int flags;
  827. u32 mask;
  828. unsigned long timeout;
  829. WARN_ON(host->cmd);
  830. /* Wait max 10 ms */
  831. timeout = 10;
  832. mask = SDHCI_CMD_INHIBIT;
  833. if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
  834. mask |= SDHCI_DATA_INHIBIT;
  835. /* We shouldn't wait for data inihibit for stop commands, even
  836. though they might use busy signaling */
  837. if (host->mrq->data && (cmd == host->mrq->data->stop))
  838. mask &= ~SDHCI_DATA_INHIBIT;
  839. while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
  840. if (timeout == 0) {
  841. pr_err("%s: Controller never released "
  842. "inhibit bit(s).\n", mmc_hostname(host->mmc));
  843. sdhci_dumpregs(host);
  844. cmd->error = -EIO;
  845. tasklet_schedule(&host->finish_tasklet);
  846. return;
  847. }
  848. timeout--;
  849. mdelay(1);
  850. }
  851. timeout = jiffies;
  852. if (!cmd->data && cmd->busy_timeout > 9000)
  853. timeout += DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ;
  854. else
  855. timeout += 10 * HZ;
  856. mod_timer(&host->timer, timeout);
  857. host->cmd = cmd;
  858. host->busy_handle = 0;
  859. sdhci_prepare_data(host, cmd);
  860. sdhci_writel(host, cmd->arg, SDHCI_ARGUMENT);
  861. sdhci_set_transfer_mode(host, cmd);
  862. if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
  863. pr_err("%s: Unsupported response type!\n",
  864. mmc_hostname(host->mmc));
  865. cmd->error = -EINVAL;
  866. tasklet_schedule(&host->finish_tasklet);
  867. return;
  868. }
  869. if (!(cmd->flags & MMC_RSP_PRESENT))
  870. flags = SDHCI_CMD_RESP_NONE;
  871. else if (cmd->flags & MMC_RSP_136)
  872. flags = SDHCI_CMD_RESP_LONG;
  873. else if (cmd->flags & MMC_RSP_BUSY)
  874. flags = SDHCI_CMD_RESP_SHORT_BUSY;
  875. else
  876. flags = SDHCI_CMD_RESP_SHORT;
  877. if (cmd->flags & MMC_RSP_CRC)
  878. flags |= SDHCI_CMD_CRC;
  879. if (cmd->flags & MMC_RSP_OPCODE)
  880. flags |= SDHCI_CMD_INDEX;
  881. /* CMD19 is special in that the Data Present Select should be set */
  882. if (cmd->data || cmd->opcode == MMC_SEND_TUNING_BLOCK ||
  883. cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)
  884. flags |= SDHCI_CMD_DATA;
  885. sdhci_writew(host, SDHCI_MAKE_CMD(cmd->opcode, flags), SDHCI_COMMAND);
  886. }
  887. EXPORT_SYMBOL_GPL(sdhci_send_command);
  888. static void sdhci_finish_command(struct sdhci_host *host)
  889. {
  890. int i;
  891. BUG_ON(host->cmd == NULL);
  892. if (host->cmd->flags & MMC_RSP_PRESENT) {
  893. if (host->cmd->flags & MMC_RSP_136) {
  894. /* CRC is stripped so we need to do some shifting. */
  895. for (i = 0;i < 4;i++) {
  896. host->cmd->resp[i] = sdhci_readl(host,
  897. SDHCI_RESPONSE + (3-i)*4) << 8;
  898. if (i != 3)
  899. host->cmd->resp[i] |=
  900. sdhci_readb(host,
  901. SDHCI_RESPONSE + (3-i)*4-1);
  902. }
  903. } else {
  904. host->cmd->resp[0] = sdhci_readl(host, SDHCI_RESPONSE);
  905. }
  906. }
  907. host->cmd->error = 0;
  908. /* Finished CMD23, now send actual command. */
  909. if (host->cmd == host->mrq->sbc) {
  910. host->cmd = NULL;
  911. sdhci_send_command(host, host->mrq->cmd);
  912. } else {
  913. /* Processed actual command. */
  914. if (host->data && host->data_early)
  915. sdhci_finish_data(host);
  916. if (!host->cmd->data)
  917. tasklet_schedule(&host->finish_tasklet);
  918. host->cmd = NULL;
  919. }
  920. }
  921. static u16 sdhci_get_preset_value(struct sdhci_host *host)
  922. {
  923. u16 preset = 0;
  924. switch (host->timing) {
  925. case MMC_TIMING_UHS_SDR12:
  926. preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
  927. break;
  928. case MMC_TIMING_UHS_SDR25:
  929. preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR25);
  930. break;
  931. case MMC_TIMING_UHS_SDR50:
  932. preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR50);
  933. break;
  934. case MMC_TIMING_UHS_SDR104:
  935. case MMC_TIMING_MMC_HS200:
  936. preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR104);
  937. break;
  938. case MMC_TIMING_UHS_DDR50:
  939. case MMC_TIMING_MMC_DDR52:
  940. preset = sdhci_readw(host, SDHCI_PRESET_FOR_DDR50);
  941. break;
  942. case MMC_TIMING_MMC_HS400:
  943. preset = sdhci_readw(host, SDHCI_PRESET_FOR_HS400);
  944. break;
  945. default:
  946. pr_warn("%s: Invalid UHS-I mode selected\n",
  947. mmc_hostname(host->mmc));
  948. preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
  949. break;
  950. }
  951. return preset;
  952. }
  953. void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
  954. {
  955. int div = 0; /* Initialized for compiler warning */
  956. int real_div = div, clk_mul = 1;
  957. u16 clk = 0;
  958. unsigned long timeout;
  959. bool switch_base_clk = false;
  960. host->mmc->actual_clock = 0;
  961. sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
  962. if (clock == 0)
  963. return;
  964. if (host->version >= SDHCI_SPEC_300) {
  965. if (host->preset_enabled) {
  966. u16 pre_val;
  967. clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
  968. pre_val = sdhci_get_preset_value(host);
  969. div = (pre_val & SDHCI_PRESET_SDCLK_FREQ_MASK)
  970. >> SDHCI_PRESET_SDCLK_FREQ_SHIFT;
  971. if (host->clk_mul &&
  972. (pre_val & SDHCI_PRESET_CLKGEN_SEL_MASK)) {
  973. clk = SDHCI_PROG_CLOCK_MODE;
  974. real_div = div + 1;
  975. clk_mul = host->clk_mul;
  976. } else {
  977. real_div = max_t(int, 1, div << 1);
  978. }
  979. goto clock_set;
  980. }
  981. /*
  982. * Check if the Host Controller supports Programmable Clock
  983. * Mode.
  984. */
  985. if (host->clk_mul) {
  986. for (div = 1; div <= 1024; div++) {
  987. if ((host->max_clk * host->clk_mul / div)
  988. <= clock)
  989. break;
  990. }
  991. if ((host->max_clk * host->clk_mul / div) <= clock) {
  992. /*
  993. * Set Programmable Clock Mode in the Clock
  994. * Control register.
  995. */
  996. clk = SDHCI_PROG_CLOCK_MODE;
  997. real_div = div;
  998. clk_mul = host->clk_mul;
  999. div--;
  1000. } else {
  1001. /*
  1002. * Divisor can be too small to reach clock
  1003. * speed requirement. Then use the base clock.
  1004. */
  1005. switch_base_clk = true;
  1006. }
  1007. }
  1008. if (!host->clk_mul || switch_base_clk) {
  1009. /* Version 3.00 divisors must be a multiple of 2. */
  1010. if (host->max_clk <= clock)
  1011. div = 1;
  1012. else {
  1013. for (div = 2; div < SDHCI_MAX_DIV_SPEC_300;
  1014. div += 2) {
  1015. if ((host->max_clk / div) <= clock)
  1016. break;
  1017. }
  1018. }
  1019. real_div = div;
  1020. div >>= 1;
  1021. if ((host->quirks2 & SDHCI_QUIRK2_CLOCK_DIV_ZERO_BROKEN)
  1022. && !div && host->max_clk <= 25000000)
  1023. div = 1;
  1024. }
  1025. } else {
  1026. /* Version 2.00 divisors must be a power of 2. */
  1027. for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
  1028. if ((host->max_clk / div) <= clock)
  1029. break;
  1030. }
  1031. real_div = div;
  1032. div >>= 1;
  1033. }
  1034. clock_set:
  1035. if (real_div)
  1036. host->mmc->actual_clock = (host->max_clk * clk_mul) / real_div;
  1037. clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
  1038. clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
  1039. << SDHCI_DIVIDER_HI_SHIFT;
  1040. clk |= SDHCI_CLOCK_INT_EN;
  1041. sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
  1042. /* Wait max 20 ms */
  1043. timeout = 20;
  1044. while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
  1045. & SDHCI_CLOCK_INT_STABLE)) {
  1046. if (timeout == 0) {
  1047. pr_err("%s: Internal clock never "
  1048. "stabilised.\n", mmc_hostname(host->mmc));
  1049. sdhci_dumpregs(host);
  1050. return;
  1051. }
  1052. timeout--;
  1053. mdelay(1);
  1054. }
  1055. clk |= SDHCI_CLOCK_CARD_EN;
  1056. sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
  1057. }
  1058. EXPORT_SYMBOL_GPL(sdhci_set_clock);
  1059. static void sdhci_set_power(struct sdhci_host *host, unsigned char mode,
  1060. unsigned short vdd)
  1061. {
  1062. struct mmc_host *mmc = host->mmc;
  1063. u8 pwr = 0;
  1064. if (!IS_ERR(mmc->supply.vmmc)) {
  1065. spin_unlock_irq(&host->lock);
  1066. mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd);
  1067. spin_lock_irq(&host->lock);
  1068. if (mode != MMC_POWER_OFF)
  1069. sdhci_writeb(host, SDHCI_POWER_ON, SDHCI_POWER_CONTROL);
  1070. else
  1071. sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
  1072. return;
  1073. }
  1074. if (mode != MMC_POWER_OFF) {
  1075. switch (1 << vdd) {
  1076. case MMC_VDD_165_195:
  1077. pwr = SDHCI_POWER_180;
  1078. break;
  1079. case MMC_VDD_29_30:
  1080. case MMC_VDD_30_31:
  1081. pwr = SDHCI_POWER_300;
  1082. break;
  1083. case MMC_VDD_32_33:
  1084. case MMC_VDD_33_34:
  1085. pwr = SDHCI_POWER_330;
  1086. break;
  1087. default:
  1088. BUG();
  1089. }
  1090. }
  1091. if (host->pwr == pwr)
  1092. return;
  1093. host->pwr = pwr;
  1094. if (pwr == 0) {
  1095. sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
  1096. if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
  1097. sdhci_runtime_pm_bus_off(host);
  1098. vdd = 0;
  1099. } else {
  1100. /*
  1101. * Spec says that we should clear the power reg before setting
  1102. * a new value. Some controllers don't seem to like this though.
  1103. */
  1104. if (!(host->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
  1105. sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
  1106. /*
  1107. * At least the Marvell CaFe chip gets confused if we set the
  1108. * voltage and set turn on power at the same time, so set the
  1109. * voltage first.
  1110. */
  1111. if (host->quirks & SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER)
  1112. sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
  1113. pwr |= SDHCI_POWER_ON;
  1114. sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
  1115. if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
  1116. sdhci_runtime_pm_bus_on(host);
  1117. /*
  1118. * Some controllers need an extra 10ms delay of 10ms before
  1119. * they can apply clock after applying power
  1120. */
  1121. if (host->quirks & SDHCI_QUIRK_DELAY_AFTER_POWER)
  1122. mdelay(10);
  1123. }
  1124. }
  1125. /*****************************************************************************\
  1126. * *
  1127. * MMC callbacks *
  1128. * *
  1129. \*****************************************************************************/
  1130. static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
  1131. {
  1132. struct sdhci_host *host;
  1133. int present;
  1134. unsigned long flags;
  1135. host = mmc_priv(mmc);
  1136. sdhci_runtime_pm_get(host);
  1137. /* Firstly check card presence */
  1138. present = sdhci_do_get_cd(host);
  1139. spin_lock_irqsave(&host->lock, flags);
  1140. WARN_ON(host->mrq != NULL);
  1141. #ifndef SDHCI_USE_LEDS_CLASS
  1142. sdhci_activate_led(host);
  1143. #endif
  1144. /*
  1145. * Ensure we don't send the STOP for non-SET_BLOCK_COUNTED
  1146. * requests if Auto-CMD12 is enabled.
  1147. */
  1148. if (!mrq->sbc && (host->flags & SDHCI_AUTO_CMD12)) {
  1149. if (mrq->stop) {
  1150. mrq->data->stop = NULL;
  1151. mrq->stop = NULL;
  1152. }
  1153. }
  1154. host->mrq = mrq;
  1155. if (!present || host->flags & SDHCI_DEVICE_DEAD) {
  1156. host->mrq->cmd->error = -ENOMEDIUM;
  1157. tasklet_schedule(&host->finish_tasklet);
  1158. } else {
  1159. if (mrq->sbc && !(host->flags & SDHCI_AUTO_CMD23))
  1160. sdhci_send_command(host, mrq->sbc);
  1161. else
  1162. sdhci_send_command(host, mrq->cmd);
  1163. }
  1164. mmiowb();
  1165. spin_unlock_irqrestore(&host->lock, flags);
  1166. }
  1167. void sdhci_set_bus_width(struct sdhci_host *host, int width)
  1168. {
  1169. u8 ctrl;
  1170. ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
  1171. if (width == MMC_BUS_WIDTH_8) {
  1172. ctrl &= ~SDHCI_CTRL_4BITBUS;
  1173. if (host->version >= SDHCI_SPEC_300)
  1174. ctrl |= SDHCI_CTRL_8BITBUS;
  1175. } else {
  1176. if (host->version >= SDHCI_SPEC_300)
  1177. ctrl &= ~SDHCI_CTRL_8BITBUS;
  1178. if (width == MMC_BUS_WIDTH_4)
  1179. ctrl |= SDHCI_CTRL_4BITBUS;
  1180. else
  1181. ctrl &= ~SDHCI_CTRL_4BITBUS;
  1182. }
  1183. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  1184. }
  1185. EXPORT_SYMBOL_GPL(sdhci_set_bus_width);
  1186. void sdhci_set_uhs_signaling(struct sdhci_host *host, unsigned timing)
  1187. {
  1188. u16 ctrl_2;
  1189. ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1190. /* Select Bus Speed Mode for host */
  1191. ctrl_2 &= ~SDHCI_CTRL_UHS_MASK;
  1192. if ((timing == MMC_TIMING_MMC_HS200) ||
  1193. (timing == MMC_TIMING_UHS_SDR104))
  1194. ctrl_2 |= SDHCI_CTRL_UHS_SDR104;
  1195. else if (timing == MMC_TIMING_UHS_SDR12)
  1196. ctrl_2 |= SDHCI_CTRL_UHS_SDR12;
  1197. else if (timing == MMC_TIMING_UHS_SDR25)
  1198. ctrl_2 |= SDHCI_CTRL_UHS_SDR25;
  1199. else if (timing == MMC_TIMING_UHS_SDR50)
  1200. ctrl_2 |= SDHCI_CTRL_UHS_SDR50;
  1201. else if ((timing == MMC_TIMING_UHS_DDR50) ||
  1202. (timing == MMC_TIMING_MMC_DDR52))
  1203. ctrl_2 |= SDHCI_CTRL_UHS_DDR50;
  1204. else if (timing == MMC_TIMING_MMC_HS400)
  1205. ctrl_2 |= SDHCI_CTRL_HS400; /* Non-standard */
  1206. sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
  1207. }
  1208. EXPORT_SYMBOL_GPL(sdhci_set_uhs_signaling);
  1209. static void sdhci_do_set_ios(struct sdhci_host *host, struct mmc_ios *ios)
  1210. {
  1211. unsigned long flags;
  1212. u8 ctrl;
  1213. struct mmc_host *mmc = host->mmc;
  1214. spin_lock_irqsave(&host->lock, flags);
  1215. if (host->flags & SDHCI_DEVICE_DEAD) {
  1216. spin_unlock_irqrestore(&host->lock, flags);
  1217. if (!IS_ERR(mmc->supply.vmmc) &&
  1218. ios->power_mode == MMC_POWER_OFF)
  1219. mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
  1220. return;
  1221. }
  1222. /*
  1223. * Reset the chip on each power off.
  1224. * Should clear out any weird states.
  1225. */
  1226. if (ios->power_mode == MMC_POWER_OFF) {
  1227. sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
  1228. sdhci_reinit(host);
  1229. }
  1230. if (host->version >= SDHCI_SPEC_300 &&
  1231. (ios->power_mode == MMC_POWER_UP) &&
  1232. !(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN))
  1233. sdhci_enable_preset_value(host, false);
  1234. if (!ios->clock || ios->clock != host->clock) {
  1235. host->ops->set_clock(host, ios->clock);
  1236. host->clock = ios->clock;
  1237. if (host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK &&
  1238. host->clock) {
  1239. host->timeout_clk = host->mmc->actual_clock ?
  1240. host->mmc->actual_clock / 1000 :
  1241. host->clock / 1000;
  1242. host->mmc->max_busy_timeout =
  1243. host->ops->get_max_timeout_count ?
  1244. host->ops->get_max_timeout_count(host) :
  1245. 1 << 27;
  1246. host->mmc->max_busy_timeout /= host->timeout_clk;
  1247. }
  1248. }
  1249. sdhci_set_power(host, ios->power_mode, ios->vdd);
  1250. if (host->ops->platform_send_init_74_clocks)
  1251. host->ops->platform_send_init_74_clocks(host, ios->power_mode);
  1252. host->ops->set_bus_width(host, ios->bus_width);
  1253. ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
  1254. if ((ios->timing == MMC_TIMING_SD_HS ||
  1255. ios->timing == MMC_TIMING_MMC_HS)
  1256. && !(host->quirks & SDHCI_QUIRK_NO_HISPD_BIT))
  1257. ctrl |= SDHCI_CTRL_HISPD;
  1258. else
  1259. ctrl &= ~SDHCI_CTRL_HISPD;
  1260. if (host->version >= SDHCI_SPEC_300) {
  1261. u16 clk, ctrl_2;
  1262. /* In case of UHS-I modes, set High Speed Enable */
  1263. if ((ios->timing == MMC_TIMING_MMC_HS400) ||
  1264. (ios->timing == MMC_TIMING_MMC_HS200) ||
  1265. (ios->timing == MMC_TIMING_MMC_DDR52) ||
  1266. (ios->timing == MMC_TIMING_UHS_SDR50) ||
  1267. (ios->timing == MMC_TIMING_UHS_SDR104) ||
  1268. (ios->timing == MMC_TIMING_UHS_DDR50) ||
  1269. (ios->timing == MMC_TIMING_UHS_SDR25))
  1270. ctrl |= SDHCI_CTRL_HISPD;
  1271. if (!host->preset_enabled) {
  1272. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  1273. /*
  1274. * We only need to set Driver Strength if the
  1275. * preset value enable is not set.
  1276. */
  1277. ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1278. ctrl_2 &= ~SDHCI_CTRL_DRV_TYPE_MASK;
  1279. if (ios->drv_type == MMC_SET_DRIVER_TYPE_A)
  1280. ctrl_2 |= SDHCI_CTRL_DRV_TYPE_A;
  1281. else if (ios->drv_type == MMC_SET_DRIVER_TYPE_B)
  1282. ctrl_2 |= SDHCI_CTRL_DRV_TYPE_B;
  1283. else if (ios->drv_type == MMC_SET_DRIVER_TYPE_C)
  1284. ctrl_2 |= SDHCI_CTRL_DRV_TYPE_C;
  1285. else if (ios->drv_type == MMC_SET_DRIVER_TYPE_D)
  1286. ctrl_2 |= SDHCI_CTRL_DRV_TYPE_D;
  1287. else {
  1288. pr_warn("%s: invalid driver type, default to "
  1289. "driver type B\n", mmc_hostname(mmc));
  1290. ctrl_2 |= SDHCI_CTRL_DRV_TYPE_B;
  1291. }
  1292. sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
  1293. } else {
  1294. /*
  1295. * According to SDHC Spec v3.00, if the Preset Value
  1296. * Enable in the Host Control 2 register is set, we
  1297. * need to reset SD Clock Enable before changing High
  1298. * Speed Enable to avoid generating clock gliches.
  1299. */
  1300. /* Reset SD Clock Enable */
  1301. clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
  1302. clk &= ~SDHCI_CLOCK_CARD_EN;
  1303. sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
  1304. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  1305. /* Re-enable SD Clock */
  1306. host->ops->set_clock(host, host->clock);
  1307. }
  1308. /* Reset SD Clock Enable */
  1309. clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
  1310. clk &= ~SDHCI_CLOCK_CARD_EN;
  1311. sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
  1312. host->ops->set_uhs_signaling(host, ios->timing);
  1313. host->timing = ios->timing;
  1314. if (!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN) &&
  1315. ((ios->timing == MMC_TIMING_UHS_SDR12) ||
  1316. (ios->timing == MMC_TIMING_UHS_SDR25) ||
  1317. (ios->timing == MMC_TIMING_UHS_SDR50) ||
  1318. (ios->timing == MMC_TIMING_UHS_SDR104) ||
  1319. (ios->timing == MMC_TIMING_UHS_DDR50) ||
  1320. (ios->timing == MMC_TIMING_MMC_DDR52))) {
  1321. u16 preset;
  1322. sdhci_enable_preset_value(host, true);
  1323. preset = sdhci_get_preset_value(host);
  1324. ios->drv_type = (preset & SDHCI_PRESET_DRV_MASK)
  1325. >> SDHCI_PRESET_DRV_SHIFT;
  1326. }
  1327. /* Re-enable SD Clock */
  1328. host->ops->set_clock(host, host->clock);
  1329. } else
  1330. sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
  1331. /*
  1332. * Some (ENE) controllers go apeshit on some ios operation,
  1333. * signalling timeout and CRC errors even on CMD0. Resetting
  1334. * it on each ios seems to solve the problem.
  1335. */
  1336. if (host->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
  1337. sdhci_do_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
  1338. mmiowb();
  1339. spin_unlock_irqrestore(&host->lock, flags);
  1340. }
  1341. static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
  1342. {
  1343. struct sdhci_host *host = mmc_priv(mmc);
  1344. sdhci_runtime_pm_get(host);
  1345. sdhci_do_set_ios(host, ios);
  1346. sdhci_runtime_pm_put(host);
  1347. }
  1348. static int sdhci_do_get_cd(struct sdhci_host *host)
  1349. {
  1350. int gpio_cd = mmc_gpio_get_cd(host->mmc);
  1351. if (host->flags & SDHCI_DEVICE_DEAD)
  1352. return 0;
  1353. /* If nonremovable, assume that the card is always present. */
  1354. if (host->mmc->caps & MMC_CAP_NONREMOVABLE)
  1355. return 1;
  1356. /*
  1357. * Try slot gpio detect, if defined it take precedence
  1358. * over build in controller functionality
  1359. */
  1360. if (!IS_ERR_VALUE(gpio_cd))
  1361. return !!gpio_cd;
  1362. /* If polling, assume that the card is always present. */
  1363. if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
  1364. return 1;
  1365. /* Host native card detect */
  1366. return !!(sdhci_readl(host, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT);
  1367. }
  1368. static int sdhci_get_cd(struct mmc_host *mmc)
  1369. {
  1370. struct sdhci_host *host = mmc_priv(mmc);
  1371. int ret;
  1372. sdhci_runtime_pm_get(host);
  1373. ret = sdhci_do_get_cd(host);
  1374. sdhci_runtime_pm_put(host);
  1375. return ret;
  1376. }
  1377. static int sdhci_check_ro(struct sdhci_host *host)
  1378. {
  1379. unsigned long flags;
  1380. int is_readonly;
  1381. spin_lock_irqsave(&host->lock, flags);
  1382. if (host->flags & SDHCI_DEVICE_DEAD)
  1383. is_readonly = 0;
  1384. else if (host->ops->get_ro)
  1385. is_readonly = host->ops->get_ro(host);
  1386. else
  1387. is_readonly = !(sdhci_readl(host, SDHCI_PRESENT_STATE)
  1388. & SDHCI_WRITE_PROTECT);
  1389. spin_unlock_irqrestore(&host->lock, flags);
  1390. /* This quirk needs to be replaced by a callback-function later */
  1391. return host->quirks & SDHCI_QUIRK_INVERTED_WRITE_PROTECT ?
  1392. !is_readonly : is_readonly;
  1393. }
  1394. #define SAMPLE_COUNT 5
  1395. static int sdhci_do_get_ro(struct sdhci_host *host)
  1396. {
  1397. int i, ro_count;
  1398. if (!(host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT))
  1399. return sdhci_check_ro(host);
  1400. ro_count = 0;
  1401. for (i = 0; i < SAMPLE_COUNT; i++) {
  1402. if (sdhci_check_ro(host)) {
  1403. if (++ro_count > SAMPLE_COUNT / 2)
  1404. return 1;
  1405. }
  1406. msleep(30);
  1407. }
  1408. return 0;
  1409. }
  1410. static void sdhci_hw_reset(struct mmc_host *mmc)
  1411. {
  1412. struct sdhci_host *host = mmc_priv(mmc);
  1413. if (host->ops && host->ops->hw_reset)
  1414. host->ops->hw_reset(host);
  1415. }
  1416. static int sdhci_get_ro(struct mmc_host *mmc)
  1417. {
  1418. struct sdhci_host *host = mmc_priv(mmc);
  1419. int ret;
  1420. sdhci_runtime_pm_get(host);
  1421. ret = sdhci_do_get_ro(host);
  1422. sdhci_runtime_pm_put(host);
  1423. return ret;
  1424. }
  1425. static void sdhci_enable_sdio_irq_nolock(struct sdhci_host *host, int enable)
  1426. {
  1427. if (!(host->flags & SDHCI_DEVICE_DEAD)) {
  1428. if (enable)
  1429. host->ier |= SDHCI_INT_CARD_INT;
  1430. else
  1431. host->ier &= ~SDHCI_INT_CARD_INT;
  1432. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  1433. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  1434. mmiowb();
  1435. }
  1436. }
  1437. static void sdhci_enable_sdio_irq(struct mmc_host *mmc, int enable)
  1438. {
  1439. struct sdhci_host *host = mmc_priv(mmc);
  1440. unsigned long flags;
  1441. sdhci_runtime_pm_get(host);
  1442. spin_lock_irqsave(&host->lock, flags);
  1443. if (enable)
  1444. host->flags |= SDHCI_SDIO_IRQ_ENABLED;
  1445. else
  1446. host->flags &= ~SDHCI_SDIO_IRQ_ENABLED;
  1447. sdhci_enable_sdio_irq_nolock(host, enable);
  1448. spin_unlock_irqrestore(&host->lock, flags);
  1449. sdhci_runtime_pm_put(host);
  1450. }
  1451. static int sdhci_do_start_signal_voltage_switch(struct sdhci_host *host,
  1452. struct mmc_ios *ios)
  1453. {
  1454. struct mmc_host *mmc = host->mmc;
  1455. u16 ctrl;
  1456. int ret;
  1457. /*
  1458. * Signal Voltage Switching is only applicable for Host Controllers
  1459. * v3.00 and above.
  1460. */
  1461. if (host->version < SDHCI_SPEC_300)
  1462. return 0;
  1463. ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1464. switch (ios->signal_voltage) {
  1465. case MMC_SIGNAL_VOLTAGE_330:
  1466. /* Set 1.8V Signal Enable in the Host Control2 register to 0 */
  1467. ctrl &= ~SDHCI_CTRL_VDD_180;
  1468. sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
  1469. if (!IS_ERR(mmc->supply.vqmmc)) {
  1470. ret = regulator_set_voltage(mmc->supply.vqmmc, 2700000,
  1471. 3600000);
  1472. if (ret) {
  1473. pr_warn("%s: Switching to 3.3V signalling voltage failed\n",
  1474. mmc_hostname(mmc));
  1475. return -EIO;
  1476. }
  1477. }
  1478. /* Wait for 5ms */
  1479. usleep_range(5000, 5500);
  1480. /* 3.3V regulator output should be stable within 5 ms */
  1481. ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1482. if (!(ctrl & SDHCI_CTRL_VDD_180))
  1483. return 0;
  1484. pr_warn("%s: 3.3V regulator output did not became stable\n",
  1485. mmc_hostname(mmc));
  1486. return -EAGAIN;
  1487. case MMC_SIGNAL_VOLTAGE_180:
  1488. if (!IS_ERR(mmc->supply.vqmmc)) {
  1489. ret = regulator_set_voltage(mmc->supply.vqmmc,
  1490. 1700000, 1950000);
  1491. if (ret) {
  1492. pr_warn("%s: Switching to 1.8V signalling voltage failed\n",
  1493. mmc_hostname(mmc));
  1494. return -EIO;
  1495. }
  1496. }
  1497. /*
  1498. * Enable 1.8V Signal Enable in the Host Control2
  1499. * register
  1500. */
  1501. ctrl |= SDHCI_CTRL_VDD_180;
  1502. sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
  1503. /* Some controller need to do more when switching */
  1504. if (host->ops->voltage_switch)
  1505. host->ops->voltage_switch(host);
  1506. /* 1.8V regulator output should be stable within 5 ms */
  1507. ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1508. if (ctrl & SDHCI_CTRL_VDD_180)
  1509. return 0;
  1510. pr_warn("%s: 1.8V regulator output did not became stable\n",
  1511. mmc_hostname(mmc));
  1512. return -EAGAIN;
  1513. case MMC_SIGNAL_VOLTAGE_120:
  1514. if (!IS_ERR(mmc->supply.vqmmc)) {
  1515. ret = regulator_set_voltage(mmc->supply.vqmmc, 1100000,
  1516. 1300000);
  1517. if (ret) {
  1518. pr_warn("%s: Switching to 1.2V signalling voltage failed\n",
  1519. mmc_hostname(mmc));
  1520. return -EIO;
  1521. }
  1522. }
  1523. return 0;
  1524. default:
  1525. /* No signal voltage switch required */
  1526. return 0;
  1527. }
  1528. }
  1529. static int sdhci_start_signal_voltage_switch(struct mmc_host *mmc,
  1530. struct mmc_ios *ios)
  1531. {
  1532. struct sdhci_host *host = mmc_priv(mmc);
  1533. int err;
  1534. if (host->version < SDHCI_SPEC_300)
  1535. return 0;
  1536. sdhci_runtime_pm_get(host);
  1537. err = sdhci_do_start_signal_voltage_switch(host, ios);
  1538. sdhci_runtime_pm_put(host);
  1539. return err;
  1540. }
  1541. static int sdhci_card_busy(struct mmc_host *mmc)
  1542. {
  1543. struct sdhci_host *host = mmc_priv(mmc);
  1544. u32 present_state;
  1545. sdhci_runtime_pm_get(host);
  1546. /* Check whether DAT[3:0] is 0000 */
  1547. present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);
  1548. sdhci_runtime_pm_put(host);
  1549. return !(present_state & SDHCI_DATA_LVL_MASK);
  1550. }
  1551. static int sdhci_prepare_hs400_tuning(struct mmc_host *mmc, struct mmc_ios *ios)
  1552. {
  1553. struct sdhci_host *host = mmc_priv(mmc);
  1554. unsigned long flags;
  1555. spin_lock_irqsave(&host->lock, flags);
  1556. host->flags |= SDHCI_HS400_TUNING;
  1557. spin_unlock_irqrestore(&host->lock, flags);
  1558. return 0;
  1559. }
  1560. static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode)
  1561. {
  1562. struct sdhci_host *host = mmc_priv(mmc);
  1563. u16 ctrl;
  1564. int tuning_loop_counter = MAX_TUNING_LOOP;
  1565. int err = 0;
  1566. unsigned long flags;
  1567. unsigned int tuning_count = 0;
  1568. bool hs400_tuning;
  1569. sdhci_runtime_pm_get(host);
  1570. spin_lock_irqsave(&host->lock, flags);
  1571. hs400_tuning = host->flags & SDHCI_HS400_TUNING;
  1572. host->flags &= ~SDHCI_HS400_TUNING;
  1573. if (host->tuning_mode == SDHCI_TUNING_MODE_1)
  1574. tuning_count = host->tuning_count;
  1575. /*
  1576. * The Host Controller needs tuning only in case of SDR104 mode
  1577. * and for SDR50 mode when Use Tuning for SDR50 is set in the
  1578. * Capabilities register.
  1579. * If the Host Controller supports the HS200 mode then the
  1580. * tuning function has to be executed.
  1581. */
  1582. switch (host->timing) {
  1583. /* HS400 tuning is done in HS200 mode */
  1584. case MMC_TIMING_MMC_HS400:
  1585. err = -EINVAL;
  1586. goto out_unlock;
  1587. case MMC_TIMING_MMC_HS200:
  1588. /*
  1589. * Periodic re-tuning for HS400 is not expected to be needed, so
  1590. * disable it here.
  1591. */
  1592. if (hs400_tuning)
  1593. tuning_count = 0;
  1594. break;
  1595. case MMC_TIMING_UHS_SDR104:
  1596. break;
  1597. case MMC_TIMING_UHS_SDR50:
  1598. if (host->flags & SDHCI_SDR50_NEEDS_TUNING ||
  1599. host->flags & SDHCI_SDR104_NEEDS_TUNING)
  1600. break;
  1601. /* FALLTHROUGH */
  1602. default:
  1603. goto out_unlock;
  1604. }
  1605. if (host->ops->platform_execute_tuning) {
  1606. spin_unlock_irqrestore(&host->lock, flags);
  1607. err = host->ops->platform_execute_tuning(host, opcode);
  1608. sdhci_runtime_pm_put(host);
  1609. return err;
  1610. }
  1611. ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1612. ctrl |= SDHCI_CTRL_EXEC_TUNING;
  1613. if (host->quirks2 & SDHCI_QUIRK2_TUNING_WORK_AROUND)
  1614. ctrl |= SDHCI_CTRL_TUNED_CLK;
  1615. sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
  1616. /*
  1617. * As per the Host Controller spec v3.00, tuning command
  1618. * generates Buffer Read Ready interrupt, so enable that.
  1619. *
  1620. * Note: The spec clearly says that when tuning sequence
  1621. * is being performed, the controller does not generate
  1622. * interrupts other than Buffer Read Ready interrupt. But
  1623. * to make sure we don't hit a controller bug, we _only_
  1624. * enable Buffer Read Ready interrupt here.
  1625. */
  1626. sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_INT_ENABLE);
  1627. sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_SIGNAL_ENABLE);
  1628. /*
  1629. * Issue CMD19 repeatedly till Execute Tuning is set to 0 or the number
  1630. * of loops reaches 40 times or a timeout of 150ms occurs.
  1631. */
  1632. do {
  1633. struct mmc_command cmd = {0};
  1634. struct mmc_request mrq = {NULL};
  1635. cmd.opcode = opcode;
  1636. cmd.arg = 0;
  1637. cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  1638. cmd.retries = 0;
  1639. cmd.data = NULL;
  1640. cmd.error = 0;
  1641. if (tuning_loop_counter-- == 0)
  1642. break;
  1643. mrq.cmd = &cmd;
  1644. host->mrq = &mrq;
  1645. /*
  1646. * In response to CMD19, the card sends 64 bytes of tuning
  1647. * block to the Host Controller. So we set the block size
  1648. * to 64 here.
  1649. */
  1650. if (cmd.opcode == MMC_SEND_TUNING_BLOCK_HS200) {
  1651. if (mmc->ios.bus_width == MMC_BUS_WIDTH_8)
  1652. sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 128),
  1653. SDHCI_BLOCK_SIZE);
  1654. else if (mmc->ios.bus_width == MMC_BUS_WIDTH_4)
  1655. sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
  1656. SDHCI_BLOCK_SIZE);
  1657. } else {
  1658. sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
  1659. SDHCI_BLOCK_SIZE);
  1660. }
  1661. /*
  1662. * The tuning block is sent by the card to the host controller.
  1663. * So we set the TRNS_READ bit in the Transfer Mode register.
  1664. * This also takes care of setting DMA Enable and Multi Block
  1665. * Select in the same register to 0.
  1666. */
  1667. sdhci_writew(host, SDHCI_TRNS_READ, SDHCI_TRANSFER_MODE);
  1668. sdhci_send_command(host, &cmd);
  1669. host->cmd = NULL;
  1670. host->mrq = NULL;
  1671. spin_unlock_irqrestore(&host->lock, flags);
  1672. /* Wait for Buffer Read Ready interrupt */
  1673. wait_event_interruptible_timeout(host->buf_ready_int,
  1674. (host->tuning_done == 1),
  1675. msecs_to_jiffies(50));
  1676. spin_lock_irqsave(&host->lock, flags);
  1677. if (!host->tuning_done) {
  1678. pr_info(DRIVER_NAME ": Timeout waiting for "
  1679. "Buffer Read Ready interrupt during tuning "
  1680. "procedure, falling back to fixed sampling "
  1681. "clock\n");
  1682. ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1683. ctrl &= ~SDHCI_CTRL_TUNED_CLK;
  1684. ctrl &= ~SDHCI_CTRL_EXEC_TUNING;
  1685. sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
  1686. err = -EIO;
  1687. goto out;
  1688. }
  1689. host->tuning_done = 0;
  1690. ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1691. /* eMMC spec does not require a delay between tuning cycles */
  1692. if (opcode == MMC_SEND_TUNING_BLOCK)
  1693. mdelay(1);
  1694. } while (ctrl & SDHCI_CTRL_EXEC_TUNING);
  1695. /*
  1696. * The Host Driver has exhausted the maximum number of loops allowed,
  1697. * so use fixed sampling frequency.
  1698. */
  1699. if (tuning_loop_counter < 0) {
  1700. ctrl &= ~SDHCI_CTRL_TUNED_CLK;
  1701. sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
  1702. }
  1703. if (!(ctrl & SDHCI_CTRL_TUNED_CLK)) {
  1704. pr_info(DRIVER_NAME ": Tuning procedure"
  1705. " failed, falling back to fixed sampling"
  1706. " clock\n");
  1707. err = -EIO;
  1708. }
  1709. out:
  1710. if (tuning_count) {
  1711. /*
  1712. * In case tuning fails, host controllers which support
  1713. * re-tuning can try tuning again at a later time, when the
  1714. * re-tuning timer expires. So for these controllers, we
  1715. * return 0. Since there might be other controllers who do not
  1716. * have this capability, we return error for them.
  1717. */
  1718. err = 0;
  1719. }
  1720. host->mmc->retune_period = err ? 0 : tuning_count;
  1721. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  1722. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  1723. out_unlock:
  1724. spin_unlock_irqrestore(&host->lock, flags);
  1725. sdhci_runtime_pm_put(host);
  1726. return err;
  1727. }
  1728. static int sdhci_select_drive_strength(struct mmc_card *card,
  1729. unsigned int max_dtr, int host_drv,
  1730. int card_drv, int *drv_type)
  1731. {
  1732. struct sdhci_host *host = mmc_priv(card->host);
  1733. if (!host->ops->select_drive_strength)
  1734. return 0;
  1735. return host->ops->select_drive_strength(host, card, max_dtr, host_drv,
  1736. card_drv, drv_type);
  1737. }
  1738. static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
  1739. {
  1740. /* Host Controller v3.00 defines preset value registers */
  1741. if (host->version < SDHCI_SPEC_300)
  1742. return;
  1743. /*
  1744. * We only enable or disable Preset Value if they are not already
  1745. * enabled or disabled respectively. Otherwise, we bail out.
  1746. */
  1747. if (host->preset_enabled != enable) {
  1748. u16 ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
  1749. if (enable)
  1750. ctrl |= SDHCI_CTRL_PRESET_VAL_ENABLE;
  1751. else
  1752. ctrl &= ~SDHCI_CTRL_PRESET_VAL_ENABLE;
  1753. sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
  1754. if (enable)
  1755. host->flags |= SDHCI_PV_ENABLED;
  1756. else
  1757. host->flags &= ~SDHCI_PV_ENABLED;
  1758. host->preset_enabled = enable;
  1759. }
  1760. }
  1761. static void sdhci_post_req(struct mmc_host *mmc, struct mmc_request *mrq,
  1762. int err)
  1763. {
  1764. struct sdhci_host *host = mmc_priv(mmc);
  1765. struct mmc_data *data = mrq->data;
  1766. if (host->flags & SDHCI_REQ_USE_DMA) {
  1767. if (data->host_cookie == COOKIE_GIVEN ||
  1768. data->host_cookie == COOKIE_MAPPED)
  1769. dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
  1770. data->flags & MMC_DATA_WRITE ?
  1771. DMA_TO_DEVICE : DMA_FROM_DEVICE);
  1772. data->host_cookie = COOKIE_UNMAPPED;
  1773. }
  1774. }
  1775. static int sdhci_pre_dma_transfer(struct sdhci_host *host,
  1776. struct mmc_data *data)
  1777. {
  1778. int sg_count;
  1779. if (data->host_cookie == COOKIE_MAPPED) {
  1780. data->host_cookie = COOKIE_GIVEN;
  1781. return data->sg_count;
  1782. }
  1783. WARN_ON(data->host_cookie == COOKIE_GIVEN);
  1784. sg_count = dma_map_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
  1785. data->flags & MMC_DATA_WRITE ?
  1786. DMA_TO_DEVICE : DMA_FROM_DEVICE);
  1787. if (sg_count == 0)
  1788. return -ENOSPC;
  1789. data->sg_count = sg_count;
  1790. data->host_cookie = COOKIE_MAPPED;
  1791. return sg_count;
  1792. }
  1793. static void sdhci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq,
  1794. bool is_first_req)
  1795. {
  1796. struct sdhci_host *host = mmc_priv(mmc);
  1797. mrq->data->host_cookie = COOKIE_UNMAPPED;
  1798. if (host->flags & SDHCI_REQ_USE_DMA)
  1799. sdhci_pre_dma_transfer(host, mrq->data);
  1800. }
  1801. static void sdhci_card_event(struct mmc_host *mmc)
  1802. {
  1803. struct sdhci_host *host = mmc_priv(mmc);
  1804. unsigned long flags;
  1805. int present;
  1806. /* First check if client has provided their own card event */
  1807. if (host->ops->card_event)
  1808. host->ops->card_event(host);
  1809. present = sdhci_do_get_cd(host);
  1810. spin_lock_irqsave(&host->lock, flags);
  1811. /* Check host->mrq first in case we are runtime suspended */
  1812. if (host->mrq && !present) {
  1813. pr_err("%s: Card removed during transfer!\n",
  1814. mmc_hostname(host->mmc));
  1815. pr_err("%s: Resetting controller.\n",
  1816. mmc_hostname(host->mmc));
  1817. sdhci_do_reset(host, SDHCI_RESET_CMD);
  1818. sdhci_do_reset(host, SDHCI_RESET_DATA);
  1819. host->mrq->cmd->error = -ENOMEDIUM;
  1820. tasklet_schedule(&host->finish_tasklet);
  1821. }
  1822. spin_unlock_irqrestore(&host->lock, flags);
  1823. }
  1824. static const struct mmc_host_ops sdhci_ops = {
  1825. .request = sdhci_request,
  1826. .post_req = sdhci_post_req,
  1827. .pre_req = sdhci_pre_req,
  1828. .set_ios = sdhci_set_ios,
  1829. .get_cd = sdhci_get_cd,
  1830. .get_ro = sdhci_get_ro,
  1831. .hw_reset = sdhci_hw_reset,
  1832. .enable_sdio_irq = sdhci_enable_sdio_irq,
  1833. .start_signal_voltage_switch = sdhci_start_signal_voltage_switch,
  1834. .prepare_hs400_tuning = sdhci_prepare_hs400_tuning,
  1835. .execute_tuning = sdhci_execute_tuning,
  1836. .select_drive_strength = sdhci_select_drive_strength,
  1837. .card_event = sdhci_card_event,
  1838. .card_busy = sdhci_card_busy,
  1839. };
  1840. /*****************************************************************************\
  1841. * *
  1842. * Tasklets *
  1843. * *
  1844. \*****************************************************************************/
  1845. static void sdhci_tasklet_finish(unsigned long param)
  1846. {
  1847. struct sdhci_host *host;
  1848. unsigned long flags;
  1849. struct mmc_request *mrq;
  1850. host = (struct sdhci_host*)param;
  1851. spin_lock_irqsave(&host->lock, flags);
  1852. /*
  1853. * If this tasklet gets rescheduled while running, it will
  1854. * be run again afterwards but without any active request.
  1855. */
  1856. if (!host->mrq) {
  1857. spin_unlock_irqrestore(&host->lock, flags);
  1858. return;
  1859. }
  1860. del_timer(&host->timer);
  1861. mrq = host->mrq;
  1862. /*
  1863. * The controller needs a reset of internal state machines
  1864. * upon error conditions.
  1865. */
  1866. if (!(host->flags & SDHCI_DEVICE_DEAD) &&
  1867. ((mrq->cmd && mrq->cmd->error) ||
  1868. (mrq->sbc && mrq->sbc->error) ||
  1869. (mrq->data && ((mrq->data->error && !mrq->data->stop) ||
  1870. (mrq->data->stop && mrq->data->stop->error))) ||
  1871. (host->quirks & SDHCI_QUIRK_RESET_AFTER_REQUEST))) {
  1872. /* Some controllers need this kick or reset won't work here */
  1873. if (host->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET)
  1874. /* This is to force an update */
  1875. host->ops->set_clock(host, host->clock);
  1876. /* Spec says we should do both at the same time, but Ricoh
  1877. controllers do not like that. */
  1878. sdhci_do_reset(host, SDHCI_RESET_CMD);
  1879. sdhci_do_reset(host, SDHCI_RESET_DATA);
  1880. }
  1881. host->mrq = NULL;
  1882. host->cmd = NULL;
  1883. host->data = NULL;
  1884. #ifndef SDHCI_USE_LEDS_CLASS
  1885. sdhci_deactivate_led(host);
  1886. #endif
  1887. mmiowb();
  1888. spin_unlock_irqrestore(&host->lock, flags);
  1889. mmc_request_done(host->mmc, mrq);
  1890. sdhci_runtime_pm_put(host);
  1891. }
  1892. static void sdhci_timeout_timer(unsigned long data)
  1893. {
  1894. struct sdhci_host *host;
  1895. unsigned long flags;
  1896. host = (struct sdhci_host*)data;
  1897. spin_lock_irqsave(&host->lock, flags);
  1898. if (host->mrq) {
  1899. pr_err("%s: Timeout waiting for hardware "
  1900. "interrupt.\n", mmc_hostname(host->mmc));
  1901. sdhci_dumpregs(host);
  1902. if (host->data) {
  1903. host->data->error = -ETIMEDOUT;
  1904. sdhci_finish_data(host);
  1905. } else {
  1906. if (host->cmd)
  1907. host->cmd->error = -ETIMEDOUT;
  1908. else
  1909. host->mrq->cmd->error = -ETIMEDOUT;
  1910. tasklet_schedule(&host->finish_tasklet);
  1911. }
  1912. }
  1913. mmiowb();
  1914. spin_unlock_irqrestore(&host->lock, flags);
  1915. }
  1916. /*****************************************************************************\
  1917. * *
  1918. * Interrupt handling *
  1919. * *
  1920. \*****************************************************************************/
  1921. static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask, u32 *mask)
  1922. {
  1923. BUG_ON(intmask == 0);
  1924. if (!host->cmd) {
  1925. pr_err("%s: Got command interrupt 0x%08x even "
  1926. "though no command operation was in progress.\n",
  1927. mmc_hostname(host->mmc), (unsigned)intmask);
  1928. sdhci_dumpregs(host);
  1929. return;
  1930. }
  1931. if (intmask & SDHCI_INT_TIMEOUT)
  1932. host->cmd->error = -ETIMEDOUT;
  1933. else if (intmask & (SDHCI_INT_CRC | SDHCI_INT_END_BIT |
  1934. SDHCI_INT_INDEX))
  1935. host->cmd->error = -EILSEQ;
  1936. if (host->cmd->error) {
  1937. tasklet_schedule(&host->finish_tasklet);
  1938. return;
  1939. }
  1940. /*
  1941. * The host can send and interrupt when the busy state has
  1942. * ended, allowing us to wait without wasting CPU cycles.
  1943. * Unfortunately this is overloaded on the "data complete"
  1944. * interrupt, so we need to take some care when handling
  1945. * it.
  1946. *
  1947. * Note: The 1.0 specification is a bit ambiguous about this
  1948. * feature so there might be some problems with older
  1949. * controllers.
  1950. */
  1951. if (host->cmd->flags & MMC_RSP_BUSY) {
  1952. if (host->cmd->data)
  1953. DBG("Cannot wait for busy signal when also "
  1954. "doing a data transfer");
  1955. else if (!(host->quirks & SDHCI_QUIRK_NO_BUSY_IRQ)
  1956. && !host->busy_handle) {
  1957. /* Mark that command complete before busy is ended */
  1958. host->busy_handle = 1;
  1959. return;
  1960. }
  1961. /* The controller does not support the end-of-busy IRQ,
  1962. * fall through and take the SDHCI_INT_RESPONSE */
  1963. } else if ((host->quirks2 & SDHCI_QUIRK2_STOP_WITH_TC) &&
  1964. host->cmd->opcode == MMC_STOP_TRANSMISSION && !host->data) {
  1965. *mask &= ~SDHCI_INT_DATA_END;
  1966. }
  1967. if (intmask & SDHCI_INT_RESPONSE)
  1968. sdhci_finish_command(host);
  1969. }
  1970. #ifdef CONFIG_MMC_DEBUG
  1971. static void sdhci_adma_show_error(struct sdhci_host *host)
  1972. {
  1973. const char *name = mmc_hostname(host->mmc);
  1974. void *desc = host->adma_table;
  1975. sdhci_dumpregs(host);
  1976. while (true) {
  1977. struct sdhci_adma2_64_desc *dma_desc = desc;
  1978. if (host->flags & SDHCI_USE_64_BIT_DMA)
  1979. DBG("%s: %p: DMA 0x%08x%08x, LEN 0x%04x, Attr=0x%02x\n",
  1980. name, desc, le32_to_cpu(dma_desc->addr_hi),
  1981. le32_to_cpu(dma_desc->addr_lo),
  1982. le16_to_cpu(dma_desc->len),
  1983. le16_to_cpu(dma_desc->cmd));
  1984. else
  1985. DBG("%s: %p: DMA 0x%08x, LEN 0x%04x, Attr=0x%02x\n",
  1986. name, desc, le32_to_cpu(dma_desc->addr_lo),
  1987. le16_to_cpu(dma_desc->len),
  1988. le16_to_cpu(dma_desc->cmd));
  1989. desc += host->desc_sz;
  1990. if (dma_desc->cmd & cpu_to_le16(ADMA2_END))
  1991. break;
  1992. }
  1993. }
  1994. #else
  1995. static void sdhci_adma_show_error(struct sdhci_host *host) { }
  1996. #endif
  1997. static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
  1998. {
  1999. u32 command;
  2000. BUG_ON(intmask == 0);
  2001. /* CMD19 generates _only_ Buffer Read Ready interrupt */
  2002. if (intmask & SDHCI_INT_DATA_AVAIL) {
  2003. command = SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND));
  2004. if (command == MMC_SEND_TUNING_BLOCK ||
  2005. command == MMC_SEND_TUNING_BLOCK_HS200) {
  2006. host->tuning_done = 1;
  2007. wake_up(&host->buf_ready_int);
  2008. return;
  2009. }
  2010. }
  2011. if (!host->data) {
  2012. /*
  2013. * The "data complete" interrupt is also used to
  2014. * indicate that a busy state has ended. See comment
  2015. * above in sdhci_cmd_irq().
  2016. */
  2017. if (host->cmd && (host->cmd->flags & MMC_RSP_BUSY)) {
  2018. if (intmask & SDHCI_INT_DATA_TIMEOUT) {
  2019. host->cmd->error = -ETIMEDOUT;
  2020. tasklet_schedule(&host->finish_tasklet);
  2021. return;
  2022. }
  2023. if (intmask & SDHCI_INT_DATA_END) {
  2024. /*
  2025. * Some cards handle busy-end interrupt
  2026. * before the command completed, so make
  2027. * sure we do things in the proper order.
  2028. */
  2029. if (host->busy_handle)
  2030. sdhci_finish_command(host);
  2031. else
  2032. host->busy_handle = 1;
  2033. return;
  2034. }
  2035. }
  2036. pr_err("%s: Got data interrupt 0x%08x even "
  2037. "though no data operation was in progress.\n",
  2038. mmc_hostname(host->mmc), (unsigned)intmask);
  2039. sdhci_dumpregs(host);
  2040. return;
  2041. }
  2042. if (intmask & SDHCI_INT_DATA_TIMEOUT)
  2043. host->data->error = -ETIMEDOUT;
  2044. else if (intmask & SDHCI_INT_DATA_END_BIT)
  2045. host->data->error = -EILSEQ;
  2046. else if ((intmask & SDHCI_INT_DATA_CRC) &&
  2047. SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND))
  2048. != MMC_BUS_TEST_R)
  2049. host->data->error = -EILSEQ;
  2050. else if (intmask & SDHCI_INT_ADMA_ERROR) {
  2051. pr_err("%s: ADMA error\n", mmc_hostname(host->mmc));
  2052. sdhci_adma_show_error(host);
  2053. host->data->error = -EIO;
  2054. if (host->ops->adma_workaround)
  2055. host->ops->adma_workaround(host, intmask);
  2056. }
  2057. if (host->data->error)
  2058. sdhci_finish_data(host);
  2059. else {
  2060. if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
  2061. sdhci_transfer_pio(host);
  2062. /*
  2063. * We currently don't do anything fancy with DMA
  2064. * boundaries, but as we can't disable the feature
  2065. * we need to at least restart the transfer.
  2066. *
  2067. * According to the spec sdhci_readl(host, SDHCI_DMA_ADDRESS)
  2068. * should return a valid address to continue from, but as
  2069. * some controllers are faulty, don't trust them.
  2070. */
  2071. if (intmask & SDHCI_INT_DMA_END) {
  2072. u32 dmastart, dmanow;
  2073. dmastart = sg_dma_address(host->data->sg);
  2074. dmanow = dmastart + host->data->bytes_xfered;
  2075. /*
  2076. * Force update to the next DMA block boundary.
  2077. */
  2078. dmanow = (dmanow &
  2079. ~(SDHCI_DEFAULT_BOUNDARY_SIZE - 1)) +
  2080. SDHCI_DEFAULT_BOUNDARY_SIZE;
  2081. host->data->bytes_xfered = dmanow - dmastart;
  2082. DBG("%s: DMA base 0x%08x, transferred 0x%06x bytes,"
  2083. " next 0x%08x\n",
  2084. mmc_hostname(host->mmc), dmastart,
  2085. host->data->bytes_xfered, dmanow);
  2086. sdhci_writel(host, dmanow, SDHCI_DMA_ADDRESS);
  2087. }
  2088. if (intmask & SDHCI_INT_DATA_END) {
  2089. if (host->cmd) {
  2090. /*
  2091. * Data managed to finish before the
  2092. * command completed. Make sure we do
  2093. * things in the proper order.
  2094. */
  2095. host->data_early = 1;
  2096. } else {
  2097. sdhci_finish_data(host);
  2098. }
  2099. }
  2100. }
  2101. }
  2102. static irqreturn_t sdhci_irq(int irq, void *dev_id)
  2103. {
  2104. irqreturn_t result = IRQ_NONE;
  2105. struct sdhci_host *host = dev_id;
  2106. u32 intmask, mask, unexpected = 0;
  2107. int max_loops = 16;
  2108. spin_lock(&host->lock);
  2109. if (host->runtime_suspended && !sdhci_sdio_irq_enabled(host)) {
  2110. spin_unlock(&host->lock);
  2111. return IRQ_NONE;
  2112. }
  2113. intmask = sdhci_readl(host, SDHCI_INT_STATUS);
  2114. if (!intmask || intmask == 0xffffffff) {
  2115. result = IRQ_NONE;
  2116. goto out;
  2117. }
  2118. do {
  2119. /* Clear selected interrupts. */
  2120. mask = intmask & (SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
  2121. SDHCI_INT_BUS_POWER);
  2122. sdhci_writel(host, mask, SDHCI_INT_STATUS);
  2123. DBG("*** %s got interrupt: 0x%08x\n",
  2124. mmc_hostname(host->mmc), intmask);
  2125. if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
  2126. u32 present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
  2127. SDHCI_CARD_PRESENT;
  2128. /*
  2129. * There is a observation on i.mx esdhc. INSERT
  2130. * bit will be immediately set again when it gets
  2131. * cleared, if a card is inserted. We have to mask
  2132. * the irq to prevent interrupt storm which will
  2133. * freeze the system. And the REMOVE gets the
  2134. * same situation.
  2135. *
  2136. * More testing are needed here to ensure it works
  2137. * for other platforms though.
  2138. */
  2139. host->ier &= ~(SDHCI_INT_CARD_INSERT |
  2140. SDHCI_INT_CARD_REMOVE);
  2141. host->ier |= present ? SDHCI_INT_CARD_REMOVE :
  2142. SDHCI_INT_CARD_INSERT;
  2143. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  2144. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  2145. sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT |
  2146. SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS);
  2147. host->thread_isr |= intmask & (SDHCI_INT_CARD_INSERT |
  2148. SDHCI_INT_CARD_REMOVE);
  2149. result = IRQ_WAKE_THREAD;
  2150. }
  2151. if (intmask & SDHCI_INT_CMD_MASK)
  2152. sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK,
  2153. &intmask);
  2154. if (intmask & SDHCI_INT_DATA_MASK)
  2155. sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
  2156. if (intmask & SDHCI_INT_BUS_POWER)
  2157. pr_err("%s: Card is consuming too much power!\n",
  2158. mmc_hostname(host->mmc));
  2159. if (intmask & SDHCI_INT_CARD_INT) {
  2160. sdhci_enable_sdio_irq_nolock(host, false);
  2161. host->thread_isr |= SDHCI_INT_CARD_INT;
  2162. result = IRQ_WAKE_THREAD;
  2163. }
  2164. intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE |
  2165. SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
  2166. SDHCI_INT_ERROR | SDHCI_INT_BUS_POWER |
  2167. SDHCI_INT_CARD_INT);
  2168. if (intmask) {
  2169. unexpected |= intmask;
  2170. sdhci_writel(host, intmask, SDHCI_INT_STATUS);
  2171. }
  2172. if (result == IRQ_NONE)
  2173. result = IRQ_HANDLED;
  2174. intmask = sdhci_readl(host, SDHCI_INT_STATUS);
  2175. } while (intmask && --max_loops);
  2176. out:
  2177. spin_unlock(&host->lock);
  2178. if (unexpected) {
  2179. pr_err("%s: Unexpected interrupt 0x%08x.\n",
  2180. mmc_hostname(host->mmc), unexpected);
  2181. sdhci_dumpregs(host);
  2182. }
  2183. return result;
  2184. }
  2185. static irqreturn_t sdhci_thread_irq(int irq, void *dev_id)
  2186. {
  2187. struct sdhci_host *host = dev_id;
  2188. unsigned long flags;
  2189. u32 isr;
  2190. spin_lock_irqsave(&host->lock, flags);
  2191. isr = host->thread_isr;
  2192. host->thread_isr = 0;
  2193. spin_unlock_irqrestore(&host->lock, flags);
  2194. if (isr & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
  2195. sdhci_card_event(host->mmc);
  2196. mmc_detect_change(host->mmc, msecs_to_jiffies(200));
  2197. }
  2198. if (isr & SDHCI_INT_CARD_INT) {
  2199. sdio_run_irqs(host->mmc);
  2200. spin_lock_irqsave(&host->lock, flags);
  2201. if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
  2202. sdhci_enable_sdio_irq_nolock(host, true);
  2203. spin_unlock_irqrestore(&host->lock, flags);
  2204. }
  2205. return isr ? IRQ_HANDLED : IRQ_NONE;
  2206. }
  2207. /*****************************************************************************\
  2208. * *
  2209. * Suspend/resume *
  2210. * *
  2211. \*****************************************************************************/
  2212. #ifdef CONFIG_PM
  2213. void sdhci_enable_irq_wakeups(struct sdhci_host *host)
  2214. {
  2215. u8 val;
  2216. u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
  2217. | SDHCI_WAKE_ON_INT;
  2218. val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
  2219. val |= mask ;
  2220. /* Avoid fake wake up */
  2221. if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
  2222. val &= ~(SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE);
  2223. sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
  2224. }
  2225. EXPORT_SYMBOL_GPL(sdhci_enable_irq_wakeups);
  2226. static void sdhci_disable_irq_wakeups(struct sdhci_host *host)
  2227. {
  2228. u8 val;
  2229. u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
  2230. | SDHCI_WAKE_ON_INT;
  2231. val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
  2232. val &= ~mask;
  2233. sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
  2234. }
  2235. int sdhci_suspend_host(struct sdhci_host *host)
  2236. {
  2237. sdhci_disable_card_detection(host);
  2238. mmc_retune_timer_stop(host->mmc);
  2239. mmc_retune_needed(host->mmc);
  2240. if (!device_may_wakeup(mmc_dev(host->mmc))) {
  2241. host->ier = 0;
  2242. sdhci_writel(host, 0, SDHCI_INT_ENABLE);
  2243. sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
  2244. free_irq(host->irq, host);
  2245. } else {
  2246. sdhci_enable_irq_wakeups(host);
  2247. enable_irq_wake(host->irq);
  2248. }
  2249. return 0;
  2250. }
  2251. EXPORT_SYMBOL_GPL(sdhci_suspend_host);
  2252. int sdhci_resume_host(struct sdhci_host *host)
  2253. {
  2254. int ret = 0;
  2255. if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
  2256. if (host->ops->enable_dma)
  2257. host->ops->enable_dma(host);
  2258. }
  2259. if (!device_may_wakeup(mmc_dev(host->mmc))) {
  2260. ret = request_threaded_irq(host->irq, sdhci_irq,
  2261. sdhci_thread_irq, IRQF_SHARED,
  2262. mmc_hostname(host->mmc), host);
  2263. if (ret)
  2264. return ret;
  2265. } else {
  2266. sdhci_disable_irq_wakeups(host);
  2267. disable_irq_wake(host->irq);
  2268. }
  2269. if ((host->mmc->pm_flags & MMC_PM_KEEP_POWER) &&
  2270. (host->quirks2 & SDHCI_QUIRK2_HOST_OFF_CARD_ON)) {
  2271. /* Card keeps power but host controller does not */
  2272. sdhci_init(host, 0);
  2273. host->pwr = 0;
  2274. host->clock = 0;
  2275. sdhci_do_set_ios(host, &host->mmc->ios);
  2276. } else {
  2277. sdhci_init(host, (host->mmc->pm_flags & MMC_PM_KEEP_POWER));
  2278. mmiowb();
  2279. }
  2280. sdhci_enable_card_detection(host);
  2281. return ret;
  2282. }
  2283. EXPORT_SYMBOL_GPL(sdhci_resume_host);
  2284. static int sdhci_runtime_pm_get(struct sdhci_host *host)
  2285. {
  2286. return pm_runtime_get_sync(host->mmc->parent);
  2287. }
  2288. static int sdhci_runtime_pm_put(struct sdhci_host *host)
  2289. {
  2290. pm_runtime_mark_last_busy(host->mmc->parent);
  2291. return pm_runtime_put_autosuspend(host->mmc->parent);
  2292. }
  2293. static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
  2294. {
  2295. if (host->runtime_suspended || host->bus_on)
  2296. return;
  2297. host->bus_on = true;
  2298. pm_runtime_get_noresume(host->mmc->parent);
  2299. }
  2300. static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
  2301. {
  2302. if (host->runtime_suspended || !host->bus_on)
  2303. return;
  2304. host->bus_on = false;
  2305. pm_runtime_put_noidle(host->mmc->parent);
  2306. }
  2307. int sdhci_runtime_suspend_host(struct sdhci_host *host)
  2308. {
  2309. unsigned long flags;
  2310. mmc_retune_timer_stop(host->mmc);
  2311. mmc_retune_needed(host->mmc);
  2312. spin_lock_irqsave(&host->lock, flags);
  2313. host->ier &= SDHCI_INT_CARD_INT;
  2314. sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
  2315. sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
  2316. spin_unlock_irqrestore(&host->lock, flags);
  2317. synchronize_hardirq(host->irq);
  2318. spin_lock_irqsave(&host->lock, flags);
  2319. host->runtime_suspended = true;
  2320. spin_unlock_irqrestore(&host->lock, flags);
  2321. return 0;
  2322. }
  2323. EXPORT_SYMBOL_GPL(sdhci_runtime_suspend_host);
  2324. int sdhci_runtime_resume_host(struct sdhci_host *host)
  2325. {
  2326. unsigned long flags;
  2327. int host_flags = host->flags;
  2328. if (host_flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
  2329. if (host->ops->enable_dma)
  2330. host->ops->enable_dma(host);
  2331. }
  2332. sdhci_init(host, 0);
  2333. /* Force clock and power re-program */
  2334. host->pwr = 0;
  2335. host->clock = 0;
  2336. sdhci_do_start_signal_voltage_switch(host, &host->mmc->ios);
  2337. sdhci_do_set_ios(host, &host->mmc->ios);
  2338. if ((host_flags & SDHCI_PV_ENABLED) &&
  2339. !(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN)) {
  2340. spin_lock_irqsave(&host->lock, flags);
  2341. sdhci_enable_preset_value(host, true);
  2342. spin_unlock_irqrestore(&host->lock, flags);
  2343. }
  2344. spin_lock_irqsave(&host->lock, flags);
  2345. host->runtime_suspended = false;
  2346. /* Enable SDIO IRQ */
  2347. if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
  2348. sdhci_enable_sdio_irq_nolock(host, true);
  2349. /* Enable Card Detection */
  2350. sdhci_enable_card_detection(host);
  2351. spin_unlock_irqrestore(&host->lock, flags);
  2352. return 0;
  2353. }
  2354. EXPORT_SYMBOL_GPL(sdhci_runtime_resume_host);
  2355. #endif /* CONFIG_PM */
  2356. /*****************************************************************************\
  2357. * *
  2358. * Device allocation/registration *
  2359. * *
  2360. \*****************************************************************************/
  2361. struct sdhci_host *sdhci_alloc_host(struct device *dev,
  2362. size_t priv_size)
  2363. {
  2364. struct mmc_host *mmc;
  2365. struct sdhci_host *host;
  2366. WARN_ON(dev == NULL);
  2367. mmc = mmc_alloc_host(sizeof(struct sdhci_host) + priv_size, dev);
  2368. if (!mmc)
  2369. return ERR_PTR(-ENOMEM);
  2370. host = mmc_priv(mmc);
  2371. host->mmc = mmc;
  2372. return host;
  2373. }
  2374. EXPORT_SYMBOL_GPL(sdhci_alloc_host);
  2375. int sdhci_add_host(struct sdhci_host *host)
  2376. {
  2377. struct mmc_host *mmc;
  2378. u32 caps[2] = {0, 0};
  2379. u32 max_current_caps;
  2380. unsigned int ocr_avail;
  2381. unsigned int override_timeout_clk;
  2382. u32 max_clk;
  2383. int ret;
  2384. WARN_ON(host == NULL);
  2385. if (host == NULL)
  2386. return -EINVAL;
  2387. mmc = host->mmc;
  2388. if (debug_quirks)
  2389. host->quirks = debug_quirks;
  2390. if (debug_quirks2)
  2391. host->quirks2 = debug_quirks2;
  2392. override_timeout_clk = host->timeout_clk;
  2393. sdhci_do_reset(host, SDHCI_RESET_ALL);
  2394. host->version = sdhci_readw(host, SDHCI_HOST_VERSION);
  2395. host->version = (host->version & SDHCI_SPEC_VER_MASK)
  2396. >> SDHCI_SPEC_VER_SHIFT;
  2397. if (host->version > SDHCI_SPEC_300) {
  2398. pr_err("%s: Unknown controller version (%d). "
  2399. "You may experience problems.\n", mmc_hostname(mmc),
  2400. host->version);
  2401. }
  2402. caps[0] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ? host->caps :
  2403. sdhci_readl(host, SDHCI_CAPABILITIES);
  2404. if (host->version >= SDHCI_SPEC_300)
  2405. caps[1] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ?
  2406. host->caps1 :
  2407. sdhci_readl(host, SDHCI_CAPABILITIES_1);
  2408. if (host->quirks & SDHCI_QUIRK_FORCE_DMA)
  2409. host->flags |= SDHCI_USE_SDMA;
  2410. else if (!(caps[0] & SDHCI_CAN_DO_SDMA))
  2411. DBG("Controller doesn't have SDMA capability\n");
  2412. else
  2413. host->flags |= SDHCI_USE_SDMA;
  2414. if ((host->quirks & SDHCI_QUIRK_BROKEN_DMA) &&
  2415. (host->flags & SDHCI_USE_SDMA)) {
  2416. DBG("Disabling DMA as it is marked broken\n");
  2417. host->flags &= ~SDHCI_USE_SDMA;
  2418. }
  2419. if ((host->version >= SDHCI_SPEC_200) &&
  2420. (caps[0] & SDHCI_CAN_DO_ADMA2))
  2421. host->flags |= SDHCI_USE_ADMA;
  2422. if ((host->quirks & SDHCI_QUIRK_BROKEN_ADMA) &&
  2423. (host->flags & SDHCI_USE_ADMA)) {
  2424. DBG("Disabling ADMA as it is marked broken\n");
  2425. host->flags &= ~SDHCI_USE_ADMA;
  2426. }
  2427. /*
  2428. * It is assumed that a 64-bit capable device has set a 64-bit DMA mask
  2429. * and *must* do 64-bit DMA. A driver has the opportunity to change
  2430. * that during the first call to ->enable_dma(). Similarly
  2431. * SDHCI_QUIRK2_BROKEN_64_BIT_DMA must be left to the drivers to
  2432. * implement.
  2433. */
  2434. if (sdhci_readl(host, SDHCI_CAPABILITIES) & SDHCI_CAN_64BIT)
  2435. host->flags |= SDHCI_USE_64_BIT_DMA;
  2436. if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
  2437. if (host->ops->enable_dma) {
  2438. if (host->ops->enable_dma(host)) {
  2439. pr_warn("%s: No suitable DMA available - falling back to PIO\n",
  2440. mmc_hostname(mmc));
  2441. host->flags &=
  2442. ~(SDHCI_USE_SDMA | SDHCI_USE_ADMA);
  2443. }
  2444. }
  2445. }
  2446. /* SDMA does not support 64-bit DMA */
  2447. if (host->flags & SDHCI_USE_64_BIT_DMA)
  2448. host->flags &= ~SDHCI_USE_SDMA;
  2449. if (host->flags & SDHCI_USE_ADMA) {
  2450. /*
  2451. * The DMA descriptor table size is calculated as the maximum
  2452. * number of segments times 2, to allow for an alignment
  2453. * descriptor for each segment, plus 1 for a nop end descriptor,
  2454. * all multipled by the descriptor size.
  2455. */
  2456. if (host->flags & SDHCI_USE_64_BIT_DMA) {
  2457. host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
  2458. SDHCI_ADMA2_64_DESC_SZ;
  2459. host->align_buffer_sz = SDHCI_MAX_SEGS *
  2460. SDHCI_ADMA2_64_ALIGN;
  2461. host->desc_sz = SDHCI_ADMA2_64_DESC_SZ;
  2462. host->align_sz = SDHCI_ADMA2_64_ALIGN;
  2463. host->align_mask = SDHCI_ADMA2_64_ALIGN - 1;
  2464. } else {
  2465. host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
  2466. SDHCI_ADMA2_32_DESC_SZ;
  2467. host->align_buffer_sz = SDHCI_MAX_SEGS *
  2468. SDHCI_ADMA2_32_ALIGN;
  2469. host->desc_sz = SDHCI_ADMA2_32_DESC_SZ;
  2470. host->align_sz = SDHCI_ADMA2_32_ALIGN;
  2471. host->align_mask = SDHCI_ADMA2_32_ALIGN - 1;
  2472. }
  2473. host->adma_table = dma_alloc_coherent(mmc_dev(mmc),
  2474. host->adma_table_sz,
  2475. &host->adma_addr,
  2476. GFP_KERNEL);
  2477. host->align_buffer = kmalloc(host->align_buffer_sz, GFP_KERNEL);
  2478. if (!host->adma_table || !host->align_buffer) {
  2479. if (host->adma_table)
  2480. dma_free_coherent(mmc_dev(mmc),
  2481. host->adma_table_sz,
  2482. host->adma_table,
  2483. host->adma_addr);
  2484. kfree(host->align_buffer);
  2485. pr_warn("%s: Unable to allocate ADMA buffers - falling back to standard DMA\n",
  2486. mmc_hostname(mmc));
  2487. host->flags &= ~SDHCI_USE_ADMA;
  2488. host->adma_table = NULL;
  2489. host->align_buffer = NULL;
  2490. } else if (host->adma_addr & host->align_mask) {
  2491. pr_warn("%s: unable to allocate aligned ADMA descriptor\n",
  2492. mmc_hostname(mmc));
  2493. host->flags &= ~SDHCI_USE_ADMA;
  2494. dma_free_coherent(mmc_dev(mmc), host->adma_table_sz,
  2495. host->adma_table, host->adma_addr);
  2496. kfree(host->align_buffer);
  2497. host->adma_table = NULL;
  2498. host->align_buffer = NULL;
  2499. }
  2500. }
  2501. /*
  2502. * If we use DMA, then it's up to the caller to set the DMA
  2503. * mask, but PIO does not need the hw shim so we set a new
  2504. * mask here in that case.
  2505. */
  2506. if (!(host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))) {
  2507. host->dma_mask = DMA_BIT_MASK(64);
  2508. mmc_dev(mmc)->dma_mask = &host->dma_mask;
  2509. }
  2510. if (host->version >= SDHCI_SPEC_300)
  2511. host->max_clk = (caps[0] & SDHCI_CLOCK_V3_BASE_MASK)
  2512. >> SDHCI_CLOCK_BASE_SHIFT;
  2513. else
  2514. host->max_clk = (caps[0] & SDHCI_CLOCK_BASE_MASK)
  2515. >> SDHCI_CLOCK_BASE_SHIFT;
  2516. host->max_clk *= 1000000;
  2517. if (host->max_clk == 0 || host->quirks &
  2518. SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN) {
  2519. if (!host->ops->get_max_clock) {
  2520. pr_err("%s: Hardware doesn't specify base clock "
  2521. "frequency.\n", mmc_hostname(mmc));
  2522. return -ENODEV;
  2523. }
  2524. host->max_clk = host->ops->get_max_clock(host);
  2525. }
  2526. /*
  2527. * In case of Host Controller v3.00, find out whether clock
  2528. * multiplier is supported.
  2529. */
  2530. host->clk_mul = (caps[1] & SDHCI_CLOCK_MUL_MASK) >>
  2531. SDHCI_CLOCK_MUL_SHIFT;
  2532. /*
  2533. * In case the value in Clock Multiplier is 0, then programmable
  2534. * clock mode is not supported, otherwise the actual clock
  2535. * multiplier is one more than the value of Clock Multiplier
  2536. * in the Capabilities Register.
  2537. */
  2538. if (host->clk_mul)
  2539. host->clk_mul += 1;
  2540. /*
  2541. * Set host parameters.
  2542. */
  2543. mmc->ops = &sdhci_ops;
  2544. max_clk = host->max_clk;
  2545. if (host->ops->get_min_clock)
  2546. mmc->f_min = host->ops->get_min_clock(host);
  2547. else if (host->version >= SDHCI_SPEC_300) {
  2548. if (host->clk_mul) {
  2549. mmc->f_min = (host->max_clk * host->clk_mul) / 1024;
  2550. max_clk = host->max_clk * host->clk_mul;
  2551. } else
  2552. mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_300;
  2553. } else
  2554. mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200;
  2555. if (!mmc->f_max || (mmc->f_max && (mmc->f_max > max_clk)))
  2556. mmc->f_max = max_clk;
  2557. if (!(host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK)) {
  2558. host->timeout_clk = (caps[0] & SDHCI_TIMEOUT_CLK_MASK) >>
  2559. SDHCI_TIMEOUT_CLK_SHIFT;
  2560. if (host->timeout_clk == 0) {
  2561. if (host->ops->get_timeout_clock) {
  2562. host->timeout_clk =
  2563. host->ops->get_timeout_clock(host);
  2564. } else {
  2565. pr_err("%s: Hardware doesn't specify timeout clock frequency.\n",
  2566. mmc_hostname(mmc));
  2567. return -ENODEV;
  2568. }
  2569. }
  2570. if (caps[0] & SDHCI_TIMEOUT_CLK_UNIT)
  2571. host->timeout_clk *= 1000;
  2572. mmc->max_busy_timeout = host->ops->get_max_timeout_count ?
  2573. host->ops->get_max_timeout_count(host) : 1 << 27;
  2574. mmc->max_busy_timeout /= host->timeout_clk;
  2575. }
  2576. if (override_timeout_clk)
  2577. host->timeout_clk = override_timeout_clk;
  2578. mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23;
  2579. mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD;
  2580. if (host->quirks & SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12)
  2581. host->flags |= SDHCI_AUTO_CMD12;
  2582. /* Auto-CMD23 stuff only works in ADMA or PIO. */
  2583. if ((host->version >= SDHCI_SPEC_300) &&
  2584. ((host->flags & SDHCI_USE_ADMA) ||
  2585. !(host->flags & SDHCI_USE_SDMA)) &&
  2586. !(host->quirks2 & SDHCI_QUIRK2_ACMD23_BROKEN)) {
  2587. host->flags |= SDHCI_AUTO_CMD23;
  2588. DBG("%s: Auto-CMD23 available\n", mmc_hostname(mmc));
  2589. } else {
  2590. DBG("%s: Auto-CMD23 unavailable\n", mmc_hostname(mmc));
  2591. }
  2592. /*
  2593. * A controller may support 8-bit width, but the board itself
  2594. * might not have the pins brought out. Boards that support
  2595. * 8-bit width must set "mmc->caps |= MMC_CAP_8_BIT_DATA;" in
  2596. * their platform code before calling sdhci_add_host(), and we
  2597. * won't assume 8-bit width for hosts without that CAP.
  2598. */
  2599. if (!(host->quirks & SDHCI_QUIRK_FORCE_1_BIT_DATA))
  2600. mmc->caps |= MMC_CAP_4_BIT_DATA;
  2601. if (host->quirks2 & SDHCI_QUIRK2_HOST_NO_CMD23)
  2602. mmc->caps &= ~MMC_CAP_CMD23;
  2603. if (caps[0] & SDHCI_CAN_DO_HISPD)
  2604. mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;
  2605. if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) &&
  2606. !(mmc->caps & MMC_CAP_NONREMOVABLE) &&
  2607. IS_ERR_VALUE(mmc_gpio_get_cd(host->mmc)))
  2608. mmc->caps |= MMC_CAP_NEEDS_POLL;
  2609. /* If there are external regulators, get them */
  2610. if (mmc_regulator_get_supply(mmc) == -EPROBE_DEFER)
  2611. return -EPROBE_DEFER;
  2612. /* If vqmmc regulator and no 1.8V signalling, then there's no UHS */
  2613. if (!IS_ERR(mmc->supply.vqmmc)) {
  2614. ret = regulator_enable(mmc->supply.vqmmc);
  2615. if (!regulator_is_supported_voltage(mmc->supply.vqmmc, 1700000,
  2616. 1950000))
  2617. caps[1] &= ~(SDHCI_SUPPORT_SDR104 |
  2618. SDHCI_SUPPORT_SDR50 |
  2619. SDHCI_SUPPORT_DDR50);
  2620. if (ret) {
  2621. pr_warn("%s: Failed to enable vqmmc regulator: %d\n",
  2622. mmc_hostname(mmc), ret);
  2623. mmc->supply.vqmmc = ERR_PTR(-EINVAL);
  2624. }
  2625. }
  2626. if (host->quirks2 & SDHCI_QUIRK2_NO_1_8_V)
  2627. caps[1] &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
  2628. SDHCI_SUPPORT_DDR50);
  2629. /* Any UHS-I mode in caps implies SDR12 and SDR25 support. */
  2630. if (caps[1] & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
  2631. SDHCI_SUPPORT_DDR50))
  2632. mmc->caps |= MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;
  2633. /* SDR104 supports also implies SDR50 support */
  2634. if (caps[1] & SDHCI_SUPPORT_SDR104) {
  2635. mmc->caps |= MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_SDR50;
  2636. /* SD3.0: SDR104 is supported so (for eMMC) the caps2
  2637. * field can be promoted to support HS200.
  2638. */
  2639. if (!(host->quirks2 & SDHCI_QUIRK2_BROKEN_HS200))
  2640. mmc->caps2 |= MMC_CAP2_HS200;
  2641. } else if (caps[1] & SDHCI_SUPPORT_SDR50)
  2642. mmc->caps |= MMC_CAP_UHS_SDR50;
  2643. if (host->quirks2 & SDHCI_QUIRK2_CAPS_BIT63_FOR_HS400 &&
  2644. (caps[1] & SDHCI_SUPPORT_HS400))
  2645. mmc->caps2 |= MMC_CAP2_HS400;
  2646. if ((mmc->caps2 & MMC_CAP2_HSX00_1_2V) &&
  2647. (IS_ERR(mmc->supply.vqmmc) ||
  2648. !regulator_is_supported_voltage(mmc->supply.vqmmc, 1100000,
  2649. 1300000)))
  2650. mmc->caps2 &= ~MMC_CAP2_HSX00_1_2V;
  2651. if ((caps[1] & SDHCI_SUPPORT_DDR50) &&
  2652. !(host->quirks2 & SDHCI_QUIRK2_BROKEN_DDR50))
  2653. mmc->caps |= MMC_CAP_UHS_DDR50;
  2654. /* Does the host need tuning for SDR50? */
  2655. if (caps[1] & SDHCI_USE_SDR50_TUNING)
  2656. host->flags |= SDHCI_SDR50_NEEDS_TUNING;
  2657. /* Does the host need tuning for SDR104 / HS200? */
  2658. if (mmc->caps2 & MMC_CAP2_HS200)
  2659. host->flags |= SDHCI_SDR104_NEEDS_TUNING;
  2660. /* Driver Type(s) (A, C, D) supported by the host */
  2661. if (caps[1] & SDHCI_DRIVER_TYPE_A)
  2662. mmc->caps |= MMC_CAP_DRIVER_TYPE_A;
  2663. if (caps[1] & SDHCI_DRIVER_TYPE_C)
  2664. mmc->caps |= MMC_CAP_DRIVER_TYPE_C;
  2665. if (caps[1] & SDHCI_DRIVER_TYPE_D)
  2666. mmc->caps |= MMC_CAP_DRIVER_TYPE_D;
  2667. /* Initial value for re-tuning timer count */
  2668. host->tuning_count = (caps[1] & SDHCI_RETUNING_TIMER_COUNT_MASK) >>
  2669. SDHCI_RETUNING_TIMER_COUNT_SHIFT;
  2670. /*
  2671. * In case Re-tuning Timer is not disabled, the actual value of
  2672. * re-tuning timer will be 2 ^ (n - 1).
  2673. */
  2674. if (host->tuning_count)
  2675. host->tuning_count = 1 << (host->tuning_count - 1);
  2676. /* Re-tuning mode supported by the Host Controller */
  2677. host->tuning_mode = (caps[1] & SDHCI_RETUNING_MODE_MASK) >>
  2678. SDHCI_RETUNING_MODE_SHIFT;
  2679. ocr_avail = 0;
  2680. /*
  2681. * According to SD Host Controller spec v3.00, if the Host System
  2682. * can afford more than 150mA, Host Driver should set XPC to 1. Also
  2683. * the value is meaningful only if Voltage Support in the Capabilities
  2684. * register is set. The actual current value is 4 times the register
  2685. * value.
  2686. */
  2687. max_current_caps = sdhci_readl(host, SDHCI_MAX_CURRENT);
  2688. if (!max_current_caps && !IS_ERR(mmc->supply.vmmc)) {
  2689. int curr = regulator_get_current_limit(mmc->supply.vmmc);
  2690. if (curr > 0) {
  2691. /* convert to SDHCI_MAX_CURRENT format */
  2692. curr = curr/1000; /* convert to mA */
  2693. curr = curr/SDHCI_MAX_CURRENT_MULTIPLIER;
  2694. curr = min_t(u32, curr, SDHCI_MAX_CURRENT_LIMIT);
  2695. max_current_caps =
  2696. (curr << SDHCI_MAX_CURRENT_330_SHIFT) |
  2697. (curr << SDHCI_MAX_CURRENT_300_SHIFT) |
  2698. (curr << SDHCI_MAX_CURRENT_180_SHIFT);
  2699. }
  2700. }
  2701. if (caps[0] & SDHCI_CAN_VDD_330) {
  2702. ocr_avail |= MMC_VDD_32_33 | MMC_VDD_33_34;
  2703. mmc->max_current_330 = ((max_current_caps &
  2704. SDHCI_MAX_CURRENT_330_MASK) >>
  2705. SDHCI_MAX_CURRENT_330_SHIFT) *
  2706. SDHCI_MAX_CURRENT_MULTIPLIER;
  2707. }
  2708. if (caps[0] & SDHCI_CAN_VDD_300) {
  2709. ocr_avail |= MMC_VDD_29_30 | MMC_VDD_30_31;
  2710. mmc->max_current_300 = ((max_current_caps &
  2711. SDHCI_MAX_CURRENT_300_MASK) >>
  2712. SDHCI_MAX_CURRENT_300_SHIFT) *
  2713. SDHCI_MAX_CURRENT_MULTIPLIER;
  2714. }
  2715. if (caps[0] & SDHCI_CAN_VDD_180) {
  2716. ocr_avail |= MMC_VDD_165_195;
  2717. mmc->max_current_180 = ((max_current_caps &
  2718. SDHCI_MAX_CURRENT_180_MASK) >>
  2719. SDHCI_MAX_CURRENT_180_SHIFT) *
  2720. SDHCI_MAX_CURRENT_MULTIPLIER;
  2721. }
  2722. /* If OCR set by host, use it instead. */
  2723. if (host->ocr_mask)
  2724. ocr_avail = host->ocr_mask;
  2725. /* If OCR set by external regulators, give it highest prio. */
  2726. if (mmc->ocr_avail)
  2727. ocr_avail = mmc->ocr_avail;
  2728. mmc->ocr_avail = ocr_avail;
  2729. mmc->ocr_avail_sdio = ocr_avail;
  2730. if (host->ocr_avail_sdio)
  2731. mmc->ocr_avail_sdio &= host->ocr_avail_sdio;
  2732. mmc->ocr_avail_sd = ocr_avail;
  2733. if (host->ocr_avail_sd)
  2734. mmc->ocr_avail_sd &= host->ocr_avail_sd;
  2735. else /* normal SD controllers don't support 1.8V */
  2736. mmc->ocr_avail_sd &= ~MMC_VDD_165_195;
  2737. mmc->ocr_avail_mmc = ocr_avail;
  2738. if (host->ocr_avail_mmc)
  2739. mmc->ocr_avail_mmc &= host->ocr_avail_mmc;
  2740. if (mmc->ocr_avail == 0) {
  2741. pr_err("%s: Hardware doesn't report any "
  2742. "support voltages.\n", mmc_hostname(mmc));
  2743. return -ENODEV;
  2744. }
  2745. spin_lock_init(&host->lock);
  2746. /*
  2747. * Maximum number of segments. Depends on if the hardware
  2748. * can do scatter/gather or not.
  2749. */
  2750. if (host->flags & SDHCI_USE_ADMA)
  2751. mmc->max_segs = SDHCI_MAX_SEGS;
  2752. else if (host->flags & SDHCI_USE_SDMA)
  2753. mmc->max_segs = 1;
  2754. else /* PIO */
  2755. mmc->max_segs = SDHCI_MAX_SEGS;
  2756. /*
  2757. * Maximum number of sectors in one transfer. Limited by SDMA boundary
  2758. * size (512KiB). Note some tuning modes impose a 4MiB limit, but this
  2759. * is less anyway.
  2760. */
  2761. mmc->max_req_size = 524288;
  2762. /*
  2763. * Maximum segment size. Could be one segment with the maximum number
  2764. * of bytes. When doing hardware scatter/gather, each entry cannot
  2765. * be larger than 64 KiB though.
  2766. */
  2767. if (host->flags & SDHCI_USE_ADMA) {
  2768. if (host->quirks & SDHCI_QUIRK_BROKEN_ADMA_ZEROLEN_DESC)
  2769. mmc->max_seg_size = 65535;
  2770. else
  2771. mmc->max_seg_size = 65536;
  2772. } else {
  2773. mmc->max_seg_size = mmc->max_req_size;
  2774. }
  2775. /*
  2776. * Maximum block size. This varies from controller to controller and
  2777. * is specified in the capabilities register.
  2778. */
  2779. if (host->quirks & SDHCI_QUIRK_FORCE_BLK_SZ_2048) {
  2780. mmc->max_blk_size = 2;
  2781. } else {
  2782. mmc->max_blk_size = (caps[0] & SDHCI_MAX_BLOCK_MASK) >>
  2783. SDHCI_MAX_BLOCK_SHIFT;
  2784. if (mmc->max_blk_size >= 3) {
  2785. pr_warn("%s: Invalid maximum block size, assuming 512 bytes\n",
  2786. mmc_hostname(mmc));
  2787. mmc->max_blk_size = 0;
  2788. }
  2789. }
  2790. mmc->max_blk_size = 512 << mmc->max_blk_size;
  2791. /*
  2792. * Maximum block count.
  2793. */
  2794. mmc->max_blk_count = (host->quirks & SDHCI_QUIRK_NO_MULTIBLOCK) ? 1 : 65535;
  2795. /*
  2796. * Init tasklets.
  2797. */
  2798. tasklet_init(&host->finish_tasklet,
  2799. sdhci_tasklet_finish, (unsigned long)host);
  2800. setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
  2801. init_waitqueue_head(&host->buf_ready_int);
  2802. sdhci_init(host, 0);
  2803. ret = request_threaded_irq(host->irq, sdhci_irq, sdhci_thread_irq,
  2804. IRQF_SHARED, mmc_hostname(mmc), host);
  2805. if (ret) {
  2806. pr_err("%s: Failed to request IRQ %d: %d\n",
  2807. mmc_hostname(mmc), host->irq, ret);
  2808. goto untasklet;
  2809. }
  2810. #ifdef CONFIG_MMC_DEBUG
  2811. sdhci_dumpregs(host);
  2812. #endif
  2813. #ifdef SDHCI_USE_LEDS_CLASS
  2814. snprintf(host->led_name, sizeof(host->led_name),
  2815. "%s::", mmc_hostname(mmc));
  2816. host->led.name = host->led_name;
  2817. host->led.brightness = LED_OFF;
  2818. host->led.default_trigger = mmc_hostname(mmc);
  2819. host->led.brightness_set = sdhci_led_control;
  2820. ret = led_classdev_register(mmc_dev(mmc), &host->led);
  2821. if (ret) {
  2822. pr_err("%s: Failed to register LED device: %d\n",
  2823. mmc_hostname(mmc), ret);
  2824. goto reset;
  2825. }
  2826. #endif
  2827. mmiowb();
  2828. mmc_add_host(mmc);
  2829. pr_info("%s: SDHCI controller on %s [%s] using %s\n",
  2830. mmc_hostname(mmc), host->hw_name, dev_name(mmc_dev(mmc)),
  2831. (host->flags & SDHCI_USE_ADMA) ?
  2832. (host->flags & SDHCI_USE_64_BIT_DMA) ? "ADMA 64-bit" : "ADMA" :
  2833. (host->flags & SDHCI_USE_SDMA) ? "DMA" : "PIO");
  2834. sdhci_enable_card_detection(host);
  2835. return 0;
  2836. #ifdef SDHCI_USE_LEDS_CLASS
  2837. reset:
  2838. sdhci_do_reset(host, SDHCI_RESET_ALL);
  2839. sdhci_writel(host, 0, SDHCI_INT_ENABLE);
  2840. sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
  2841. free_irq(host->irq, host);
  2842. #endif
  2843. untasklet:
  2844. tasklet_kill(&host->finish_tasklet);
  2845. return ret;
  2846. }
  2847. EXPORT_SYMBOL_GPL(sdhci_add_host);
  2848. void sdhci_remove_host(struct sdhci_host *host, int dead)
  2849. {
  2850. struct mmc_host *mmc = host->mmc;
  2851. unsigned long flags;
  2852. if (dead) {
  2853. spin_lock_irqsave(&host->lock, flags);
  2854. host->flags |= SDHCI_DEVICE_DEAD;
  2855. if (host->mrq) {
  2856. pr_err("%s: Controller removed during "
  2857. " transfer!\n", mmc_hostname(mmc));
  2858. host->mrq->cmd->error = -ENOMEDIUM;
  2859. tasklet_schedule(&host->finish_tasklet);
  2860. }
  2861. spin_unlock_irqrestore(&host->lock, flags);
  2862. }
  2863. sdhci_disable_card_detection(host);
  2864. mmc_remove_host(mmc);
  2865. #ifdef SDHCI_USE_LEDS_CLASS
  2866. led_classdev_unregister(&host->led);
  2867. #endif
  2868. if (!dead)
  2869. sdhci_do_reset(host, SDHCI_RESET_ALL);
  2870. sdhci_writel(host, 0, SDHCI_INT_ENABLE);
  2871. sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
  2872. free_irq(host->irq, host);
  2873. del_timer_sync(&host->timer);
  2874. tasklet_kill(&host->finish_tasklet);
  2875. if (!IS_ERR(mmc->supply.vqmmc))
  2876. regulator_disable(mmc->supply.vqmmc);
  2877. if (host->adma_table)
  2878. dma_free_coherent(mmc_dev(mmc), host->adma_table_sz,
  2879. host->adma_table, host->adma_addr);
  2880. kfree(host->align_buffer);
  2881. host->adma_table = NULL;
  2882. host->align_buffer = NULL;
  2883. }
  2884. EXPORT_SYMBOL_GPL(sdhci_remove_host);
  2885. void sdhci_free_host(struct sdhci_host *host)
  2886. {
  2887. mmc_free_host(host->mmc);
  2888. }
  2889. EXPORT_SYMBOL_GPL(sdhci_free_host);
  2890. /*****************************************************************************\
  2891. * *
  2892. * Driver init/exit *
  2893. * *
  2894. \*****************************************************************************/
  2895. static int __init sdhci_drv_init(void)
  2896. {
  2897. pr_info(DRIVER_NAME
  2898. ": Secure Digital Host Controller Interface driver\n");
  2899. pr_info(DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
  2900. return 0;
  2901. }
  2902. static void __exit sdhci_drv_exit(void)
  2903. {
  2904. }
  2905. module_init(sdhci_drv_init);
  2906. module_exit(sdhci_drv_exit);
  2907. module_param(debug_quirks, uint, 0444);
  2908. module_param(debug_quirks2, uint, 0444);
  2909. MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
  2910. MODULE_DESCRIPTION("Secure Digital Host Controller Interface core driver");
  2911. MODULE_LICENSE("GPL");
  2912. MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");
  2913. MODULE_PARM_DESC(debug_quirks2, "Force certain other quirks.");