ti-sysc.c 84 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * ti-sysc.c - Texas Instruments sysc interconnect target driver
  4. *
  5. * TI SoCs have an interconnect target wrapper IP for many devices. The wrapper
  6. * IP manages clock gating, resets, and PM capabilities for the connected devices.
  7. *
  8. * Copyright (C) 2017-2024 Texas Instruments Incorporated - https://www.ti.com/
  9. *
  10. * Many features are based on the earlier omap_hwmod arch code with thanks to all
  11. * the people who developed and debugged the code over the years:
  12. *
  13. * Copyright (C) 2009-2011 Nokia Corporation
  14. * Copyright (C) 2011-2021 Texas Instruments Incorporated - https://www.ti.com/
  15. */
  16. #include <linux/io.h>
  17. #include <linux/clk.h>
  18. #include <linux/clkdev.h>
  19. #include <linux/cpu_pm.h>
  20. #include <linux/delay.h>
  21. #include <linux/list.h>
  22. #include <linux/module.h>
  23. #include <linux/platform_device.h>
  24. #include <linux/pm_domain.h>
  25. #include <linux/pm_runtime.h>
  26. #include <linux/reset.h>
  27. #include <linux/of_address.h>
  28. #include <linux/of_platform.h>
  29. #include <linux/slab.h>
  30. #include <linux/sys_soc.h>
  31. #include <linux/timekeeping.h>
  32. #include <linux/iopoll.h>
  33. #include <linux/platform_data/ti-sysc.h>
  34. #include <dt-bindings/bus/ti-sysc.h>
  35. #define DIS_ISP BIT(2)
  36. #define DIS_IVA BIT(1)
  37. #define DIS_SGX BIT(0)
  38. #define SOC_FLAG(match, flag) { .machine = match, .data = (void *)(flag), }
  39. #define MAX_MODULE_SOFTRESET_WAIT 10000
  40. enum sysc_soc {
  41. SOC_UNKNOWN,
  42. SOC_2420,
  43. SOC_2430,
  44. SOC_AM33,
  45. SOC_3430,
  46. SOC_AM35,
  47. SOC_3630,
  48. SOC_4430,
  49. SOC_4460,
  50. SOC_4470,
  51. SOC_5430,
  52. SOC_AM3,
  53. SOC_AM4,
  54. SOC_DRA7,
  55. };
  56. struct sysc_address {
  57. unsigned long base;
  58. struct list_head node;
  59. };
  60. struct sysc_module {
  61. struct sysc *ddata;
  62. struct list_head node;
  63. };
  64. struct sysc_soc_info {
  65. unsigned long general_purpose:1;
  66. enum sysc_soc soc;
  67. struct mutex list_lock; /* disabled and restored modules list lock */
  68. struct list_head disabled_modules;
  69. struct list_head restored_modules;
  70. struct notifier_block nb;
  71. };
  72. enum sysc_clocks {
  73. SYSC_FCK,
  74. SYSC_ICK,
  75. SYSC_OPTFCK0,
  76. SYSC_OPTFCK1,
  77. SYSC_OPTFCK2,
  78. SYSC_OPTFCK3,
  79. SYSC_OPTFCK4,
  80. SYSC_OPTFCK5,
  81. SYSC_OPTFCK6,
  82. SYSC_OPTFCK7,
  83. SYSC_MAX_CLOCKS,
  84. };
  85. static struct sysc_soc_info *sysc_soc;
  86. static const char * const reg_names[] = { "rev", "sysc", "syss", };
  87. static const char * const clock_names[SYSC_MAX_CLOCKS] = {
  88. "fck", "ick", "opt0", "opt1", "opt2", "opt3", "opt4",
  89. "opt5", "opt6", "opt7",
  90. };
  91. #define SYSC_IDLEMODE_MASK 3
  92. #define SYSC_CLOCKACTIVITY_MASK 3
  93. /**
  94. * struct sysc - TI sysc interconnect target module registers and capabilities
  95. * @dev: struct device pointer
  96. * @module_pa: physical address of the interconnect target module
  97. * @module_size: size of the interconnect target module
  98. * @module_va: virtual address of the interconnect target module
  99. * @offsets: register offsets from module base
  100. * @mdata: ti-sysc to hwmod translation data for a module
  101. * @clocks: clocks used by the interconnect target module
  102. * @clock_roles: clock role names for the found clocks
  103. * @nr_clocks: number of clocks used by the interconnect target module
  104. * @rsts: resets used by the interconnect target module
  105. * @legacy_mode: configured for legacy mode if set
  106. * @cap: interconnect target module capabilities
  107. * @cfg: interconnect target module configuration
  108. * @cookie: data used by legacy platform callbacks
  109. * @name: name if available
  110. * @revision: interconnect target module revision
  111. * @sysconfig: saved sysconfig register value
  112. * @reserved: target module is reserved and already in use
  113. * @enabled: sysc runtime enabled status
  114. * @needs_resume: runtime resume needed on resume from suspend
  115. * @child_needs_resume: runtime resume needed for child on resume from suspend
  116. * @idle_work: work structure used to perform delayed idle on a module
  117. * @pre_reset_quirk: module specific pre-reset quirk
  118. * @post_reset_quirk: module specific post-reset quirk
  119. * @reset_done_quirk: module specific reset done quirk
  120. * @module_enable_quirk: module specific enable quirk
  121. * @module_disable_quirk: module specific disable quirk
  122. * @module_unlock_quirk: module specific sysconfig unlock quirk
  123. * @module_lock_quirk: module specific sysconfig lock quirk
  124. */
  125. struct sysc {
  126. struct device *dev;
  127. u64 module_pa;
  128. u32 module_size;
  129. void __iomem *module_va;
  130. int offsets[SYSC_MAX_REGS];
  131. struct ti_sysc_module_data *mdata;
  132. struct clk **clocks;
  133. const char **clock_roles;
  134. int nr_clocks;
  135. struct reset_control *rsts;
  136. const char *legacy_mode;
  137. const struct sysc_capabilities *cap;
  138. struct sysc_config cfg;
  139. struct ti_sysc_cookie cookie;
  140. const char *name;
  141. u32 revision;
  142. u32 sysconfig;
  143. unsigned int reserved:1;
  144. unsigned int enabled:1;
  145. unsigned int needs_resume:1;
  146. unsigned int child_needs_resume:1;
  147. struct delayed_work idle_work;
  148. void (*pre_reset_quirk)(struct sysc *sysc);
  149. void (*post_reset_quirk)(struct sysc *sysc);
  150. void (*reset_done_quirk)(struct sysc *sysc);
  151. void (*module_enable_quirk)(struct sysc *sysc);
  152. void (*module_disable_quirk)(struct sysc *sysc);
  153. void (*module_unlock_quirk)(struct sysc *sysc);
  154. void (*module_lock_quirk)(struct sysc *sysc);
  155. };
  156. static void sysc_parse_dts_quirks(struct sysc *ddata, struct device_node *np,
  157. bool is_child);
  158. static int sysc_reset(struct sysc *ddata);
  159. static void sysc_write(struct sysc *ddata, int offset, u32 value)
  160. {
  161. if (ddata->cfg.quirks & SYSC_QUIRK_16BIT) {
  162. writew_relaxed(value & 0xffff, ddata->module_va + offset);
  163. /* Only i2c revision has LO and HI register with stride of 4 */
  164. if (ddata->offsets[SYSC_REVISION] >= 0 &&
  165. offset == ddata->offsets[SYSC_REVISION]) {
  166. u16 hi = value >> 16;
  167. writew_relaxed(hi, ddata->module_va + offset + 4);
  168. }
  169. return;
  170. }
  171. writel_relaxed(value, ddata->module_va + offset);
  172. }
  173. static u32 sysc_read(struct sysc *ddata, int offset)
  174. {
  175. if (ddata->cfg.quirks & SYSC_QUIRK_16BIT) {
  176. u32 val;
  177. val = readw_relaxed(ddata->module_va + offset);
  178. /* Only i2c revision has LO and HI register with stride of 4 */
  179. if (ddata->offsets[SYSC_REVISION] >= 0 &&
  180. offset == ddata->offsets[SYSC_REVISION]) {
  181. u16 tmp = readw_relaxed(ddata->module_va + offset + 4);
  182. val |= tmp << 16;
  183. }
  184. return val;
  185. }
  186. return readl_relaxed(ddata->module_va + offset);
  187. }
  188. static bool sysc_opt_clks_needed(struct sysc *ddata)
  189. {
  190. return !!(ddata->cfg.quirks & SYSC_QUIRK_OPT_CLKS_NEEDED);
  191. }
  192. static u32 sysc_read_revision(struct sysc *ddata)
  193. {
  194. int offset = ddata->offsets[SYSC_REVISION];
  195. if (offset < 0)
  196. return 0;
  197. return sysc_read(ddata, offset);
  198. }
  199. static u32 sysc_read_sysconfig(struct sysc *ddata)
  200. {
  201. int offset = ddata->offsets[SYSC_SYSCONFIG];
  202. if (offset < 0)
  203. return 0;
  204. return sysc_read(ddata, offset);
  205. }
  206. static u32 sysc_read_sysstatus(struct sysc *ddata)
  207. {
  208. int offset = ddata->offsets[SYSC_SYSSTATUS];
  209. if (offset < 0)
  210. return 0;
  211. return sysc_read(ddata, offset);
  212. }
  213. static int sysc_poll_reset_sysstatus(struct sysc *ddata)
  214. {
  215. int error, retries;
  216. u32 syss_done, rstval;
  217. if (ddata->cfg.quirks & SYSS_QUIRK_RESETDONE_INVERTED)
  218. syss_done = 0;
  219. else
  220. syss_done = ddata->cfg.syss_mask;
  221. if (likely(!timekeeping_suspended)) {
  222. error = readx_poll_timeout_atomic(sysc_read_sysstatus, ddata,
  223. rstval, (rstval & ddata->cfg.syss_mask) ==
  224. syss_done, 100, MAX_MODULE_SOFTRESET_WAIT);
  225. } else {
  226. retries = MAX_MODULE_SOFTRESET_WAIT;
  227. while (retries--) {
  228. rstval = sysc_read_sysstatus(ddata);
  229. if ((rstval & ddata->cfg.syss_mask) == syss_done)
  230. return 0;
  231. udelay(2); /* Account for udelay flakeyness */
  232. }
  233. error = -ETIMEDOUT;
  234. }
  235. return error;
  236. }
  237. static int sysc_poll_reset_sysconfig(struct sysc *ddata)
  238. {
  239. int error, retries;
  240. u32 sysc_mask, rstval;
  241. sysc_mask = BIT(ddata->cap->regbits->srst_shift);
  242. if (likely(!timekeeping_suspended)) {
  243. error = readx_poll_timeout_atomic(sysc_read_sysconfig, ddata,
  244. rstval, !(rstval & sysc_mask),
  245. 100, MAX_MODULE_SOFTRESET_WAIT);
  246. } else {
  247. retries = MAX_MODULE_SOFTRESET_WAIT;
  248. while (retries--) {
  249. rstval = sysc_read_sysconfig(ddata);
  250. if (!(rstval & sysc_mask))
  251. return 0;
  252. udelay(2); /* Account for udelay flakeyness */
  253. }
  254. error = -ETIMEDOUT;
  255. }
  256. return error;
  257. }
  258. /* Poll on reset status */
  259. static int sysc_wait_softreset(struct sysc *ddata)
  260. {
  261. int syss_offset, error = 0;
  262. if (ddata->cap->regbits->srst_shift < 0)
  263. return 0;
  264. syss_offset = ddata->offsets[SYSC_SYSSTATUS];
  265. if (syss_offset >= 0)
  266. error = sysc_poll_reset_sysstatus(ddata);
  267. else if (ddata->cfg.quirks & SYSC_QUIRK_RESET_STATUS)
  268. error = sysc_poll_reset_sysconfig(ddata);
  269. return error;
  270. }
  271. static int sysc_add_named_clock_from_child(struct sysc *ddata,
  272. const char *name,
  273. const char *optfck_name)
  274. {
  275. struct device_node *np = ddata->dev->of_node;
  276. struct device_node *child;
  277. struct clk_lookup *cl;
  278. struct clk *clock;
  279. const char *n;
  280. if (name)
  281. n = name;
  282. else
  283. n = optfck_name;
  284. /* Does the clock alias already exist? */
  285. clock = of_clk_get_by_name(np, n);
  286. if (!IS_ERR(clock)) {
  287. clk_put(clock);
  288. return 0;
  289. }
  290. child = of_get_next_available_child(np, NULL);
  291. if (!child)
  292. return -ENODEV;
  293. clock = devm_get_clk_from_child(ddata->dev, child, name);
  294. if (IS_ERR(clock))
  295. return PTR_ERR(clock);
  296. /*
  297. * Use clkdev_add() instead of clkdev_alloc() to avoid the MAX_DEV_ID
  298. * limit for clk_get(). If cl ever needs to be freed, it should be done
  299. * with clkdev_drop().
  300. */
  301. cl = kzalloc_obj(*cl);
  302. if (!cl)
  303. return -ENOMEM;
  304. cl->con_id = n;
  305. cl->dev_id = dev_name(ddata->dev);
  306. cl->clk = clock;
  307. clkdev_add(cl);
  308. clk_put(clock);
  309. return 0;
  310. }
  311. static int sysc_init_ext_opt_clock(struct sysc *ddata, const char *name)
  312. {
  313. const char *optfck_name;
  314. int error, index;
  315. if (ddata->nr_clocks < SYSC_OPTFCK0)
  316. index = SYSC_OPTFCK0;
  317. else
  318. index = ddata->nr_clocks;
  319. if (name)
  320. optfck_name = name;
  321. else
  322. optfck_name = clock_names[index];
  323. error = sysc_add_named_clock_from_child(ddata, name, optfck_name);
  324. if (error)
  325. return error;
  326. ddata->clock_roles[index] = optfck_name;
  327. ddata->nr_clocks++;
  328. return 0;
  329. }
  330. static int sysc_get_one_clock(struct sysc *ddata, const char *name)
  331. {
  332. int error, i, index = -ENODEV;
  333. if (!strncmp(clock_names[SYSC_FCK], name, 3))
  334. index = SYSC_FCK;
  335. else if (!strncmp(clock_names[SYSC_ICK], name, 3))
  336. index = SYSC_ICK;
  337. if (index < 0) {
  338. for (i = SYSC_OPTFCK0; i < SYSC_MAX_CLOCKS; i++) {
  339. if (!ddata->clocks[i]) {
  340. index = i;
  341. break;
  342. }
  343. }
  344. }
  345. if (index < 0) {
  346. dev_err(ddata->dev, "clock %s not added\n", name);
  347. return index;
  348. }
  349. ddata->clocks[index] = devm_clk_get(ddata->dev, name);
  350. if (IS_ERR(ddata->clocks[index])) {
  351. dev_err(ddata->dev, "clock get error for %s: %li\n",
  352. name, PTR_ERR(ddata->clocks[index]));
  353. return PTR_ERR(ddata->clocks[index]);
  354. }
  355. error = clk_prepare(ddata->clocks[index]);
  356. if (error) {
  357. dev_err(ddata->dev, "clock prepare error for %s: %i\n",
  358. name, error);
  359. return error;
  360. }
  361. return 0;
  362. }
  363. static int sysc_get_clocks(struct sysc *ddata)
  364. {
  365. struct device_node *np = ddata->dev->of_node;
  366. struct property *prop;
  367. const char *name;
  368. int nr_fck = 0, nr_ick = 0, i, error = 0;
  369. ddata->clock_roles = devm_kcalloc(ddata->dev,
  370. SYSC_MAX_CLOCKS,
  371. sizeof(*ddata->clock_roles),
  372. GFP_KERNEL);
  373. if (!ddata->clock_roles)
  374. return -ENOMEM;
  375. of_property_for_each_string(np, "clock-names", prop, name) {
  376. if (!strncmp(clock_names[SYSC_FCK], name, 3))
  377. nr_fck++;
  378. if (!strncmp(clock_names[SYSC_ICK], name, 3))
  379. nr_ick++;
  380. ddata->clock_roles[ddata->nr_clocks] = name;
  381. ddata->nr_clocks++;
  382. }
  383. if (ddata->nr_clocks < 1)
  384. return 0;
  385. if ((ddata->cfg.quirks & SYSC_QUIRK_EXT_OPT_CLOCK)) {
  386. error = sysc_init_ext_opt_clock(ddata, NULL);
  387. if (error)
  388. return error;
  389. }
  390. if (ddata->nr_clocks > SYSC_MAX_CLOCKS) {
  391. dev_err(ddata->dev, "too many clocks for %pOF\n", np);
  392. return -EINVAL;
  393. }
  394. if (nr_fck > 1 || nr_ick > 1) {
  395. dev_err(ddata->dev, "max one fck and ick for %pOF\n", np);
  396. return -EINVAL;
  397. }
  398. /* Always add a slot for main clocks fck and ick even if unused */
  399. if (!nr_fck)
  400. ddata->nr_clocks++;
  401. if (!nr_ick)
  402. ddata->nr_clocks++;
  403. ddata->clocks = devm_kcalloc(ddata->dev,
  404. ddata->nr_clocks, sizeof(*ddata->clocks),
  405. GFP_KERNEL);
  406. if (!ddata->clocks)
  407. return -ENOMEM;
  408. for (i = 0; i < SYSC_MAX_CLOCKS; i++) {
  409. const char *name = ddata->clock_roles[i];
  410. if (!name)
  411. continue;
  412. error = sysc_get_one_clock(ddata, name);
  413. if (error)
  414. return error;
  415. }
  416. return 0;
  417. }
  418. static int sysc_enable_main_clocks(struct sysc *ddata)
  419. {
  420. struct clk *clock;
  421. int i, error;
  422. if (!ddata->clocks)
  423. return 0;
  424. for (i = 0; i < SYSC_OPTFCK0; i++) {
  425. clock = ddata->clocks[i];
  426. /* Main clocks may not have ick */
  427. if (IS_ERR_OR_NULL(clock))
  428. continue;
  429. error = clk_enable(clock);
  430. if (error)
  431. goto err_disable;
  432. }
  433. return 0;
  434. err_disable:
  435. for (i--; i >= 0; i--) {
  436. clock = ddata->clocks[i];
  437. /* Main clocks may not have ick */
  438. if (IS_ERR_OR_NULL(clock))
  439. continue;
  440. clk_disable(clock);
  441. }
  442. return error;
  443. }
  444. static void sysc_disable_main_clocks(struct sysc *ddata)
  445. {
  446. struct clk *clock;
  447. int i;
  448. if (!ddata->clocks)
  449. return;
  450. for (i = 0; i < SYSC_OPTFCK0; i++) {
  451. clock = ddata->clocks[i];
  452. if (IS_ERR_OR_NULL(clock))
  453. continue;
  454. clk_disable(clock);
  455. }
  456. }
  457. static int sysc_enable_opt_clocks(struct sysc *ddata)
  458. {
  459. struct clk *clock;
  460. int i, error;
  461. if (!ddata->clocks || ddata->nr_clocks < SYSC_OPTFCK0 + 1)
  462. return 0;
  463. for (i = SYSC_OPTFCK0; i < SYSC_MAX_CLOCKS; i++) {
  464. clock = ddata->clocks[i];
  465. /* Assume no holes for opt clocks */
  466. if (IS_ERR_OR_NULL(clock))
  467. return 0;
  468. error = clk_enable(clock);
  469. if (error)
  470. goto err_disable;
  471. }
  472. return 0;
  473. err_disable:
  474. for (i--; i >= 0; i--) {
  475. clock = ddata->clocks[i];
  476. if (IS_ERR_OR_NULL(clock))
  477. continue;
  478. clk_disable(clock);
  479. }
  480. return error;
  481. }
  482. static void sysc_disable_opt_clocks(struct sysc *ddata)
  483. {
  484. struct clk *clock;
  485. int i;
  486. if (!ddata->clocks || ddata->nr_clocks < SYSC_OPTFCK0 + 1)
  487. return;
  488. for (i = SYSC_OPTFCK0; i < SYSC_MAX_CLOCKS; i++) {
  489. clock = ddata->clocks[i];
  490. /* Assume no holes for opt clocks */
  491. if (IS_ERR_OR_NULL(clock))
  492. return;
  493. clk_disable(clock);
  494. }
  495. }
  496. static void sysc_clkdm_deny_idle(struct sysc *ddata)
  497. {
  498. struct ti_sysc_platform_data *pdata;
  499. if (ddata->legacy_mode || (ddata->cfg.quirks & SYSC_QUIRK_CLKDM_NOAUTO))
  500. return;
  501. pdata = dev_get_platdata(ddata->dev);
  502. if (pdata && pdata->clkdm_deny_idle)
  503. pdata->clkdm_deny_idle(ddata->dev, &ddata->cookie);
  504. }
  505. static void sysc_clkdm_allow_idle(struct sysc *ddata)
  506. {
  507. struct ti_sysc_platform_data *pdata;
  508. if (ddata->legacy_mode || (ddata->cfg.quirks & SYSC_QUIRK_CLKDM_NOAUTO))
  509. return;
  510. pdata = dev_get_platdata(ddata->dev);
  511. if (pdata && pdata->clkdm_allow_idle)
  512. pdata->clkdm_allow_idle(ddata->dev, &ddata->cookie);
  513. }
  514. /**
  515. * sysc_init_resets - init rstctrl reset line if configured
  516. * @ddata: device driver data
  517. *
  518. * See sysc_rstctrl_reset_deassert().
  519. */
  520. static int sysc_init_resets(struct sysc *ddata)
  521. {
  522. ddata->rsts =
  523. devm_reset_control_get_optional_shared(ddata->dev, "rstctrl");
  524. return PTR_ERR_OR_ZERO(ddata->rsts);
  525. }
  526. /**
  527. * sysc_parse_and_check_child_range - parses module IO region from ranges
  528. * @ddata: device driver data
  529. *
  530. * In general we only need rev, syss, and sysc registers and not the whole
  531. * module range. But we do want the offsets for these registers from the
  532. * module base. This allows us to check them against the legacy hwmod
  533. * platform data. Let's also check the ranges are configured properly.
  534. */
  535. static int sysc_parse_and_check_child_range(struct sysc *ddata)
  536. {
  537. struct device_node *np = ddata->dev->of_node;
  538. struct of_range_parser parser;
  539. struct of_range range;
  540. int error;
  541. error = of_range_parser_init(&parser, np);
  542. if (error)
  543. return error;
  544. for_each_of_range(&parser, &range) {
  545. ddata->module_pa = range.cpu_addr;
  546. ddata->module_size = range.size;
  547. break;
  548. }
  549. return 0;
  550. }
  551. static struct device_node *stdout_path;
  552. static void sysc_init_stdout_path(struct sysc *ddata)
  553. {
  554. struct device_node *np = NULL;
  555. const char *uart;
  556. if (IS_ERR(stdout_path))
  557. return;
  558. if (stdout_path)
  559. return;
  560. np = of_find_node_by_path("/chosen");
  561. if (!np)
  562. goto err;
  563. uart = of_get_property(np, "stdout-path", NULL);
  564. if (!uart)
  565. goto err;
  566. np = of_find_node_by_path(uart);
  567. if (!np)
  568. goto err;
  569. stdout_path = np;
  570. return;
  571. err:
  572. stdout_path = ERR_PTR(-ENODEV);
  573. }
  574. static void sysc_check_quirk_stdout(struct sysc *ddata,
  575. struct device_node *np)
  576. {
  577. sysc_init_stdout_path(ddata);
  578. if (np != stdout_path)
  579. return;
  580. ddata->cfg.quirks |= SYSC_QUIRK_NO_IDLE_ON_INIT |
  581. SYSC_QUIRK_NO_RESET_ON_INIT;
  582. }
  583. /**
  584. * sysc_check_one_child - check child configuration
  585. * @ddata: device driver data
  586. * @np: child device node
  587. *
  588. * Let's avoid messy situations where we have new interconnect target
  589. * node but children have "ti,hwmods". These belong to the interconnect
  590. * target node and are managed by this driver.
  591. */
  592. static void sysc_check_one_child(struct sysc *ddata,
  593. struct device_node *np)
  594. {
  595. const char *name;
  596. name = of_get_property(np, "ti,hwmods", NULL);
  597. if (name && !of_device_is_compatible(np, "ti,sysc"))
  598. dev_warn(ddata->dev, "really a child ti,hwmods property?");
  599. sysc_check_quirk_stdout(ddata, np);
  600. sysc_parse_dts_quirks(ddata, np, true);
  601. }
  602. static void sysc_check_children(struct sysc *ddata)
  603. {
  604. struct device_node *child;
  605. for_each_child_of_node(ddata->dev->of_node, child)
  606. sysc_check_one_child(ddata, child);
  607. }
  608. /*
  609. * So far only I2C uses 16-bit read access with clockactivity with revision
  610. * in two registers with stride of 4. We can detect this based on the rev
  611. * register size to configure things far enough to be able to properly read
  612. * the revision register.
  613. */
  614. static void sysc_check_quirk_16bit(struct sysc *ddata, struct resource *res)
  615. {
  616. if (resource_size(res) == 8)
  617. ddata->cfg.quirks |= SYSC_QUIRK_16BIT | SYSC_QUIRK_USE_CLOCKACT;
  618. }
  619. /**
  620. * sysc_parse_one - parses the interconnect target module registers
  621. * @ddata: device driver data
  622. * @reg: register to parse
  623. */
  624. static int sysc_parse_one(struct sysc *ddata, enum sysc_registers reg)
  625. {
  626. struct resource *res;
  627. const char *name;
  628. switch (reg) {
  629. case SYSC_REVISION:
  630. case SYSC_SYSCONFIG:
  631. case SYSC_SYSSTATUS:
  632. name = reg_names[reg];
  633. break;
  634. default:
  635. return -EINVAL;
  636. }
  637. res = platform_get_resource_byname(to_platform_device(ddata->dev),
  638. IORESOURCE_MEM, name);
  639. if (!res) {
  640. ddata->offsets[reg] = -ENODEV;
  641. return 0;
  642. }
  643. ddata->offsets[reg] = res->start - ddata->module_pa;
  644. if (reg == SYSC_REVISION)
  645. sysc_check_quirk_16bit(ddata, res);
  646. return 0;
  647. }
  648. static int sysc_parse_registers(struct sysc *ddata)
  649. {
  650. int i, error;
  651. for (i = 0; i < SYSC_MAX_REGS; i++) {
  652. error = sysc_parse_one(ddata, i);
  653. if (error)
  654. return error;
  655. }
  656. return 0;
  657. }
  658. /**
  659. * sysc_check_registers - check for misconfigured register overlaps
  660. * @ddata: device driver data
  661. */
  662. static int sysc_check_registers(struct sysc *ddata)
  663. {
  664. int i, j, nr_regs = 0, nr_matches = 0;
  665. for (i = 0; i < SYSC_MAX_REGS; i++) {
  666. if (ddata->offsets[i] < 0)
  667. continue;
  668. if (ddata->offsets[i] > (ddata->module_size - 4)) {
  669. dev_err(ddata->dev, "register outside module range");
  670. return -EINVAL;
  671. }
  672. for (j = 0; j < SYSC_MAX_REGS; j++) {
  673. if (ddata->offsets[j] < 0)
  674. continue;
  675. if (ddata->offsets[i] == ddata->offsets[j])
  676. nr_matches++;
  677. }
  678. nr_regs++;
  679. }
  680. if (nr_matches > nr_regs) {
  681. dev_err(ddata->dev, "overlapping registers: (%i/%i)",
  682. nr_regs, nr_matches);
  683. return -EINVAL;
  684. }
  685. return 0;
  686. }
  687. /**
  688. * sysc_ioremap - ioremap register space for the interconnect target module
  689. * @ddata: device driver data
  690. *
  691. * Note that the interconnect target module registers can be anywhere
  692. * within the interconnect target module range. For example, SGX has
  693. * them at offset 0x1fc00 in the 32MB module address space. And cpsw
  694. * has them at offset 0x1200 in the CPSW_WR child. Usually the
  695. * interconnect target module registers are at the beginning of
  696. * the module range though.
  697. */
  698. static int sysc_ioremap(struct sysc *ddata)
  699. {
  700. int size;
  701. if (ddata->offsets[SYSC_REVISION] < 0 &&
  702. ddata->offsets[SYSC_SYSCONFIG] < 0 &&
  703. ddata->offsets[SYSC_SYSSTATUS] < 0) {
  704. size = ddata->module_size;
  705. } else {
  706. size = max3(ddata->offsets[SYSC_REVISION],
  707. ddata->offsets[SYSC_SYSCONFIG],
  708. ddata->offsets[SYSC_SYSSTATUS]);
  709. if (size < SZ_1K)
  710. size = SZ_1K;
  711. if ((size + sizeof(u32)) > ddata->module_size)
  712. size = ddata->module_size;
  713. }
  714. ddata->module_va = devm_ioremap(ddata->dev,
  715. ddata->module_pa,
  716. size + sizeof(u32));
  717. if (!ddata->module_va)
  718. return -EIO;
  719. return 0;
  720. }
  721. /**
  722. * sysc_map_and_check_registers - ioremap and check device registers
  723. * @ddata: device driver data
  724. */
  725. static int sysc_map_and_check_registers(struct sysc *ddata)
  726. {
  727. struct device_node *np = ddata->dev->of_node;
  728. int error;
  729. error = sysc_parse_and_check_child_range(ddata);
  730. if (error)
  731. return error;
  732. sysc_check_children(ddata);
  733. if (!of_property_present(np, "reg"))
  734. return 0;
  735. error = sysc_parse_registers(ddata);
  736. if (error)
  737. return error;
  738. error = sysc_ioremap(ddata);
  739. if (error)
  740. return error;
  741. error = sysc_check_registers(ddata);
  742. if (error)
  743. return error;
  744. return 0;
  745. }
  746. /**
  747. * sysc_show_rev - read and show interconnect target module revision
  748. * @bufp: buffer to print the information to
  749. * @ddata: device driver data
  750. */
  751. static int sysc_show_rev(char *bufp, struct sysc *ddata)
  752. {
  753. int len;
  754. if (ddata->offsets[SYSC_REVISION] < 0)
  755. return sprintf(bufp, ":NA");
  756. len = sprintf(bufp, ":%08x", ddata->revision);
  757. return len;
  758. }
  759. static int sysc_show_reg(struct sysc *ddata,
  760. char *bufp, enum sysc_registers reg)
  761. {
  762. if (ddata->offsets[reg] < 0)
  763. return sprintf(bufp, ":NA");
  764. return sprintf(bufp, ":%x", ddata->offsets[reg]);
  765. }
  766. static int sysc_show_name(char *bufp, struct sysc *ddata)
  767. {
  768. if (!ddata->name)
  769. return 0;
  770. return sprintf(bufp, ":%s", ddata->name);
  771. }
  772. /**
  773. * sysc_show_registers - show information about interconnect target module
  774. * @ddata: device driver data
  775. */
  776. static void sysc_show_registers(struct sysc *ddata)
  777. {
  778. char buf[128];
  779. char *bufp = buf;
  780. int i;
  781. for (i = 0; i < SYSC_MAX_REGS; i++)
  782. bufp += sysc_show_reg(ddata, bufp, i);
  783. bufp += sysc_show_rev(bufp, ddata);
  784. bufp += sysc_show_name(bufp, ddata);
  785. dev_dbg(ddata->dev, "%llx:%x%s\n",
  786. ddata->module_pa, ddata->module_size,
  787. buf);
  788. }
  789. /**
  790. * sysc_write_sysconfig - handle sysconfig quirks for register write
  791. * @ddata: device driver data
  792. * @value: register value
  793. */
  794. static void sysc_write_sysconfig(struct sysc *ddata, u32 value)
  795. {
  796. if (ddata->module_unlock_quirk)
  797. ddata->module_unlock_quirk(ddata);
  798. sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], value);
  799. if (ddata->module_lock_quirk)
  800. ddata->module_lock_quirk(ddata);
  801. }
  802. #define SYSC_IDLE_MASK (SYSC_NR_IDLEMODES - 1)
  803. #define SYSC_CLOCACT_ICK 2
  804. /* Caller needs to manage sysc_clkdm_deny_idle() and sysc_clkdm_allow_idle() */
  805. static int sysc_enable_module(struct device *dev)
  806. {
  807. struct sysc *ddata;
  808. const struct sysc_regbits *regbits;
  809. u32 reg, idlemodes, best_mode;
  810. int error;
  811. ddata = dev_get_drvdata(dev);
  812. /*
  813. * Some modules like DSS reset automatically on idle. Enable optional
  814. * reset clocks and wait for OCP softreset to complete.
  815. */
  816. if (ddata->cfg.quirks & SYSC_QUIRK_OPT_CLKS_IN_RESET) {
  817. error = sysc_enable_opt_clocks(ddata);
  818. if (error) {
  819. dev_err(ddata->dev,
  820. "Optional clocks failed for enable: %i\n",
  821. error);
  822. return error;
  823. }
  824. }
  825. /*
  826. * Some modules like i2c and hdq1w have unusable reset status unless
  827. * the module reset quirk is enabled. Skip status check on enable.
  828. */
  829. if (!(ddata->cfg.quirks & SYSC_MODULE_QUIRK_ENA_RESETDONE)) {
  830. error = sysc_wait_softreset(ddata);
  831. if (error)
  832. dev_warn(ddata->dev, "OCP softreset timed out\n");
  833. }
  834. if (ddata->cfg.quirks & SYSC_QUIRK_OPT_CLKS_IN_RESET)
  835. sysc_disable_opt_clocks(ddata);
  836. /*
  837. * Some subsystem private interconnects, like DSS top level module,
  838. * need only the automatic OCP softreset handling with no sysconfig
  839. * register bits to configure.
  840. */
  841. if (ddata->offsets[SYSC_SYSCONFIG] == -ENODEV)
  842. return 0;
  843. regbits = ddata->cap->regbits;
  844. reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  845. /*
  846. * Set CLOCKACTIVITY, we only use it for ick. And we only configure it
  847. * based on the SYSC_QUIRK_USE_CLOCKACT flag, not based on the hardware
  848. * capabilities. See the old HWMOD_SET_DEFAULT_CLOCKACT flag.
  849. */
  850. if (regbits->clkact_shift >= 0 &&
  851. (ddata->cfg.quirks & SYSC_QUIRK_USE_CLOCKACT))
  852. reg |= SYSC_CLOCACT_ICK << regbits->clkact_shift;
  853. /* Set SIDLE mode */
  854. idlemodes = ddata->cfg.sidlemodes;
  855. if (!idlemodes || regbits->sidle_shift < 0)
  856. goto set_midle;
  857. if (ddata->cfg.quirks & (SYSC_QUIRK_SWSUP_SIDLE |
  858. SYSC_QUIRK_SWSUP_SIDLE_ACT)) {
  859. best_mode = SYSC_IDLE_NO;
  860. /* Clear WAKEUP */
  861. if (regbits->enwkup_shift >= 0 &&
  862. ddata->cfg.sysc_val & BIT(regbits->enwkup_shift))
  863. reg &= ~BIT(regbits->enwkup_shift);
  864. } else {
  865. best_mode = fls(ddata->cfg.sidlemodes) - 1;
  866. if (best_mode > SYSC_IDLE_MASK) {
  867. dev_err(dev, "%s: invalid sidlemode\n", __func__);
  868. return -EINVAL;
  869. }
  870. /* Set WAKEUP */
  871. if (regbits->enwkup_shift >= 0 &&
  872. ddata->cfg.sysc_val & BIT(regbits->enwkup_shift))
  873. reg |= BIT(regbits->enwkup_shift);
  874. }
  875. reg &= ~(SYSC_IDLE_MASK << regbits->sidle_shift);
  876. reg |= best_mode << regbits->sidle_shift;
  877. sysc_write_sysconfig(ddata, reg);
  878. set_midle:
  879. /* Set MIDLE mode */
  880. idlemodes = ddata->cfg.midlemodes;
  881. if (!idlemodes || regbits->midle_shift < 0)
  882. goto set_autoidle;
  883. best_mode = fls(ddata->cfg.midlemodes) - 1;
  884. if (best_mode > SYSC_IDLE_MASK) {
  885. dev_err(dev, "%s: invalid midlemode\n", __func__);
  886. error = -EINVAL;
  887. goto save_context;
  888. }
  889. if (ddata->cfg.quirks & SYSC_QUIRK_SWSUP_MSTANDBY)
  890. best_mode = SYSC_IDLE_NO;
  891. reg &= ~(SYSC_IDLE_MASK << regbits->midle_shift);
  892. reg |= best_mode << regbits->midle_shift;
  893. sysc_write_sysconfig(ddata, reg);
  894. set_autoidle:
  895. /* Autoidle bit must enabled separately if available */
  896. if (regbits->autoidle_shift >= 0 &&
  897. ddata->cfg.sysc_val & BIT(regbits->autoidle_shift)) {
  898. reg |= 1 << regbits->autoidle_shift;
  899. sysc_write_sysconfig(ddata, reg);
  900. }
  901. error = 0;
  902. save_context:
  903. /* Save context and flush posted write */
  904. ddata->sysconfig = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  905. if (ddata->module_enable_quirk)
  906. ddata->module_enable_quirk(ddata);
  907. return error;
  908. }
  909. static int sysc_best_idle_mode(u32 idlemodes, u32 *best_mode)
  910. {
  911. if (idlemodes & BIT(SYSC_IDLE_SMART_WKUP))
  912. *best_mode = SYSC_IDLE_SMART_WKUP;
  913. else if (idlemodes & BIT(SYSC_IDLE_SMART))
  914. *best_mode = SYSC_IDLE_SMART;
  915. else if (idlemodes & BIT(SYSC_IDLE_FORCE))
  916. *best_mode = SYSC_IDLE_FORCE;
  917. else
  918. return -EINVAL;
  919. return 0;
  920. }
  921. /* Caller needs to manage sysc_clkdm_deny_idle() and sysc_clkdm_allow_idle() */
  922. static int sysc_disable_module(struct device *dev)
  923. {
  924. struct sysc *ddata;
  925. const struct sysc_regbits *regbits;
  926. u32 reg, idlemodes, best_mode;
  927. int ret;
  928. ddata = dev_get_drvdata(dev);
  929. if (ddata->offsets[SYSC_SYSCONFIG] == -ENODEV)
  930. return 0;
  931. if (ddata->module_disable_quirk)
  932. ddata->module_disable_quirk(ddata);
  933. regbits = ddata->cap->regbits;
  934. reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  935. /* Set MIDLE mode */
  936. idlemodes = ddata->cfg.midlemodes;
  937. if (!idlemodes || regbits->midle_shift < 0)
  938. goto set_sidle;
  939. ret = sysc_best_idle_mode(idlemodes, &best_mode);
  940. if (ret) {
  941. dev_err(dev, "%s: invalid midlemode\n", __func__);
  942. return ret;
  943. }
  944. if (ddata->cfg.quirks & (SYSC_QUIRK_SWSUP_MSTANDBY) ||
  945. ddata->cfg.quirks & (SYSC_QUIRK_FORCE_MSTANDBY))
  946. best_mode = SYSC_IDLE_FORCE;
  947. reg &= ~(SYSC_IDLE_MASK << regbits->midle_shift);
  948. reg |= best_mode << regbits->midle_shift;
  949. sysc_write_sysconfig(ddata, reg);
  950. set_sidle:
  951. /* Set SIDLE mode */
  952. idlemodes = ddata->cfg.sidlemodes;
  953. if (!idlemodes || regbits->sidle_shift < 0) {
  954. ret = 0;
  955. goto save_context;
  956. }
  957. if (ddata->cfg.quirks & SYSC_QUIRK_SWSUP_SIDLE) {
  958. best_mode = SYSC_IDLE_FORCE;
  959. } else {
  960. ret = sysc_best_idle_mode(idlemodes, &best_mode);
  961. if (ret) {
  962. dev_err(dev, "%s: invalid sidlemode\n", __func__);
  963. ret = -EINVAL;
  964. goto save_context;
  965. }
  966. }
  967. if (ddata->cfg.quirks & SYSC_QUIRK_SWSUP_SIDLE_ACT) {
  968. /* Set WAKEUP */
  969. if (regbits->enwkup_shift >= 0 &&
  970. ddata->cfg.sysc_val & BIT(regbits->enwkup_shift))
  971. reg |= BIT(regbits->enwkup_shift);
  972. }
  973. reg &= ~(SYSC_IDLE_MASK << regbits->sidle_shift);
  974. reg |= best_mode << regbits->sidle_shift;
  975. if (regbits->autoidle_shift >= 0 &&
  976. ddata->cfg.sysc_val & BIT(regbits->autoidle_shift))
  977. reg |= 1 << regbits->autoidle_shift;
  978. sysc_write_sysconfig(ddata, reg);
  979. ret = 0;
  980. save_context:
  981. /* Save context and flush posted write */
  982. ddata->sysconfig = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  983. return ret;
  984. }
  985. static int __maybe_unused sysc_runtime_suspend_legacy(struct device *dev,
  986. struct sysc *ddata)
  987. {
  988. struct ti_sysc_platform_data *pdata;
  989. int error;
  990. pdata = dev_get_platdata(ddata->dev);
  991. if (!pdata)
  992. return 0;
  993. if (!pdata->idle_module)
  994. return -ENODEV;
  995. error = pdata->idle_module(dev, &ddata->cookie);
  996. if (error)
  997. dev_err(dev, "%s: could not idle: %i\n",
  998. __func__, error);
  999. reset_control_assert(ddata->rsts);
  1000. return 0;
  1001. }
  1002. static int __maybe_unused sysc_runtime_resume_legacy(struct device *dev,
  1003. struct sysc *ddata)
  1004. {
  1005. struct ti_sysc_platform_data *pdata;
  1006. int error;
  1007. pdata = dev_get_platdata(ddata->dev);
  1008. if (!pdata)
  1009. return 0;
  1010. if (!pdata->enable_module)
  1011. return -ENODEV;
  1012. error = pdata->enable_module(dev, &ddata->cookie);
  1013. if (error)
  1014. dev_err(dev, "%s: could not enable: %i\n",
  1015. __func__, error);
  1016. reset_control_deassert(ddata->rsts);
  1017. return 0;
  1018. }
  1019. static int __maybe_unused sysc_runtime_suspend(struct device *dev)
  1020. {
  1021. struct sysc *ddata;
  1022. int error = 0;
  1023. ddata = dev_get_drvdata(dev);
  1024. if (!ddata->enabled)
  1025. return 0;
  1026. sysc_clkdm_deny_idle(ddata);
  1027. if (ddata->legacy_mode) {
  1028. error = sysc_runtime_suspend_legacy(dev, ddata);
  1029. if (error)
  1030. goto err_allow_idle;
  1031. } else {
  1032. error = sysc_disable_module(dev);
  1033. if (error)
  1034. goto err_allow_idle;
  1035. }
  1036. sysc_disable_main_clocks(ddata);
  1037. if (sysc_opt_clks_needed(ddata))
  1038. sysc_disable_opt_clocks(ddata);
  1039. ddata->enabled = false;
  1040. err_allow_idle:
  1041. sysc_clkdm_allow_idle(ddata);
  1042. reset_control_assert(ddata->rsts);
  1043. return error;
  1044. }
  1045. static int __maybe_unused sysc_runtime_resume(struct device *dev)
  1046. {
  1047. struct sysc *ddata;
  1048. int error = 0;
  1049. ddata = dev_get_drvdata(dev);
  1050. if (ddata->enabled)
  1051. return 0;
  1052. sysc_clkdm_deny_idle(ddata);
  1053. if (sysc_opt_clks_needed(ddata)) {
  1054. error = sysc_enable_opt_clocks(ddata);
  1055. if (error)
  1056. goto err_allow_idle;
  1057. }
  1058. error = sysc_enable_main_clocks(ddata);
  1059. if (error)
  1060. goto err_opt_clocks;
  1061. reset_control_deassert(ddata->rsts);
  1062. if (ddata->legacy_mode) {
  1063. error = sysc_runtime_resume_legacy(dev, ddata);
  1064. if (error)
  1065. goto err_main_clocks;
  1066. } else {
  1067. error = sysc_enable_module(dev);
  1068. if (error)
  1069. goto err_main_clocks;
  1070. }
  1071. ddata->enabled = true;
  1072. sysc_clkdm_allow_idle(ddata);
  1073. return 0;
  1074. err_main_clocks:
  1075. sysc_disable_main_clocks(ddata);
  1076. err_opt_clocks:
  1077. if (sysc_opt_clks_needed(ddata))
  1078. sysc_disable_opt_clocks(ddata);
  1079. err_allow_idle:
  1080. sysc_clkdm_allow_idle(ddata);
  1081. return error;
  1082. }
  1083. /*
  1084. * Checks if device context was lost. Assumes the sysconfig register value
  1085. * after lost context is different from the configured value. Only works for
  1086. * enabled devices.
  1087. *
  1088. * Eventually we may want to also add support to using the context lost
  1089. * registers that some SoCs have.
  1090. */
  1091. static int sysc_check_context(struct sysc *ddata)
  1092. {
  1093. u32 reg;
  1094. if (!ddata->enabled)
  1095. return -ENODATA;
  1096. reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  1097. if (reg == ddata->sysconfig)
  1098. return 0;
  1099. return -EACCES;
  1100. }
  1101. static int sysc_reinit_module(struct sysc *ddata, bool leave_enabled)
  1102. {
  1103. struct device *dev = ddata->dev;
  1104. int error;
  1105. if (ddata->enabled) {
  1106. /* Nothing to do if enabled and context not lost */
  1107. error = sysc_check_context(ddata);
  1108. if (!error)
  1109. return 0;
  1110. /* Disable target module if it is enabled */
  1111. error = sysc_runtime_suspend(dev);
  1112. if (error)
  1113. dev_warn(dev, "reinit suspend failed: %i\n", error);
  1114. }
  1115. /* Enable target module */
  1116. error = sysc_runtime_resume(dev);
  1117. if (error)
  1118. dev_warn(dev, "reinit resume failed: %i\n", error);
  1119. /* Some modules like am335x gpmc need reset and restore of sysconfig */
  1120. if (ddata->cfg.quirks & SYSC_QUIRK_RESET_ON_CTX_LOST) {
  1121. error = sysc_reset(ddata);
  1122. if (error)
  1123. dev_warn(dev, "reinit reset failed: %i\n", error);
  1124. sysc_write_sysconfig(ddata, ddata->sysconfig);
  1125. }
  1126. if (leave_enabled)
  1127. return error;
  1128. /* Disable target module if no leave_enabled was set */
  1129. error = sysc_runtime_suspend(dev);
  1130. if (error)
  1131. dev_warn(dev, "reinit suspend failed: %i\n", error);
  1132. return error;
  1133. }
  1134. static int __maybe_unused sysc_noirq_suspend(struct device *dev)
  1135. {
  1136. struct sysc *ddata;
  1137. ddata = dev_get_drvdata(dev);
  1138. if (ddata->cfg.quirks & SYSC_QUIRK_NO_IDLE)
  1139. return 0;
  1140. if (!ddata->enabled)
  1141. return 0;
  1142. ddata->needs_resume = 1;
  1143. return sysc_runtime_suspend(dev);
  1144. }
  1145. static int __maybe_unused sysc_noirq_resume(struct device *dev)
  1146. {
  1147. struct sysc *ddata;
  1148. int error = 0;
  1149. ddata = dev_get_drvdata(dev);
  1150. if (ddata->cfg.quirks & SYSC_QUIRK_NO_IDLE)
  1151. return 0;
  1152. if (ddata->cfg.quirks & SYSC_QUIRK_REINIT_ON_RESUME) {
  1153. error = sysc_reinit_module(ddata, ddata->needs_resume);
  1154. if (error)
  1155. dev_warn(dev, "noirq_resume failed: %i\n", error);
  1156. } else if (ddata->needs_resume) {
  1157. error = sysc_runtime_resume(dev);
  1158. if (error)
  1159. dev_warn(dev, "noirq_resume failed: %i\n", error);
  1160. }
  1161. ddata->needs_resume = 0;
  1162. return error;
  1163. }
  1164. static const struct dev_pm_ops sysc_pm_ops = {
  1165. SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(sysc_noirq_suspend, sysc_noirq_resume)
  1166. SET_RUNTIME_PM_OPS(sysc_runtime_suspend,
  1167. sysc_runtime_resume,
  1168. NULL)
  1169. };
  1170. /* Module revision register based quirks */
  1171. struct sysc_revision_quirk {
  1172. const char *name;
  1173. u32 base;
  1174. int rev_offset;
  1175. int sysc_offset;
  1176. int syss_offset;
  1177. u32 revision;
  1178. u32 revision_mask;
  1179. u32 quirks;
  1180. };
  1181. #define SYSC_QUIRK(optname, optbase, optrev, optsysc, optsyss, \
  1182. optrev_val, optrevmask, optquirkmask) \
  1183. { \
  1184. .name = (optname), \
  1185. .base = (optbase), \
  1186. .rev_offset = (optrev), \
  1187. .sysc_offset = (optsysc), \
  1188. .syss_offset = (optsyss), \
  1189. .revision = (optrev_val), \
  1190. .revision_mask = (optrevmask), \
  1191. .quirks = (optquirkmask), \
  1192. }
  1193. static const struct sysc_revision_quirk sysc_revision_quirks[] = {
  1194. /* Quirks that need to be set based on the module address */
  1195. SYSC_QUIRK("mcpdm", 0x40132000, 0, 0x10, -ENODEV, 0x50000800, 0xffffffff,
  1196. SYSC_QUIRK_EXT_OPT_CLOCK | SYSC_QUIRK_NO_RESET_ON_INIT |
  1197. SYSC_QUIRK_SWSUP_SIDLE),
  1198. /* Quirks that need to be set based on detected module */
  1199. SYSC_QUIRK("aess", 0, 0, 0x10, -ENODEV, 0x40000000, 0xffffffff,
  1200. SYSC_MODULE_QUIRK_AESS),
  1201. /* Errata i893 handling for dra7 dcan1 and 2 */
  1202. SYSC_QUIRK("dcan", 0x4ae3c000, 0x20, -ENODEV, -ENODEV, 0xa3170504, 0xffffffff,
  1203. SYSC_QUIRK_CLKDM_NOAUTO),
  1204. SYSC_QUIRK("dcan", 0x48480000, 0x20, -ENODEV, -ENODEV, 0xa3170504, 0xffffffff,
  1205. SYSC_QUIRK_CLKDM_NOAUTO),
  1206. SYSC_QUIRK("dss", 0x4832a000, 0, 0x10, 0x14, 0x00000020, 0xffffffff,
  1207. SYSC_QUIRK_OPT_CLKS_IN_RESET | SYSC_MODULE_QUIRK_DSS_RESET),
  1208. SYSC_QUIRK("dss", 0x58000000, 0, -ENODEV, 0x14, 0x00000040, 0xffffffff,
  1209. SYSC_QUIRK_OPT_CLKS_IN_RESET | SYSC_MODULE_QUIRK_DSS_RESET),
  1210. SYSC_QUIRK("dss", 0x58000000, 0, -ENODEV, 0x14, 0x00000061, 0xffffffff,
  1211. SYSC_QUIRK_OPT_CLKS_IN_RESET | SYSC_MODULE_QUIRK_DSS_RESET),
  1212. SYSC_QUIRK("dwc3", 0x48880000, 0, 0x10, -ENODEV, 0x500a0200, 0xffffffff,
  1213. SYSC_QUIRK_CLKDM_NOAUTO),
  1214. SYSC_QUIRK("dwc3", 0x488c0000, 0, 0x10, -ENODEV, 0x500a0200, 0xffffffff,
  1215. SYSC_QUIRK_CLKDM_NOAUTO),
  1216. SYSC_QUIRK("gpio", 0, 0, 0x10, 0x114, 0x50600801, 0xffff00ff,
  1217. SYSC_QUIRK_OPT_CLKS_IN_RESET),
  1218. SYSC_QUIRK("gpmc", 0, 0, 0x10, 0x14, 0x00000060, 0xffffffff,
  1219. SYSC_QUIRK_REINIT_ON_CTX_LOST | SYSC_QUIRK_RESET_ON_CTX_LOST |
  1220. SYSC_QUIRK_GPMC_DEBUG),
  1221. SYSC_QUIRK("hdmi", 0, 0, 0x10, -ENODEV, 0x50030200, 0xffffffff,
  1222. SYSC_QUIRK_OPT_CLKS_NEEDED),
  1223. SYSC_QUIRK("hdq1w", 0, 0, 0x14, 0x18, 0x00000006, 0xffffffff,
  1224. SYSC_MODULE_QUIRK_HDQ1W | SYSC_MODULE_QUIRK_ENA_RESETDONE),
  1225. SYSC_QUIRK("hdq1w", 0, 0, 0x14, 0x18, 0x0000000a, 0xffffffff,
  1226. SYSC_MODULE_QUIRK_HDQ1W | SYSC_MODULE_QUIRK_ENA_RESETDONE),
  1227. SYSC_QUIRK("i2c", 0, 0, 0x20, 0x10, 0x00000036, 0x000000ff,
  1228. SYSC_MODULE_QUIRK_I2C | SYSC_MODULE_QUIRK_ENA_RESETDONE),
  1229. SYSC_QUIRK("i2c", 0, 0, 0x20, 0x10, 0x0000003c, 0x000000ff,
  1230. SYSC_MODULE_QUIRK_I2C | SYSC_MODULE_QUIRK_ENA_RESETDONE),
  1231. SYSC_QUIRK("i2c", 0, 0, 0x20, 0x10, 0x00000040, 0x000000ff,
  1232. SYSC_MODULE_QUIRK_I2C | SYSC_MODULE_QUIRK_ENA_RESETDONE),
  1233. SYSC_QUIRK("i2c", 0, 0, 0x10, 0x90, 0x5040000a, 0xfffff0f0,
  1234. SYSC_MODULE_QUIRK_I2C | SYSC_MODULE_QUIRK_ENA_RESETDONE),
  1235. SYSC_QUIRK("gpu", 0x50000000, 0x14, -ENODEV, -ENODEV, 0x00010201, 0xffffffff, 0),
  1236. SYSC_QUIRK("gpu", 0x50000000, 0xfe00, 0xfe10, -ENODEV, 0x40000000 , 0xffffffff,
  1237. SYSC_MODULE_QUIRK_SGX),
  1238. SYSC_QUIRK("lcdc", 0, 0, 0x54, -ENODEV, 0x4f201000, 0xffffffff,
  1239. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY),
  1240. SYSC_QUIRK("mcasp", 0, 0, 0x4, -ENODEV, 0x44306302, 0xffffffff,
  1241. SYSC_QUIRK_SWSUP_SIDLE),
  1242. SYSC_QUIRK("rtc", 0, 0x74, 0x78, -ENODEV, 0x4eb01908, 0xffff00f0,
  1243. SYSC_MODULE_QUIRK_RTC_UNLOCK),
  1244. SYSC_QUIRK("tptc", 0, 0, 0x10, -ENODEV, 0x40006c00, 0xffffefff,
  1245. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY),
  1246. SYSC_QUIRK("tptc", 0, 0, -ENODEV, -ENODEV, 0x40007c00, 0xffffffff,
  1247. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY),
  1248. SYSC_QUIRK("sata", 0, 0xfc, 0x1100, -ENODEV, 0x5e412000, 0xffffffff,
  1249. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY),
  1250. SYSC_QUIRK("uart", 0, 0x50, 0x54, 0x58, 0x00000046, 0xffffffff,
  1251. SYSC_QUIRK_SWSUP_SIDLE_ACT),
  1252. SYSC_QUIRK("uart", 0, 0x50, 0x54, 0x58, 0x00000052, 0xffffffff,
  1253. SYSC_QUIRK_SWSUP_SIDLE_ACT),
  1254. /* Uarts on omap4 and later */
  1255. SYSC_QUIRK("uart", 0, 0x50, 0x54, 0x58, 0x50411e03, 0xffff00ff,
  1256. SYSC_QUIRK_SWSUP_SIDLE_ACT),
  1257. SYSC_QUIRK("uart", 0, 0x50, 0x54, 0x58, 0x47422e03, 0xffffffff,
  1258. SYSC_QUIRK_SWSUP_SIDLE_ACT),
  1259. SYSC_QUIRK("uart", 0, 0x50, 0x54, 0x58, 0x47424e03, 0xffffffff,
  1260. SYSC_QUIRK_SWSUP_SIDLE_ACT),
  1261. SYSC_QUIRK("usb_host_hs", 0, 0, 0x10, 0x14, 0x50700100, 0xffffffff,
  1262. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY),
  1263. SYSC_QUIRK("usb_host_hs", 0, 0, 0x10, -ENODEV, 0x50700101, 0xffffffff,
  1264. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY),
  1265. SYSC_QUIRK("usb_otg_hs", 0, 0x400, 0x404, 0x408, 0x00000033,
  1266. 0xffffffff, SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY |
  1267. SYSC_MODULE_QUIRK_OTG),
  1268. SYSC_QUIRK("usb_otg_hs", 0, 0x400, 0x404, 0x408, 0x00000040,
  1269. 0xffffffff, SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY |
  1270. SYSC_MODULE_QUIRK_OTG),
  1271. SYSC_QUIRK("usb_otg_hs", 0, 0x400, 0x404, 0x408, 0x00000050,
  1272. 0xffffffff, SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY |
  1273. SYSC_MODULE_QUIRK_OTG),
  1274. SYSC_QUIRK("usb_otg_hs", 0, 0, 0x10, -ENODEV, 0x4ea2080d, 0xffffffff,
  1275. SYSC_QUIRK_SWSUP_SIDLE | SYSC_QUIRK_SWSUP_MSTANDBY |
  1276. SYSC_QUIRK_REINIT_ON_CTX_LOST),
  1277. SYSC_QUIRK("wdt", 0, 0, 0x10, 0x14, 0x502a0500, 0xfffff0f0,
  1278. SYSC_MODULE_QUIRK_WDT),
  1279. /* PRUSS on am3, am4 and am5 */
  1280. SYSC_QUIRK("pruss", 0, 0x26000, 0x26004, -ENODEV, 0x47000000, 0xff000000,
  1281. SYSC_MODULE_QUIRK_PRUSS),
  1282. /* Watchdog on am3 and am4 */
  1283. SYSC_QUIRK("wdt", 0x44e35000, 0, 0x10, 0x14, 0x502a0500, 0xfffff0f0,
  1284. SYSC_MODULE_QUIRK_WDT | SYSC_QUIRK_SWSUP_SIDLE),
  1285. #ifdef DEBUG
  1286. SYSC_QUIRK("adc", 0, 0, 0x10, -ENODEV, 0x47300001, 0xffffffff, 0),
  1287. SYSC_QUIRK("atl", 0, 0, -ENODEV, -ENODEV, 0x0a070100, 0xffffffff, 0),
  1288. SYSC_QUIRK("cm", 0, 0, -ENODEV, -ENODEV, 0x40000301, 0xffffffff, 0),
  1289. SYSC_QUIRK("control", 0, 0, 0x10, -ENODEV, 0x40000900, 0xffffffff, 0),
  1290. SYSC_QUIRK("cpgmac", 0, 0x1200, 0x1208, 0x1204, 0x4edb1902,
  1291. 0xffff00f0, 0),
  1292. SYSC_QUIRK("dcan", 0, 0x20, -ENODEV, -ENODEV, 0xa3170504, 0xffffffff, 0),
  1293. SYSC_QUIRK("dcan", 0, 0x20, -ENODEV, -ENODEV, 0x4edb1902, 0xffffffff, 0),
  1294. SYSC_QUIRK("dispc", 0x4832a400, 0, 0x10, 0x14, 0x00000030, 0xffffffff, 0),
  1295. SYSC_QUIRK("dispc", 0x58001000, 0, 0x10, 0x14, 0x00000040, 0xffffffff, 0),
  1296. SYSC_QUIRK("dispc", 0x58001000, 0, 0x10, 0x14, 0x00000051, 0xffffffff, 0),
  1297. SYSC_QUIRK("dmic", 0, 0, 0x10, -ENODEV, 0x50010000, 0xffffffff, 0),
  1298. SYSC_QUIRK("dsi", 0x58004000, 0, 0x10, 0x14, 0x00000030, 0xffffffff, 0),
  1299. SYSC_QUIRK("dsi", 0x58005000, 0, 0x10, 0x14, 0x00000030, 0xffffffff, 0),
  1300. SYSC_QUIRK("dsi", 0x58005000, 0, 0x10, 0x14, 0x00000040, 0xffffffff, 0),
  1301. SYSC_QUIRK("dsi", 0x58009000, 0, 0x10, 0x14, 0x00000040, 0xffffffff, 0),
  1302. SYSC_QUIRK("dwc3", 0, 0, 0x10, -ENODEV, 0x500a0200, 0xffffffff, 0),
  1303. SYSC_QUIRK("d2d", 0x4a0b6000, 0, 0x10, 0x14, 0x00000010, 0xffffffff, 0),
  1304. SYSC_QUIRK("d2d", 0x4a0cd000, 0, 0x10, 0x14, 0x00000010, 0xffffffff, 0),
  1305. SYSC_QUIRK("elm", 0x48080000, 0, 0x10, 0x14, 0x00000020, 0xffffffff, 0),
  1306. SYSC_QUIRK("emif", 0, 0, -ENODEV, -ENODEV, 0x40441403, 0xffff0fff, 0),
  1307. SYSC_QUIRK("emif", 0, 0, -ENODEV, -ENODEV, 0x50440500, 0xffffffff, 0),
  1308. SYSC_QUIRK("epwmss", 0, 0, 0x4, -ENODEV, 0x47400001, 0xffffffff, 0),
  1309. SYSC_QUIRK("gpu", 0, 0x1fc00, 0x1fc10, -ENODEV, 0, 0, 0),
  1310. SYSC_QUIRK("gpu", 0, 0xfe00, 0xfe10, -ENODEV, 0x40000000 , 0xffffffff, 0),
  1311. SYSC_QUIRK("hdmi", 0, 0, 0x10, -ENODEV, 0x50031d00, 0xffffffff, 0),
  1312. SYSC_QUIRK("hsi", 0, 0, 0x10, 0x14, 0x50043101, 0xffffffff, 0),
  1313. SYSC_QUIRK("iss", 0, 0, 0x10, -ENODEV, 0x40000101, 0xffffffff, 0),
  1314. SYSC_QUIRK("keypad", 0x4a31c000, 0, 0x10, 0x14, 0x00000020, 0xffffffff, 0),
  1315. SYSC_QUIRK("mcasp", 0, 0, 0x4, -ENODEV, 0x44307b02, 0xffffffff, 0),
  1316. SYSC_QUIRK("mcbsp", 0, -ENODEV, 0x8c, -ENODEV, 0, 0, 0),
  1317. SYSC_QUIRK("mcspi", 0, 0, 0x10, -ENODEV, 0x40300a0b, 0xffff00ff, 0),
  1318. SYSC_QUIRK("mcspi", 0, 0, 0x110, 0x114, 0x40300a0b, 0xffffffff, 0),
  1319. SYSC_QUIRK("mailbox", 0, 0, 0x10, -ENODEV, 0x00000400, 0xffffffff, 0),
  1320. SYSC_QUIRK("m3", 0, 0, -ENODEV, -ENODEV, 0x5f580105, 0x0fff0f00, 0),
  1321. SYSC_QUIRK("ocp2scp", 0, 0, 0x10, 0x14, 0x50060005, 0xfffffff0, 0),
  1322. SYSC_QUIRK("ocp2scp", 0, 0, -ENODEV, -ENODEV, 0x50060007, 0xffffffff, 0),
  1323. SYSC_QUIRK("padconf", 0, 0, 0x10, -ENODEV, 0x4fff0800, 0xffffffff, 0),
  1324. SYSC_QUIRK("padconf", 0, 0, -ENODEV, -ENODEV, 0x40001100, 0xffffffff, 0),
  1325. SYSC_QUIRK("pcie", 0x51000000, -ENODEV, -ENODEV, -ENODEV, 0, 0, 0),
  1326. SYSC_QUIRK("pcie", 0x51800000, -ENODEV, -ENODEV, -ENODEV, 0, 0, 0),
  1327. SYSC_QUIRK("prcm", 0, 0, -ENODEV, -ENODEV, 0x40000100, 0xffffffff, 0),
  1328. SYSC_QUIRK("prcm", 0, 0, -ENODEV, -ENODEV, 0x00004102, 0xffffffff, 0),
  1329. SYSC_QUIRK("prcm", 0, 0, -ENODEV, -ENODEV, 0x40000400, 0xffffffff, 0),
  1330. SYSC_QUIRK("rfbi", 0x4832a800, 0, 0x10, 0x14, 0x00000010, 0xffffffff, 0),
  1331. SYSC_QUIRK("rfbi", 0x58002000, 0, 0x10, 0x14, 0x00000010, 0xffffffff, 0),
  1332. SYSC_QUIRK("scm", 0, 0, 0x10, -ENODEV, 0x40000900, 0xffffffff, 0),
  1333. SYSC_QUIRK("scm", 0, 0, -ENODEV, -ENODEV, 0x4e8b0100, 0xffffffff, 0),
  1334. SYSC_QUIRK("scm", 0, 0, -ENODEV, -ENODEV, 0x4f000100, 0xffffffff, 0),
  1335. SYSC_QUIRK("scm", 0, 0, -ENODEV, -ENODEV, 0x40000900, 0xffffffff, 0),
  1336. SYSC_QUIRK("scrm", 0, 0, -ENODEV, -ENODEV, 0x00000010, 0xffffffff, 0),
  1337. SYSC_QUIRK("sdio", 0, 0, 0x10, -ENODEV, 0x40202301, 0xffff0ff0, 0),
  1338. SYSC_QUIRK("sdio", 0, 0x2fc, 0x110, 0x114, 0x31010000, 0xffffffff, 0),
  1339. SYSC_QUIRK("sdma", 0, 0, 0x2c, 0x28, 0x00010900, 0xffffffff, 0),
  1340. SYSC_QUIRK("sham", 0, 0x100, 0x110, 0x114, 0x40000c03, 0xffffffff, 0),
  1341. SYSC_QUIRK("slimbus", 0, 0, 0x10, -ENODEV, 0x40000902, 0xffffffff, 0),
  1342. SYSC_QUIRK("slimbus", 0, 0, 0x10, -ENODEV, 0x40002903, 0xffffffff, 0),
  1343. SYSC_QUIRK("smartreflex", 0, -ENODEV, 0x24, -ENODEV, 0x00000000, 0xffffffff, 0),
  1344. SYSC_QUIRK("smartreflex", 0, -ENODEV, 0x38, -ENODEV, 0x00000000, 0xffffffff, 0),
  1345. SYSC_QUIRK("spinlock", 0, 0, 0x10, -ENODEV, 0x50020000, 0xffffffff, 0),
  1346. SYSC_QUIRK("rng", 0, 0x1fe0, 0x1fe4, -ENODEV, 0x00000020, 0xffffffff, 0),
  1347. SYSC_QUIRK("timer", 0, 0, 0x10, 0x14, 0x00000013, 0xffffffff, 0),
  1348. SYSC_QUIRK("timer", 0, 0, 0x10, 0x14, 0x00000015, 0xffffffff, 0),
  1349. /* Some timers on omap4 and later */
  1350. SYSC_QUIRK("timer", 0, 0, 0x10, -ENODEV, 0x50002100, 0xffffffff, 0),
  1351. SYSC_QUIRK("timer", 0, 0, 0x10, -ENODEV, 0x4fff1301, 0xffff00ff, 0),
  1352. SYSC_QUIRK("timer32k", 0, 0, 0x4, -ENODEV, 0x00000040, 0xffffffff, 0),
  1353. SYSC_QUIRK("timer32k", 0, 0, 0x4, -ENODEV, 0x00000011, 0xffffffff, 0),
  1354. SYSC_QUIRK("timer32k", 0, 0, 0x4, -ENODEV, 0x00000060, 0xffffffff, 0),
  1355. SYSC_QUIRK("tpcc", 0, 0, -ENODEV, -ENODEV, 0x40014c00, 0xffffffff, 0),
  1356. SYSC_QUIRK("usbhstll", 0, 0, 0x10, 0x14, 0x00000004, 0xffffffff, 0),
  1357. SYSC_QUIRK("usbhstll", 0, 0, 0x10, 0x14, 0x00000008, 0xffffffff, 0),
  1358. SYSC_QUIRK("venc", 0x58003000, 0, -ENODEV, -ENODEV, 0x00000002, 0xffffffff, 0),
  1359. SYSC_QUIRK("vfpe", 0, 0, 0x104, -ENODEV, 0x4d001200, 0xffffffff, 0),
  1360. #endif
  1361. };
  1362. /*
  1363. * Early quirks based on module base and register offsets only that are
  1364. * needed before the module revision can be read
  1365. */
  1366. static void sysc_init_early_quirks(struct sysc *ddata)
  1367. {
  1368. const struct sysc_revision_quirk *q;
  1369. int i;
  1370. for (i = 0; i < ARRAY_SIZE(sysc_revision_quirks); i++) {
  1371. q = &sysc_revision_quirks[i];
  1372. if (!q->base)
  1373. continue;
  1374. if (q->base != ddata->module_pa)
  1375. continue;
  1376. if (q->rev_offset != ddata->offsets[SYSC_REVISION])
  1377. continue;
  1378. if (q->sysc_offset != ddata->offsets[SYSC_SYSCONFIG])
  1379. continue;
  1380. if (q->syss_offset != ddata->offsets[SYSC_SYSSTATUS])
  1381. continue;
  1382. ddata->name = q->name;
  1383. ddata->cfg.quirks |= q->quirks;
  1384. }
  1385. }
  1386. /* Quirks that also consider the revision register value */
  1387. static void sysc_init_revision_quirks(struct sysc *ddata)
  1388. {
  1389. const struct sysc_revision_quirk *q;
  1390. int i;
  1391. for (i = 0; i < ARRAY_SIZE(sysc_revision_quirks); i++) {
  1392. q = &sysc_revision_quirks[i];
  1393. if (q->base && q->base != ddata->module_pa)
  1394. continue;
  1395. if (q->rev_offset != ddata->offsets[SYSC_REVISION])
  1396. continue;
  1397. if (q->sysc_offset != ddata->offsets[SYSC_SYSCONFIG])
  1398. continue;
  1399. if (q->syss_offset != ddata->offsets[SYSC_SYSSTATUS])
  1400. continue;
  1401. if (q->revision == ddata->revision ||
  1402. (q->revision & q->revision_mask) ==
  1403. (ddata->revision & q->revision_mask)) {
  1404. ddata->name = q->name;
  1405. ddata->cfg.quirks |= q->quirks;
  1406. }
  1407. }
  1408. }
  1409. /*
  1410. * DSS needs dispc outputs disabled to reset modules. Returns mask of
  1411. * enabled DSS interrupts. Eventually we may be able to do this on
  1412. * dispc init rather than top-level DSS init.
  1413. */
  1414. static u32 sysc_quirk_dispc(struct sysc *ddata, int dispc_offset,
  1415. bool disable)
  1416. {
  1417. bool lcd_en, digit_en, lcd2_en = false, lcd3_en = false;
  1418. const int lcd_en_mask = BIT(0), digit_en_mask = BIT(1);
  1419. int manager_count;
  1420. bool framedonetv_irq = true;
  1421. u32 val, irq_mask = 0;
  1422. switch (sysc_soc->soc) {
  1423. case SOC_2420 ... SOC_3630:
  1424. manager_count = 2;
  1425. framedonetv_irq = false;
  1426. break;
  1427. case SOC_4430 ... SOC_4470:
  1428. manager_count = 3;
  1429. break;
  1430. case SOC_5430:
  1431. case SOC_DRA7:
  1432. manager_count = 4;
  1433. break;
  1434. case SOC_AM4:
  1435. manager_count = 1;
  1436. framedonetv_irq = false;
  1437. break;
  1438. case SOC_UNKNOWN:
  1439. default:
  1440. return 0;
  1441. }
  1442. /* Remap the whole module range to be able to reset dispc outputs */
  1443. devm_iounmap(ddata->dev, ddata->module_va);
  1444. ddata->module_va = devm_ioremap(ddata->dev,
  1445. ddata->module_pa,
  1446. ddata->module_size);
  1447. if (!ddata->module_va)
  1448. return -EIO;
  1449. /* DISP_CONTROL, shut down lcd and digit on disable if enabled */
  1450. val = sysc_read(ddata, dispc_offset + 0x40);
  1451. lcd_en = val & lcd_en_mask;
  1452. digit_en = val & digit_en_mask;
  1453. if (lcd_en)
  1454. irq_mask |= BIT(0); /* FRAMEDONE */
  1455. if (digit_en) {
  1456. if (framedonetv_irq)
  1457. irq_mask |= BIT(24); /* FRAMEDONETV */
  1458. else
  1459. irq_mask |= BIT(2) | BIT(3); /* EVSYNC bits */
  1460. }
  1461. if (disable && (lcd_en || digit_en))
  1462. sysc_write(ddata, dispc_offset + 0x40,
  1463. val & ~(lcd_en_mask | digit_en_mask));
  1464. if (manager_count <= 2)
  1465. return irq_mask;
  1466. /* DISPC_CONTROL2 */
  1467. val = sysc_read(ddata, dispc_offset + 0x238);
  1468. lcd2_en = val & lcd_en_mask;
  1469. if (lcd2_en)
  1470. irq_mask |= BIT(22); /* FRAMEDONE2 */
  1471. if (disable && lcd2_en)
  1472. sysc_write(ddata, dispc_offset + 0x238,
  1473. val & ~lcd_en_mask);
  1474. if (manager_count <= 3)
  1475. return irq_mask;
  1476. /* DISPC_CONTROL3 */
  1477. val = sysc_read(ddata, dispc_offset + 0x848);
  1478. lcd3_en = val & lcd_en_mask;
  1479. if (lcd3_en)
  1480. irq_mask |= BIT(30); /* FRAMEDONE3 */
  1481. if (disable && lcd3_en)
  1482. sysc_write(ddata, dispc_offset + 0x848,
  1483. val & ~lcd_en_mask);
  1484. return irq_mask;
  1485. }
  1486. /* DSS needs child outputs disabled and SDI registers cleared for reset */
  1487. static void sysc_pre_reset_quirk_dss(struct sysc *ddata)
  1488. {
  1489. const int dispc_offset = 0x1000;
  1490. int error;
  1491. u32 irq_mask, val;
  1492. /* Get enabled outputs */
  1493. irq_mask = sysc_quirk_dispc(ddata, dispc_offset, false);
  1494. if (!irq_mask)
  1495. return;
  1496. /* Clear IRQSTATUS */
  1497. sysc_write(ddata, dispc_offset + 0x18, irq_mask);
  1498. /* Disable outputs */
  1499. val = sysc_quirk_dispc(ddata, dispc_offset, true);
  1500. /* Poll IRQSTATUS */
  1501. error = readl_poll_timeout(ddata->module_va + dispc_offset + 0x18,
  1502. val, val != irq_mask, 100, 50);
  1503. if (error)
  1504. dev_warn(ddata->dev, "%s: timed out %08x !+ %08x\n",
  1505. __func__, val, irq_mask);
  1506. if (sysc_soc->soc == SOC_3430 || sysc_soc->soc == SOC_AM35) {
  1507. /* Clear DSS_SDI_CONTROL */
  1508. sysc_write(ddata, 0x44, 0);
  1509. /* Clear DSS_PLL_CONTROL */
  1510. sysc_write(ddata, 0x48, 0);
  1511. }
  1512. /* Clear DSS_CONTROL to switch DSS clock sources to PRCM if not */
  1513. sysc_write(ddata, 0x40, 0);
  1514. }
  1515. /* 1-wire needs module's internal clocks enabled for reset */
  1516. static void sysc_pre_reset_quirk_hdq1w(struct sysc *ddata)
  1517. {
  1518. int offset = 0x0c; /* HDQ_CTRL_STATUS */
  1519. u16 val;
  1520. val = sysc_read(ddata, offset);
  1521. val |= BIT(5);
  1522. sysc_write(ddata, offset, val);
  1523. }
  1524. /* AESS (Audio Engine SubSystem) needs autogating set after enable */
  1525. static void sysc_module_enable_quirk_aess(struct sysc *ddata)
  1526. {
  1527. int offset = 0x7c; /* AESS_AUTO_GATING_ENABLE */
  1528. sysc_write(ddata, offset, 1);
  1529. }
  1530. /* I2C needs to be disabled for reset */
  1531. static void sysc_clk_quirk_i2c(struct sysc *ddata, bool enable)
  1532. {
  1533. int offset;
  1534. u16 val;
  1535. /* I2C_CON, omap2/3 is different from omap4 and later */
  1536. if ((ddata->revision & 0xffffff00) == 0x001f0000)
  1537. offset = 0x24;
  1538. else
  1539. offset = 0xa4;
  1540. /* I2C_EN */
  1541. val = sysc_read(ddata, offset);
  1542. if (enable)
  1543. val |= BIT(15);
  1544. else
  1545. val &= ~BIT(15);
  1546. sysc_write(ddata, offset, val);
  1547. }
  1548. static void sysc_pre_reset_quirk_i2c(struct sysc *ddata)
  1549. {
  1550. sysc_clk_quirk_i2c(ddata, false);
  1551. }
  1552. static void sysc_post_reset_quirk_i2c(struct sysc *ddata)
  1553. {
  1554. sysc_clk_quirk_i2c(ddata, true);
  1555. }
  1556. /* RTC on am3 and 4 needs to be unlocked and locked for sysconfig */
  1557. static void sysc_quirk_rtc(struct sysc *ddata, bool lock)
  1558. {
  1559. u32 val, kick0_val = 0, kick1_val = 0;
  1560. unsigned long flags;
  1561. int error;
  1562. if (!lock) {
  1563. kick0_val = 0x83e70b13;
  1564. kick1_val = 0x95a4f1e0;
  1565. }
  1566. local_irq_save(flags);
  1567. /* RTC_STATUS BUSY bit may stay active for 1/32768 seconds (~30 usec) */
  1568. error = readl_poll_timeout_atomic(ddata->module_va + 0x44, val,
  1569. !(val & BIT(0)), 100, 50);
  1570. if (error)
  1571. dev_warn(ddata->dev, "rtc busy timeout\n");
  1572. /* Now we have ~15 microseconds to read/write various registers */
  1573. sysc_write(ddata, 0x6c, kick0_val);
  1574. sysc_write(ddata, 0x70, kick1_val);
  1575. local_irq_restore(flags);
  1576. }
  1577. static void sysc_module_unlock_quirk_rtc(struct sysc *ddata)
  1578. {
  1579. sysc_quirk_rtc(ddata, false);
  1580. }
  1581. static void sysc_module_lock_quirk_rtc(struct sysc *ddata)
  1582. {
  1583. sysc_quirk_rtc(ddata, true);
  1584. }
  1585. /* OTG omap2430 glue layer up to omap4 needs OTG_FORCESTDBY configured */
  1586. static void sysc_module_enable_quirk_otg(struct sysc *ddata)
  1587. {
  1588. int offset = 0x414; /* OTG_FORCESTDBY */
  1589. sysc_write(ddata, offset, 0);
  1590. }
  1591. static void sysc_module_disable_quirk_otg(struct sysc *ddata)
  1592. {
  1593. int offset = 0x414; /* OTG_FORCESTDBY */
  1594. u32 val = BIT(0); /* ENABLEFORCE */
  1595. sysc_write(ddata, offset, val);
  1596. }
  1597. /* 36xx SGX needs a quirk for to bypass OCP IPG interrupt logic */
  1598. static void sysc_module_enable_quirk_sgx(struct sysc *ddata)
  1599. {
  1600. int offset = 0xff08; /* OCP_DEBUG_CONFIG */
  1601. u32 val = BIT(31); /* THALIA_INT_BYPASS */
  1602. sysc_write(ddata, offset, val);
  1603. }
  1604. /* Watchdog timer needs a disable sequence after reset */
  1605. static void sysc_reset_done_quirk_wdt(struct sysc *ddata)
  1606. {
  1607. int wps, spr, error;
  1608. u32 val;
  1609. wps = 0x34;
  1610. spr = 0x48;
  1611. sysc_write(ddata, spr, 0xaaaa);
  1612. error = readl_poll_timeout(ddata->module_va + wps, val,
  1613. !(val & 0x10), 100,
  1614. MAX_MODULE_SOFTRESET_WAIT);
  1615. if (error)
  1616. dev_warn(ddata->dev, "wdt disable step1 failed\n");
  1617. sysc_write(ddata, spr, 0x5555);
  1618. error = readl_poll_timeout(ddata->module_va + wps, val,
  1619. !(val & 0x10), 100,
  1620. MAX_MODULE_SOFTRESET_WAIT);
  1621. if (error)
  1622. dev_warn(ddata->dev, "wdt disable step2 failed\n");
  1623. }
  1624. /* PRUSS needs to set MSTANDBY_INIT inorder to idle properly */
  1625. static void sysc_module_disable_quirk_pruss(struct sysc *ddata)
  1626. {
  1627. u32 reg;
  1628. reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  1629. reg |= SYSC_PRUSS_STANDBY_INIT;
  1630. sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg);
  1631. }
  1632. static void sysc_module_enable_quirk_pruss(struct sysc *ddata)
  1633. {
  1634. u32 reg;
  1635. reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);
  1636. /*
  1637. * Clearing the SYSC_PRUSS_STANDBY_INIT bit - Updates OCP master
  1638. * port configuration to enable memory access outside of the
  1639. * PRU-ICSS subsystem.
  1640. */
  1641. reg &= (~SYSC_PRUSS_STANDBY_INIT);
  1642. sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg);
  1643. }
  1644. static void sysc_init_module_quirks(struct sysc *ddata)
  1645. {
  1646. if (ddata->legacy_mode || !ddata->name)
  1647. return;
  1648. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_HDQ1W) {
  1649. ddata->pre_reset_quirk = sysc_pre_reset_quirk_hdq1w;
  1650. return;
  1651. }
  1652. #ifdef CONFIG_OMAP_GPMC_DEBUG
  1653. if (ddata->cfg.quirks & SYSC_QUIRK_GPMC_DEBUG) {
  1654. ddata->cfg.quirks |= SYSC_QUIRK_NO_RESET_ON_INIT;
  1655. return;
  1656. }
  1657. #endif
  1658. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_I2C) {
  1659. ddata->pre_reset_quirk = sysc_pre_reset_quirk_i2c;
  1660. ddata->post_reset_quirk = sysc_post_reset_quirk_i2c;
  1661. return;
  1662. }
  1663. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_AESS)
  1664. ddata->module_enable_quirk = sysc_module_enable_quirk_aess;
  1665. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_DSS_RESET)
  1666. ddata->pre_reset_quirk = sysc_pre_reset_quirk_dss;
  1667. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_RTC_UNLOCK) {
  1668. ddata->module_unlock_quirk = sysc_module_unlock_quirk_rtc;
  1669. ddata->module_lock_quirk = sysc_module_lock_quirk_rtc;
  1670. return;
  1671. }
  1672. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_OTG) {
  1673. ddata->module_enable_quirk = sysc_module_enable_quirk_otg;
  1674. ddata->module_disable_quirk = sysc_module_disable_quirk_otg;
  1675. }
  1676. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_SGX)
  1677. ddata->module_enable_quirk = sysc_module_enable_quirk_sgx;
  1678. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_WDT) {
  1679. ddata->reset_done_quirk = sysc_reset_done_quirk_wdt;
  1680. ddata->module_disable_quirk = sysc_reset_done_quirk_wdt;
  1681. }
  1682. if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_PRUSS) {
  1683. ddata->module_enable_quirk = sysc_module_enable_quirk_pruss;
  1684. ddata->module_disable_quirk = sysc_module_disable_quirk_pruss;
  1685. }
  1686. }
  1687. static int sysc_clockdomain_init(struct sysc *ddata)
  1688. {
  1689. struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev);
  1690. struct clk *fck = NULL, *ick = NULL;
  1691. int error;
  1692. if (!pdata || !pdata->init_clockdomain)
  1693. return 0;
  1694. switch (ddata->nr_clocks) {
  1695. case 2:
  1696. ick = ddata->clocks[SYSC_ICK];
  1697. fallthrough;
  1698. case 1:
  1699. fck = ddata->clocks[SYSC_FCK];
  1700. break;
  1701. case 0:
  1702. return 0;
  1703. }
  1704. error = pdata->init_clockdomain(ddata->dev, fck, ick, &ddata->cookie);
  1705. if (!error || error == -ENODEV)
  1706. return 0;
  1707. return error;
  1708. }
  1709. /*
  1710. * Note that pdata->init_module() typically does a reset first. After
  1711. * pdata->init_module() is done, PM runtime can be used for the interconnect
  1712. * target module.
  1713. */
  1714. static int sysc_legacy_init(struct sysc *ddata)
  1715. {
  1716. struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev);
  1717. int error;
  1718. if (!pdata || !pdata->init_module)
  1719. return 0;
  1720. error = pdata->init_module(ddata->dev, ddata->mdata, &ddata->cookie);
  1721. if (error == -EEXIST)
  1722. error = 0;
  1723. return error;
  1724. }
  1725. /*
  1726. * Note that the caller must ensure the interconnect target module is enabled
  1727. * before calling reset. Otherwise reset will not complete.
  1728. */
  1729. static int sysc_reset(struct sysc *ddata)
  1730. {
  1731. int sysc_offset, sysc_val, error;
  1732. u32 sysc_mask;
  1733. sysc_offset = ddata->offsets[SYSC_SYSCONFIG];
  1734. if (ddata->legacy_mode ||
  1735. ddata->cap->regbits->srst_shift < 0)
  1736. return 0;
  1737. sysc_mask = BIT(ddata->cap->regbits->srst_shift);
  1738. if (ddata->pre_reset_quirk)
  1739. ddata->pre_reset_quirk(ddata);
  1740. if (sysc_offset >= 0) {
  1741. sysc_val = sysc_read_sysconfig(ddata);
  1742. sysc_val |= sysc_mask;
  1743. sysc_write(ddata, sysc_offset, sysc_val);
  1744. /*
  1745. * Some devices need a delay before reading registers
  1746. * after reset. Presumably a srst_udelay is not needed
  1747. * for devices that use a rstctrl register reset.
  1748. */
  1749. if (ddata->cfg.srst_udelay)
  1750. fsleep(ddata->cfg.srst_udelay);
  1751. /*
  1752. * Flush posted write. For devices needing srst_udelay
  1753. * this should trigger an interconnect error if the
  1754. * srst_udelay value is needed but not configured.
  1755. */
  1756. sysc_val = sysc_read_sysconfig(ddata);
  1757. }
  1758. if (ddata->post_reset_quirk)
  1759. ddata->post_reset_quirk(ddata);
  1760. error = sysc_wait_softreset(ddata);
  1761. if (error)
  1762. dev_warn(ddata->dev, "OCP softreset timed out\n");
  1763. if (ddata->reset_done_quirk)
  1764. ddata->reset_done_quirk(ddata);
  1765. return error;
  1766. }
  1767. /*
  1768. * At this point the module is configured enough to read the revision but
  1769. * module may not be completely configured yet to use PM runtime. Enable
  1770. * all clocks directly during init to configure the quirks needed for PM
  1771. * runtime based on the revision register.
  1772. */
  1773. static int sysc_init_module(struct sysc *ddata)
  1774. {
  1775. bool rstctrl_deasserted = false;
  1776. int error = sysc_clockdomain_init(ddata);
  1777. if (error)
  1778. return error;
  1779. sysc_clkdm_deny_idle(ddata);
  1780. /*
  1781. * Always enable clocks. The bootloader may or may not have enabled
  1782. * the related clocks.
  1783. */
  1784. error = sysc_enable_opt_clocks(ddata);
  1785. if (error)
  1786. return error;
  1787. error = sysc_enable_main_clocks(ddata);
  1788. if (error)
  1789. goto err_opt_clocks;
  1790. if (!(ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT)) {
  1791. error = reset_control_deassert(ddata->rsts);
  1792. if (error)
  1793. goto err_main_clocks;
  1794. rstctrl_deasserted = true;
  1795. }
  1796. ddata->revision = sysc_read_revision(ddata);
  1797. sysc_init_revision_quirks(ddata);
  1798. sysc_init_module_quirks(ddata);
  1799. if (ddata->legacy_mode) {
  1800. error = sysc_legacy_init(ddata);
  1801. if (error)
  1802. goto err_main_clocks;
  1803. }
  1804. if (!ddata->legacy_mode) {
  1805. error = sysc_enable_module(ddata->dev);
  1806. if (error)
  1807. goto err_main_clocks;
  1808. }
  1809. if (!(ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT)) {
  1810. error = sysc_reset(ddata);
  1811. if (error)
  1812. dev_err(ddata->dev, "Reset failed with %d\n", error);
  1813. if (error && !ddata->legacy_mode)
  1814. sysc_disable_module(ddata->dev);
  1815. }
  1816. err_main_clocks:
  1817. if (error)
  1818. sysc_disable_main_clocks(ddata);
  1819. err_opt_clocks:
  1820. /* No re-enable of clockdomain autoidle to prevent module autoidle */
  1821. if (error) {
  1822. sysc_disable_opt_clocks(ddata);
  1823. sysc_clkdm_allow_idle(ddata);
  1824. }
  1825. if (error && rstctrl_deasserted &&
  1826. !(ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT))
  1827. reset_control_assert(ddata->rsts);
  1828. return error;
  1829. }
  1830. static int sysc_init_sysc_mask(struct sysc *ddata)
  1831. {
  1832. struct device_node *np = ddata->dev->of_node;
  1833. int error;
  1834. u32 val;
  1835. error = of_property_read_u32(np, "ti,sysc-mask", &val);
  1836. if (error)
  1837. return 0;
  1838. ddata->cfg.sysc_val = val & ddata->cap->sysc_mask;
  1839. return 0;
  1840. }
  1841. static int sysc_init_idlemode(struct sysc *ddata, u8 *idlemodes,
  1842. const char *name)
  1843. {
  1844. struct device_node *np = ddata->dev->of_node;
  1845. u32 val;
  1846. of_property_for_each_u32(np, name, val) {
  1847. if (val >= SYSC_NR_IDLEMODES) {
  1848. dev_err(ddata->dev, "invalid idlemode: %i\n", val);
  1849. return -EINVAL;
  1850. }
  1851. *idlemodes |= (1 << val);
  1852. }
  1853. return 0;
  1854. }
  1855. static int sysc_init_idlemodes(struct sysc *ddata)
  1856. {
  1857. int error;
  1858. error = sysc_init_idlemode(ddata, &ddata->cfg.midlemodes,
  1859. "ti,sysc-midle");
  1860. if (error)
  1861. return error;
  1862. error = sysc_init_idlemode(ddata, &ddata->cfg.sidlemodes,
  1863. "ti,sysc-sidle");
  1864. if (error)
  1865. return error;
  1866. return 0;
  1867. }
  1868. /*
  1869. * Only some devices on omap4 and later have SYSCONFIG reset done
  1870. * bit. We can detect this if there is no SYSSTATUS at all, or the
  1871. * SYSTATUS bit 0 is not used. Note that some SYSSTATUS registers
  1872. * have multiple bits for the child devices like OHCI and EHCI.
  1873. * Depends on SYSC being parsed first.
  1874. */
  1875. static int sysc_init_syss_mask(struct sysc *ddata)
  1876. {
  1877. struct device_node *np = ddata->dev->of_node;
  1878. int error;
  1879. u32 val;
  1880. error = of_property_read_u32(np, "ti,syss-mask", &val);
  1881. if (error) {
  1882. if ((ddata->cap->type == TI_SYSC_OMAP4 ||
  1883. ddata->cap->type == TI_SYSC_OMAP4_TIMER) &&
  1884. (ddata->cfg.sysc_val & SYSC_OMAP4_SOFTRESET))
  1885. ddata->cfg.quirks |= SYSC_QUIRK_RESET_STATUS;
  1886. return 0;
  1887. }
  1888. if (!(val & 1) && (ddata->cfg.sysc_val & SYSC_OMAP4_SOFTRESET))
  1889. ddata->cfg.quirks |= SYSC_QUIRK_RESET_STATUS;
  1890. ddata->cfg.syss_mask = val;
  1891. return 0;
  1892. }
  1893. /*
  1894. * Many child device drivers need to have fck and opt clocks available
  1895. * to get the clock rate for device internal configuration etc.
  1896. */
  1897. static int sysc_child_add_named_clock(struct sysc *ddata,
  1898. struct device *child,
  1899. const char *name)
  1900. {
  1901. struct clk *clk;
  1902. struct clk_lookup *l;
  1903. int error = 0;
  1904. if (!name)
  1905. return 0;
  1906. clk = clk_get(child, name);
  1907. if (!IS_ERR(clk)) {
  1908. error = -EEXIST;
  1909. goto put_clk;
  1910. }
  1911. clk = clk_get(ddata->dev, name);
  1912. if (IS_ERR(clk))
  1913. return -ENODEV;
  1914. l = clkdev_create(clk, name, dev_name(child));
  1915. if (!l)
  1916. error = -ENOMEM;
  1917. put_clk:
  1918. clk_put(clk);
  1919. return error;
  1920. }
  1921. static int sysc_child_add_clocks(struct sysc *ddata,
  1922. struct device *child)
  1923. {
  1924. int i, error;
  1925. for (i = 0; i < ddata->nr_clocks; i++) {
  1926. error = sysc_child_add_named_clock(ddata,
  1927. child,
  1928. ddata->clock_roles[i]);
  1929. if (error && error != -EEXIST) {
  1930. dev_err(ddata->dev, "could not add child clock %s: %i\n",
  1931. ddata->clock_roles[i], error);
  1932. return error;
  1933. }
  1934. }
  1935. return 0;
  1936. }
  1937. static const struct device_type sysc_device_type = {
  1938. };
  1939. static struct sysc *sysc_child_to_parent(struct device *dev)
  1940. {
  1941. struct device *parent = dev->parent;
  1942. if (!parent || parent->type != &sysc_device_type)
  1943. return NULL;
  1944. return dev_get_drvdata(parent);
  1945. }
  1946. static int __maybe_unused sysc_child_runtime_suspend(struct device *dev)
  1947. {
  1948. struct sysc *ddata;
  1949. int error;
  1950. ddata = sysc_child_to_parent(dev);
  1951. error = pm_generic_runtime_suspend(dev);
  1952. if (error)
  1953. return error;
  1954. if (!ddata->enabled)
  1955. return 0;
  1956. return sysc_runtime_suspend(ddata->dev);
  1957. }
  1958. static int __maybe_unused sysc_child_runtime_resume(struct device *dev)
  1959. {
  1960. struct sysc *ddata;
  1961. int error;
  1962. ddata = sysc_child_to_parent(dev);
  1963. if (!ddata->enabled) {
  1964. error = sysc_runtime_resume(ddata->dev);
  1965. if (error < 0)
  1966. dev_err(ddata->dev,
  1967. "%s error: %i\n", __func__, error);
  1968. }
  1969. return pm_generic_runtime_resume(dev);
  1970. }
  1971. /* Caller needs to take list_lock if ever used outside of cpu_pm */
  1972. static void sysc_reinit_modules(struct sysc_soc_info *soc)
  1973. {
  1974. struct sysc_module *module;
  1975. struct sysc *ddata;
  1976. list_for_each_entry(module, &sysc_soc->restored_modules, node) {
  1977. ddata = module->ddata;
  1978. sysc_reinit_module(ddata, ddata->enabled);
  1979. }
  1980. }
  1981. /**
  1982. * sysc_context_notifier - optionally reset and restore module after idle
  1983. * @nb: notifier block
  1984. * @cmd: unused
  1985. * @v: unused
  1986. *
  1987. * Some interconnect target modules need to be restored, or reset and restored
  1988. * on CPU_PM CPU_PM_CLUSTER_EXIT notifier. This is needed at least for am335x
  1989. * OTG and GPMC target modules even if the modules are unused.
  1990. */
  1991. static int sysc_context_notifier(struct notifier_block *nb, unsigned long cmd,
  1992. void *v)
  1993. {
  1994. struct sysc_soc_info *soc;
  1995. soc = container_of(nb, struct sysc_soc_info, nb);
  1996. switch (cmd) {
  1997. case CPU_CLUSTER_PM_ENTER:
  1998. break;
  1999. case CPU_CLUSTER_PM_ENTER_FAILED: /* No need to restore context */
  2000. break;
  2001. case CPU_CLUSTER_PM_EXIT:
  2002. sysc_reinit_modules(soc);
  2003. break;
  2004. }
  2005. return NOTIFY_OK;
  2006. }
  2007. /**
  2008. * sysc_add_restored - optionally add reset and restore quirk hanlling
  2009. * @ddata: device data
  2010. */
  2011. static void sysc_add_restored(struct sysc *ddata)
  2012. {
  2013. struct sysc_module *restored_module;
  2014. restored_module = kzalloc_obj(*restored_module);
  2015. if (!restored_module)
  2016. return;
  2017. restored_module->ddata = ddata;
  2018. mutex_lock(&sysc_soc->list_lock);
  2019. list_add(&restored_module->node, &sysc_soc->restored_modules);
  2020. if (sysc_soc->nb.notifier_call)
  2021. goto out_unlock;
  2022. sysc_soc->nb.notifier_call = sysc_context_notifier;
  2023. cpu_pm_register_notifier(&sysc_soc->nb);
  2024. out_unlock:
  2025. mutex_unlock(&sysc_soc->list_lock);
  2026. }
  2027. static int sysc_notifier_call(struct notifier_block *nb,
  2028. unsigned long event, void *device)
  2029. {
  2030. struct device *dev = device;
  2031. struct sysc *ddata;
  2032. int error;
  2033. ddata = sysc_child_to_parent(dev);
  2034. if (!ddata)
  2035. return NOTIFY_DONE;
  2036. switch (event) {
  2037. case BUS_NOTIFY_ADD_DEVICE:
  2038. error = sysc_child_add_clocks(ddata, dev);
  2039. if (error)
  2040. return error;
  2041. break;
  2042. default:
  2043. break;
  2044. }
  2045. return NOTIFY_DONE;
  2046. }
  2047. static struct notifier_block sysc_nb = {
  2048. .notifier_call = sysc_notifier_call,
  2049. };
  2050. /* Device tree configured quirks */
  2051. struct sysc_dts_quirk {
  2052. const char *name;
  2053. u32 mask;
  2054. };
  2055. static const struct sysc_dts_quirk sysc_dts_quirks[] = {
  2056. { .name = "ti,no-idle-on-init",
  2057. .mask = SYSC_QUIRK_NO_IDLE_ON_INIT, },
  2058. { .name = "ti,no-reset-on-init",
  2059. .mask = SYSC_QUIRK_NO_RESET_ON_INIT, },
  2060. { .name = "ti,no-idle",
  2061. .mask = SYSC_QUIRK_NO_IDLE, },
  2062. };
  2063. static void sysc_parse_dts_quirks(struct sysc *ddata, struct device_node *np,
  2064. bool is_child)
  2065. {
  2066. int i;
  2067. for (i = 0; i < ARRAY_SIZE(sysc_dts_quirks); i++) {
  2068. const char *name = sysc_dts_quirks[i].name;
  2069. if (!of_property_present(np, name))
  2070. continue;
  2071. ddata->cfg.quirks |= sysc_dts_quirks[i].mask;
  2072. if (is_child) {
  2073. dev_warn(ddata->dev,
  2074. "dts flag should be at module level for %s\n",
  2075. name);
  2076. }
  2077. }
  2078. }
  2079. static int sysc_init_dts_quirks(struct sysc *ddata)
  2080. {
  2081. struct device_node *np = ddata->dev->of_node;
  2082. int error;
  2083. u32 val;
  2084. ddata->legacy_mode = of_get_property(np, "ti,hwmods", NULL);
  2085. sysc_parse_dts_quirks(ddata, np, false);
  2086. error = of_property_read_u32(np, "ti,sysc-delay-us", &val);
  2087. if (!error) {
  2088. if (val > 255) {
  2089. dev_warn(ddata->dev, "bad ti,sysc-delay-us: %i\n",
  2090. val);
  2091. }
  2092. ddata->cfg.srst_udelay = (u8)val;
  2093. }
  2094. return 0;
  2095. }
  2096. static void sysc_unprepare(struct sysc *ddata)
  2097. {
  2098. int i;
  2099. if (!ddata->clocks)
  2100. return;
  2101. for (i = 0; i < SYSC_MAX_CLOCKS; i++) {
  2102. if (!IS_ERR_OR_NULL(ddata->clocks[i]))
  2103. clk_unprepare(ddata->clocks[i]);
  2104. }
  2105. }
  2106. /*
  2107. * Common sysc register bits found on omap2, also known as type1
  2108. */
  2109. static const struct sysc_regbits sysc_regbits_omap2 = {
  2110. .dmadisable_shift = -ENODEV,
  2111. .midle_shift = 12,
  2112. .sidle_shift = 3,
  2113. .clkact_shift = 8,
  2114. .emufree_shift = 5,
  2115. .enwkup_shift = 2,
  2116. .srst_shift = 1,
  2117. .autoidle_shift = 0,
  2118. };
  2119. static const struct sysc_capabilities sysc_omap2 = {
  2120. .type = TI_SYSC_OMAP2,
  2121. .sysc_mask = SYSC_OMAP2_CLOCKACTIVITY | SYSC_OMAP2_EMUFREE |
  2122. SYSC_OMAP2_ENAWAKEUP | SYSC_OMAP2_SOFTRESET |
  2123. SYSC_OMAP2_AUTOIDLE,
  2124. .regbits = &sysc_regbits_omap2,
  2125. };
  2126. /* All omap2 and 3 timers, and timers 1, 2 & 10 on omap 4 and 5 */
  2127. static const struct sysc_capabilities sysc_omap2_timer = {
  2128. .type = TI_SYSC_OMAP2_TIMER,
  2129. .sysc_mask = SYSC_OMAP2_CLOCKACTIVITY | SYSC_OMAP2_EMUFREE |
  2130. SYSC_OMAP2_ENAWAKEUP | SYSC_OMAP2_SOFTRESET |
  2131. SYSC_OMAP2_AUTOIDLE,
  2132. .regbits = &sysc_regbits_omap2,
  2133. .mod_quirks = SYSC_QUIRK_USE_CLOCKACT,
  2134. };
  2135. /*
  2136. * SHAM2 (SHA1/MD5) sysc found on omap3, a variant of sysc_regbits_omap2
  2137. * with different sidle position
  2138. */
  2139. static const struct sysc_regbits sysc_regbits_omap3_sham = {
  2140. .dmadisable_shift = -ENODEV,
  2141. .midle_shift = -ENODEV,
  2142. .sidle_shift = 4,
  2143. .clkact_shift = -ENODEV,
  2144. .enwkup_shift = -ENODEV,
  2145. .srst_shift = 1,
  2146. .autoidle_shift = 0,
  2147. .emufree_shift = -ENODEV,
  2148. };
  2149. static const struct sysc_capabilities sysc_omap3_sham = {
  2150. .type = TI_SYSC_OMAP3_SHAM,
  2151. .sysc_mask = SYSC_OMAP2_SOFTRESET | SYSC_OMAP2_AUTOIDLE,
  2152. .regbits = &sysc_regbits_omap3_sham,
  2153. };
  2154. /*
  2155. * AES register bits found on omap3 and later, a variant of
  2156. * sysc_regbits_omap2 with different sidle position
  2157. */
  2158. static const struct sysc_regbits sysc_regbits_omap3_aes = {
  2159. .dmadisable_shift = -ENODEV,
  2160. .midle_shift = -ENODEV,
  2161. .sidle_shift = 6,
  2162. .clkact_shift = -ENODEV,
  2163. .enwkup_shift = -ENODEV,
  2164. .srst_shift = 1,
  2165. .autoidle_shift = 0,
  2166. .emufree_shift = -ENODEV,
  2167. };
  2168. static const struct sysc_capabilities sysc_omap3_aes = {
  2169. .type = TI_SYSC_OMAP3_AES,
  2170. .sysc_mask = SYSC_OMAP2_SOFTRESET | SYSC_OMAP2_AUTOIDLE,
  2171. .regbits = &sysc_regbits_omap3_aes,
  2172. };
  2173. /*
  2174. * Common sysc register bits found on omap4, also known as type2
  2175. */
  2176. static const struct sysc_regbits sysc_regbits_omap4 = {
  2177. .dmadisable_shift = 16,
  2178. .midle_shift = 4,
  2179. .sidle_shift = 2,
  2180. .clkact_shift = -ENODEV,
  2181. .enwkup_shift = -ENODEV,
  2182. .emufree_shift = 1,
  2183. .srst_shift = 0,
  2184. .autoidle_shift = -ENODEV,
  2185. };
  2186. static const struct sysc_capabilities sysc_omap4 = {
  2187. .type = TI_SYSC_OMAP4,
  2188. .sysc_mask = SYSC_OMAP4_DMADISABLE | SYSC_OMAP4_FREEEMU |
  2189. SYSC_OMAP4_SOFTRESET,
  2190. .regbits = &sysc_regbits_omap4,
  2191. };
  2192. static const struct sysc_capabilities sysc_omap4_timer = {
  2193. .type = TI_SYSC_OMAP4_TIMER,
  2194. .sysc_mask = SYSC_OMAP4_DMADISABLE | SYSC_OMAP4_FREEEMU |
  2195. SYSC_OMAP4_SOFTRESET,
  2196. .regbits = &sysc_regbits_omap4,
  2197. };
  2198. /*
  2199. * Common sysc register bits found on omap4, also known as type3
  2200. */
  2201. static const struct sysc_regbits sysc_regbits_omap4_simple = {
  2202. .dmadisable_shift = -ENODEV,
  2203. .midle_shift = 2,
  2204. .sidle_shift = 0,
  2205. .clkact_shift = -ENODEV,
  2206. .enwkup_shift = -ENODEV,
  2207. .srst_shift = -ENODEV,
  2208. .emufree_shift = -ENODEV,
  2209. .autoidle_shift = -ENODEV,
  2210. };
  2211. static const struct sysc_capabilities sysc_omap4_simple = {
  2212. .type = TI_SYSC_OMAP4_SIMPLE,
  2213. .regbits = &sysc_regbits_omap4_simple,
  2214. };
  2215. /*
  2216. * SmartReflex sysc found on omap34xx
  2217. */
  2218. static const struct sysc_regbits sysc_regbits_omap34xx_sr = {
  2219. .dmadisable_shift = -ENODEV,
  2220. .midle_shift = -ENODEV,
  2221. .sidle_shift = -ENODEV,
  2222. .clkact_shift = 20,
  2223. .enwkup_shift = -ENODEV,
  2224. .srst_shift = -ENODEV,
  2225. .emufree_shift = -ENODEV,
  2226. .autoidle_shift = -ENODEV,
  2227. };
  2228. static const struct sysc_capabilities sysc_34xx_sr = {
  2229. .type = TI_SYSC_OMAP34XX_SR,
  2230. .sysc_mask = SYSC_OMAP2_CLOCKACTIVITY,
  2231. .regbits = &sysc_regbits_omap34xx_sr,
  2232. .mod_quirks = SYSC_QUIRK_USE_CLOCKACT | SYSC_QUIRK_UNCACHED,
  2233. };
  2234. /*
  2235. * SmartReflex sysc found on omap36xx and later
  2236. */
  2237. static const struct sysc_regbits sysc_regbits_omap36xx_sr = {
  2238. .dmadisable_shift = -ENODEV,
  2239. .midle_shift = -ENODEV,
  2240. .sidle_shift = 24,
  2241. .clkact_shift = -ENODEV,
  2242. .enwkup_shift = 26,
  2243. .srst_shift = -ENODEV,
  2244. .emufree_shift = -ENODEV,
  2245. .autoidle_shift = -ENODEV,
  2246. };
  2247. static const struct sysc_capabilities sysc_36xx_sr = {
  2248. .type = TI_SYSC_OMAP36XX_SR,
  2249. .sysc_mask = SYSC_OMAP3_SR_ENAWAKEUP,
  2250. .regbits = &sysc_regbits_omap36xx_sr,
  2251. .mod_quirks = SYSC_QUIRK_UNCACHED,
  2252. };
  2253. static const struct sysc_capabilities sysc_omap4_sr = {
  2254. .type = TI_SYSC_OMAP4_SR,
  2255. .regbits = &sysc_regbits_omap36xx_sr,
  2256. };
  2257. /*
  2258. * McASP register bits found on omap4 and later
  2259. */
  2260. static const struct sysc_regbits sysc_regbits_omap4_mcasp = {
  2261. .dmadisable_shift = -ENODEV,
  2262. .midle_shift = -ENODEV,
  2263. .sidle_shift = 0,
  2264. .clkact_shift = -ENODEV,
  2265. .enwkup_shift = -ENODEV,
  2266. .srst_shift = -ENODEV,
  2267. .emufree_shift = -ENODEV,
  2268. .autoidle_shift = -ENODEV,
  2269. };
  2270. static const struct sysc_capabilities sysc_omap4_mcasp = {
  2271. .type = TI_SYSC_OMAP4_MCASP,
  2272. .regbits = &sysc_regbits_omap4_mcasp,
  2273. .mod_quirks = SYSC_QUIRK_OPT_CLKS_NEEDED,
  2274. };
  2275. /*
  2276. * McASP found on dra7 and later
  2277. */
  2278. static const struct sysc_capabilities sysc_dra7_mcasp = {
  2279. .type = TI_SYSC_OMAP4_SIMPLE,
  2280. .regbits = &sysc_regbits_omap4_simple,
  2281. .mod_quirks = SYSC_QUIRK_OPT_CLKS_NEEDED,
  2282. };
  2283. /*
  2284. * FS USB host found on omap4 and later
  2285. */
  2286. static const struct sysc_regbits sysc_regbits_omap4_usb_host_fs = {
  2287. .dmadisable_shift = -ENODEV,
  2288. .midle_shift = -ENODEV,
  2289. .sidle_shift = 24,
  2290. .clkact_shift = -ENODEV,
  2291. .enwkup_shift = 26,
  2292. .srst_shift = -ENODEV,
  2293. .emufree_shift = -ENODEV,
  2294. .autoidle_shift = -ENODEV,
  2295. };
  2296. static const struct sysc_capabilities sysc_omap4_usb_host_fs = {
  2297. .type = TI_SYSC_OMAP4_USB_HOST_FS,
  2298. .sysc_mask = SYSC_OMAP2_ENAWAKEUP,
  2299. .regbits = &sysc_regbits_omap4_usb_host_fs,
  2300. };
  2301. static const struct sysc_regbits sysc_regbits_dra7_mcan = {
  2302. .dmadisable_shift = -ENODEV,
  2303. .midle_shift = -ENODEV,
  2304. .sidle_shift = -ENODEV,
  2305. .clkact_shift = -ENODEV,
  2306. .enwkup_shift = 4,
  2307. .srst_shift = 0,
  2308. .emufree_shift = -ENODEV,
  2309. .autoidle_shift = -ENODEV,
  2310. };
  2311. static const struct sysc_capabilities sysc_dra7_mcan = {
  2312. .type = TI_SYSC_DRA7_MCAN,
  2313. .sysc_mask = SYSC_DRA7_MCAN_ENAWAKEUP | SYSC_OMAP4_SOFTRESET,
  2314. .regbits = &sysc_regbits_dra7_mcan,
  2315. .mod_quirks = SYSS_QUIRK_RESETDONE_INVERTED,
  2316. };
  2317. /*
  2318. * PRUSS found on some AM33xx, AM437x and AM57xx SoCs
  2319. */
  2320. static const struct sysc_capabilities sysc_pruss = {
  2321. .type = TI_SYSC_PRUSS,
  2322. .sysc_mask = SYSC_PRUSS_STANDBY_INIT | SYSC_PRUSS_SUB_MWAIT,
  2323. .regbits = &sysc_regbits_omap4_simple,
  2324. .mod_quirks = SYSC_MODULE_QUIRK_PRUSS,
  2325. };
  2326. static int sysc_init_pdata(struct sysc *ddata)
  2327. {
  2328. struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev);
  2329. struct ti_sysc_module_data *mdata;
  2330. if (!pdata)
  2331. return 0;
  2332. mdata = devm_kzalloc(ddata->dev, sizeof(*mdata), GFP_KERNEL);
  2333. if (!mdata)
  2334. return -ENOMEM;
  2335. if (ddata->legacy_mode) {
  2336. mdata->name = ddata->legacy_mode;
  2337. mdata->module_pa = ddata->module_pa;
  2338. mdata->module_size = ddata->module_size;
  2339. mdata->offsets = ddata->offsets;
  2340. mdata->nr_offsets = SYSC_MAX_REGS;
  2341. mdata->cap = ddata->cap;
  2342. mdata->cfg = &ddata->cfg;
  2343. }
  2344. ddata->mdata = mdata;
  2345. return 0;
  2346. }
  2347. static int sysc_init_match(struct sysc *ddata)
  2348. {
  2349. const struct sysc_capabilities *cap;
  2350. cap = of_device_get_match_data(ddata->dev);
  2351. if (!cap)
  2352. return -EINVAL;
  2353. ddata->cap = cap;
  2354. if (ddata->cap)
  2355. ddata->cfg.quirks |= ddata->cap->mod_quirks;
  2356. return 0;
  2357. }
  2358. static void ti_sysc_idle(struct work_struct *work)
  2359. {
  2360. struct sysc *ddata;
  2361. ddata = container_of(work, struct sysc, idle_work.work);
  2362. /*
  2363. * One time decrement of clock usage counts if left on from init.
  2364. * Note that we disable opt clocks unconditionally in this case
  2365. * as they are enabled unconditionally during init without
  2366. * considering sysc_opt_clks_needed() at that point.
  2367. */
  2368. if (ddata->cfg.quirks & (SYSC_QUIRK_NO_IDLE |
  2369. SYSC_QUIRK_NO_IDLE_ON_INIT)) {
  2370. sysc_disable_main_clocks(ddata);
  2371. sysc_disable_opt_clocks(ddata);
  2372. sysc_clkdm_allow_idle(ddata);
  2373. }
  2374. /* Keep permanent PM runtime usage count for SYSC_QUIRK_NO_IDLE */
  2375. if (ddata->cfg.quirks & SYSC_QUIRK_NO_IDLE)
  2376. return;
  2377. /*
  2378. * Decrement PM runtime usage count for SYSC_QUIRK_NO_IDLE_ON_INIT
  2379. * and SYSC_QUIRK_NO_RESET_ON_INIT
  2380. */
  2381. if (pm_runtime_active(ddata->dev))
  2382. pm_runtime_put_sync(ddata->dev);
  2383. }
  2384. /*
  2385. * SoC model and features detection. Only needed for SoCs that need
  2386. * special handling for quirks, no need to list others.
  2387. */
  2388. static const struct soc_device_attribute sysc_soc_match[] = {
  2389. SOC_FLAG("OMAP242*", SOC_2420),
  2390. SOC_FLAG("OMAP243*", SOC_2430),
  2391. SOC_FLAG("AM33*", SOC_AM33),
  2392. SOC_FLAG("AM35*", SOC_AM35),
  2393. SOC_FLAG("OMAP3[45]*", SOC_3430),
  2394. SOC_FLAG("OMAP3[67]*", SOC_3630),
  2395. SOC_FLAG("OMAP443*", SOC_4430),
  2396. SOC_FLAG("OMAP446*", SOC_4460),
  2397. SOC_FLAG("OMAP447*", SOC_4470),
  2398. SOC_FLAG("OMAP54*", SOC_5430),
  2399. SOC_FLAG("AM433", SOC_AM3),
  2400. SOC_FLAG("AM43*", SOC_AM4),
  2401. SOC_FLAG("DRA7*", SOC_DRA7),
  2402. { /* sentinel */ }
  2403. };
  2404. /*
  2405. * List of SoCs variants with disabled features. By default we assume all
  2406. * devices in the device tree are available so no need to list those SoCs.
  2407. */
  2408. static const struct soc_device_attribute sysc_soc_feat_match[] = {
  2409. /* OMAP3430/3530 and AM3517 variants with some accelerators disabled */
  2410. SOC_FLAG("AM3505", DIS_SGX),
  2411. SOC_FLAG("OMAP3525", DIS_SGX),
  2412. SOC_FLAG("OMAP3515", DIS_IVA | DIS_SGX),
  2413. SOC_FLAG("OMAP3503", DIS_ISP | DIS_IVA | DIS_SGX),
  2414. /* OMAP3630/DM3730 variants with some accelerators disabled */
  2415. SOC_FLAG("AM3703", DIS_IVA | DIS_SGX),
  2416. SOC_FLAG("DM3725", DIS_SGX),
  2417. SOC_FLAG("OMAP3611", DIS_ISP | DIS_IVA | DIS_SGX),
  2418. SOC_FLAG("OMAP3615/AM3715", DIS_IVA),
  2419. SOC_FLAG("OMAP3621", DIS_ISP),
  2420. { /* sentinel */ }
  2421. };
  2422. static int sysc_add_disabled(unsigned long base)
  2423. {
  2424. struct sysc_address *disabled_module;
  2425. disabled_module = kzalloc_obj(*disabled_module);
  2426. if (!disabled_module)
  2427. return -ENOMEM;
  2428. disabled_module->base = base;
  2429. mutex_lock(&sysc_soc->list_lock);
  2430. list_add(&disabled_module->node, &sysc_soc->disabled_modules);
  2431. mutex_unlock(&sysc_soc->list_lock);
  2432. return 0;
  2433. }
  2434. /*
  2435. * One time init to detect the booted SoC, disable unavailable features
  2436. * and initialize list for optional cpu_pm notifier.
  2437. *
  2438. * Note that we initialize static data shared across all ti-sysc instances
  2439. * so ddata is only used for SoC type. This can be called from module_init
  2440. * once we no longer need to rely on platform data.
  2441. */
  2442. static int sysc_init_static_data(struct sysc *ddata)
  2443. {
  2444. const struct soc_device_attribute *match;
  2445. struct ti_sysc_platform_data *pdata;
  2446. unsigned long features = 0;
  2447. struct device_node *np;
  2448. if (sysc_soc)
  2449. return 0;
  2450. sysc_soc = kzalloc_obj(*sysc_soc);
  2451. if (!sysc_soc)
  2452. return -ENOMEM;
  2453. mutex_init(&sysc_soc->list_lock);
  2454. INIT_LIST_HEAD(&sysc_soc->disabled_modules);
  2455. INIT_LIST_HEAD(&sysc_soc->restored_modules);
  2456. sysc_soc->general_purpose = true;
  2457. pdata = dev_get_platdata(ddata->dev);
  2458. if (pdata && pdata->soc_type_gp)
  2459. sysc_soc->general_purpose = pdata->soc_type_gp();
  2460. match = soc_device_match(sysc_soc_match);
  2461. if (match && match->data)
  2462. sysc_soc->soc = (enum sysc_soc)(uintptr_t)match->data;
  2463. /*
  2464. * Check and warn about possible old incomplete dtb. We now want to see
  2465. * simple-pm-bus instead of simple-bus in the dtb for genpd using SoCs.
  2466. */
  2467. switch (sysc_soc->soc) {
  2468. case SOC_AM3:
  2469. case SOC_AM4:
  2470. case SOC_4430 ... SOC_4470:
  2471. case SOC_5430:
  2472. case SOC_DRA7:
  2473. np = of_find_node_by_path("/ocp");
  2474. WARN_ONCE(np && of_device_is_compatible(np, "simple-bus"),
  2475. "ti-sysc: Incomplete old dtb, please update\n");
  2476. break;
  2477. default:
  2478. break;
  2479. }
  2480. /* Ignore devices that are not available on HS and EMU SoCs */
  2481. if (!sysc_soc->general_purpose) {
  2482. switch (sysc_soc->soc) {
  2483. case SOC_3430 ... SOC_3630:
  2484. sysc_add_disabled(0x48304000); /* timer12 */
  2485. break;
  2486. case SOC_AM3:
  2487. sysc_add_disabled(0x48310000); /* rng */
  2488. break;
  2489. default:
  2490. break;
  2491. }
  2492. }
  2493. match = soc_device_match(sysc_soc_feat_match);
  2494. if (!match)
  2495. return 0;
  2496. if (match->data)
  2497. features = (unsigned long)match->data;
  2498. /*
  2499. * Add disabled devices to the list based on the module base.
  2500. * Note that this must be done before we attempt to access the
  2501. * device and have module revision checks working.
  2502. */
  2503. if (features & DIS_ISP)
  2504. sysc_add_disabled(0x480bd400);
  2505. if (features & DIS_IVA)
  2506. sysc_add_disabled(0x5d000000);
  2507. if (features & DIS_SGX)
  2508. sysc_add_disabled(0x50000000);
  2509. return 0;
  2510. }
  2511. static void sysc_cleanup_static_data(void)
  2512. {
  2513. struct sysc_module *restored_module;
  2514. struct sysc_address *disabled_module;
  2515. struct list_head *pos, *tmp;
  2516. if (!sysc_soc)
  2517. return;
  2518. if (sysc_soc->nb.notifier_call)
  2519. cpu_pm_unregister_notifier(&sysc_soc->nb);
  2520. mutex_lock(&sysc_soc->list_lock);
  2521. list_for_each_safe(pos, tmp, &sysc_soc->restored_modules) {
  2522. restored_module = list_entry(pos, struct sysc_module, node);
  2523. list_del(pos);
  2524. kfree(restored_module);
  2525. }
  2526. list_for_each_safe(pos, tmp, &sysc_soc->disabled_modules) {
  2527. disabled_module = list_entry(pos, struct sysc_address, node);
  2528. list_del(pos);
  2529. kfree(disabled_module);
  2530. }
  2531. mutex_unlock(&sysc_soc->list_lock);
  2532. }
  2533. static int sysc_check_disabled_devices(struct sysc *ddata)
  2534. {
  2535. struct sysc_address *disabled_module;
  2536. int error = 0;
  2537. mutex_lock(&sysc_soc->list_lock);
  2538. list_for_each_entry(disabled_module, &sysc_soc->disabled_modules, node) {
  2539. if (ddata->module_pa == disabled_module->base) {
  2540. dev_dbg(ddata->dev, "module disabled for this SoC\n");
  2541. error = -ENODEV;
  2542. break;
  2543. }
  2544. }
  2545. mutex_unlock(&sysc_soc->list_lock);
  2546. return error;
  2547. }
  2548. /*
  2549. * Ignore timers tagged with no-reset and no-idle. These are likely in use,
  2550. * for example by drivers/clocksource/timer-ti-dm-systimer.c. If more checks
  2551. * are needed, we could also look at the timer register configuration.
  2552. */
  2553. static int sysc_check_active_timer(struct sysc *ddata)
  2554. {
  2555. int error;
  2556. if (ddata->cap->type != TI_SYSC_OMAP2_TIMER &&
  2557. ddata->cap->type != TI_SYSC_OMAP4_TIMER)
  2558. return 0;
  2559. /*
  2560. * Quirk for omap3 beagleboard revision A to B4 to use gpt12.
  2561. * Revision C and later are fixed with commit 23885389dbbb ("ARM:
  2562. * dts: Fix timer regression for beagleboard revision c"). This all
  2563. * can be dropped if we stop supporting old beagleboard revisions
  2564. * A to B4 at some point.
  2565. */
  2566. switch (sysc_soc->soc) {
  2567. case SOC_AM33:
  2568. case SOC_3430:
  2569. case SOC_AM35:
  2570. error = -ENXIO;
  2571. break;
  2572. default:
  2573. error = -EBUSY;
  2574. }
  2575. if ((ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT) &&
  2576. (ddata->cfg.quirks & SYSC_QUIRK_NO_IDLE))
  2577. return error;
  2578. return 0;
  2579. }
  2580. static const struct of_device_id sysc_match_table[] = {
  2581. { .compatible = "simple-bus", },
  2582. { /* sentinel */ },
  2583. };
  2584. static int sysc_probe(struct platform_device *pdev)
  2585. {
  2586. struct ti_sysc_platform_data *pdata = dev_get_platdata(&pdev->dev);
  2587. struct sysc *ddata;
  2588. int error;
  2589. ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
  2590. if (!ddata)
  2591. return -ENOMEM;
  2592. ddata->offsets[SYSC_REVISION] = -ENODEV;
  2593. ddata->offsets[SYSC_SYSCONFIG] = -ENODEV;
  2594. ddata->offsets[SYSC_SYSSTATUS] = -ENODEV;
  2595. ddata->dev = &pdev->dev;
  2596. platform_set_drvdata(pdev, ddata);
  2597. error = sysc_init_static_data(ddata);
  2598. if (error)
  2599. return error;
  2600. error = sysc_init_match(ddata);
  2601. if (error)
  2602. return error;
  2603. error = sysc_init_dts_quirks(ddata);
  2604. if (error)
  2605. return error;
  2606. error = sysc_map_and_check_registers(ddata);
  2607. if (error)
  2608. return error;
  2609. error = sysc_init_sysc_mask(ddata);
  2610. if (error)
  2611. return error;
  2612. error = sysc_init_idlemodes(ddata);
  2613. if (error)
  2614. return error;
  2615. error = sysc_init_syss_mask(ddata);
  2616. if (error)
  2617. return error;
  2618. error = sysc_init_pdata(ddata);
  2619. if (error)
  2620. return error;
  2621. sysc_init_early_quirks(ddata);
  2622. error = sysc_check_disabled_devices(ddata);
  2623. if (error)
  2624. return error;
  2625. error = sysc_check_active_timer(ddata);
  2626. if (error == -ENXIO)
  2627. ddata->reserved = true;
  2628. else if (error)
  2629. return error;
  2630. error = sysc_get_clocks(ddata);
  2631. if (error)
  2632. return error;
  2633. error = sysc_init_resets(ddata);
  2634. if (error)
  2635. goto unprepare;
  2636. error = sysc_init_module(ddata);
  2637. if (error)
  2638. goto unprepare;
  2639. pm_runtime_enable(ddata->dev);
  2640. error = pm_runtime_resume_and_get(ddata->dev);
  2641. if (error < 0) {
  2642. pm_runtime_disable(ddata->dev);
  2643. goto unprepare;
  2644. }
  2645. /* Balance use counts as PM runtime should have enabled these all */
  2646. if (!(ddata->cfg.quirks &
  2647. (SYSC_QUIRK_NO_IDLE | SYSC_QUIRK_NO_IDLE_ON_INIT))) {
  2648. sysc_disable_main_clocks(ddata);
  2649. sysc_disable_opt_clocks(ddata);
  2650. sysc_clkdm_allow_idle(ddata);
  2651. }
  2652. if (!(ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT))
  2653. reset_control_assert(ddata->rsts);
  2654. sysc_show_registers(ddata);
  2655. ddata->dev->type = &sysc_device_type;
  2656. if (!ddata->reserved) {
  2657. error = of_platform_populate(ddata->dev->of_node,
  2658. sysc_match_table,
  2659. pdata ? pdata->auxdata : NULL,
  2660. ddata->dev);
  2661. if (error)
  2662. goto err;
  2663. }
  2664. INIT_DELAYED_WORK(&ddata->idle_work, ti_sysc_idle);
  2665. /* At least earlycon won't survive without deferred idle */
  2666. if (ddata->cfg.quirks & (SYSC_QUIRK_NO_IDLE |
  2667. SYSC_QUIRK_NO_IDLE_ON_INIT |
  2668. SYSC_QUIRK_NO_RESET_ON_INIT)) {
  2669. schedule_delayed_work(&ddata->idle_work, 3000);
  2670. } else {
  2671. pm_runtime_put(&pdev->dev);
  2672. }
  2673. if (ddata->cfg.quirks & SYSC_QUIRK_REINIT_ON_CTX_LOST)
  2674. sysc_add_restored(ddata);
  2675. return 0;
  2676. err:
  2677. pm_runtime_put_sync(&pdev->dev);
  2678. pm_runtime_disable(&pdev->dev);
  2679. unprepare:
  2680. sysc_unprepare(ddata);
  2681. return error;
  2682. }
  2683. static void sysc_remove(struct platform_device *pdev)
  2684. {
  2685. struct sysc *ddata = platform_get_drvdata(pdev);
  2686. int error;
  2687. /* Device can still be enabled, see deferred idle quirk in probe */
  2688. if (cancel_delayed_work_sync(&ddata->idle_work))
  2689. ti_sysc_idle(&ddata->idle_work.work);
  2690. error = pm_runtime_resume_and_get(ddata->dev);
  2691. if (error < 0) {
  2692. pm_runtime_disable(ddata->dev);
  2693. goto unprepare;
  2694. }
  2695. of_platform_depopulate(&pdev->dev);
  2696. pm_runtime_put_sync(&pdev->dev);
  2697. pm_runtime_disable(&pdev->dev);
  2698. if (!reset_control_status(ddata->rsts))
  2699. reset_control_assert(ddata->rsts);
  2700. unprepare:
  2701. sysc_unprepare(ddata);
  2702. }
  2703. static const struct of_device_id sysc_match[] = {
  2704. { .compatible = "ti,sysc-omap2", .data = &sysc_omap2, },
  2705. { .compatible = "ti,sysc-omap2-timer", .data = &sysc_omap2_timer, },
  2706. { .compatible = "ti,sysc-omap4", .data = &sysc_omap4, },
  2707. { .compatible = "ti,sysc-omap4-timer", .data = &sysc_omap4_timer, },
  2708. { .compatible = "ti,sysc-omap4-simple", .data = &sysc_omap4_simple, },
  2709. { .compatible = "ti,sysc-omap3430-sr", .data = &sysc_34xx_sr, },
  2710. { .compatible = "ti,sysc-omap3630-sr", .data = &sysc_36xx_sr, },
  2711. { .compatible = "ti,sysc-omap4-sr", .data = &sysc_omap4_sr, },
  2712. { .compatible = "ti,sysc-omap3-sham", .data = &sysc_omap3_sham, },
  2713. { .compatible = "ti,sysc-omap-aes", .data = &sysc_omap3_aes, },
  2714. { .compatible = "ti,sysc-mcasp", .data = &sysc_omap4_mcasp, },
  2715. { .compatible = "ti,sysc-dra7-mcasp", .data = &sysc_dra7_mcasp, },
  2716. { .compatible = "ti,sysc-usb-host-fs",
  2717. .data = &sysc_omap4_usb_host_fs, },
  2718. { .compatible = "ti,sysc-dra7-mcan", .data = &sysc_dra7_mcan, },
  2719. { .compatible = "ti,sysc-pruss", .data = &sysc_pruss, },
  2720. { },
  2721. };
  2722. MODULE_DEVICE_TABLE(of, sysc_match);
  2723. static struct platform_driver sysc_driver = {
  2724. .probe = sysc_probe,
  2725. .remove = sysc_remove,
  2726. .driver = {
  2727. .name = "ti-sysc",
  2728. .of_match_table = sysc_match,
  2729. .pm = &sysc_pm_ops,
  2730. },
  2731. };
  2732. static int __init sysc_init(void)
  2733. {
  2734. bus_register_notifier(&platform_bus_type, &sysc_nb);
  2735. return platform_driver_register(&sysc_driver);
  2736. }
  2737. module_init(sysc_init);
  2738. static void __exit sysc_exit(void)
  2739. {
  2740. bus_unregister_notifier(&platform_bus_type, &sysc_nb);
  2741. platform_driver_unregister(&sysc_driver);
  2742. sysc_cleanup_static_data();
  2743. }
  2744. module_exit(sysc_exit);
  2745. MODULE_DESCRIPTION("TI sysc interconnect target driver");
  2746. MODULE_LICENSE("GPL v2");