ti-sysc.c 83 KB

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