sumo_dpm.c 51 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830
  1. /*
  2. * Copyright 2012 Advanced Micro Devices, Inc.
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining a
  5. * copy of this software and associated documentation files (the "Software"),
  6. * to deal in the Software without restriction, including without limitation
  7. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8. * and/or sell copies of the Software, and to permit persons to whom the
  9. * Software is furnished to do so, subject to the following conditions:
  10. *
  11. * The above copyright notice and this permission notice shall be included in
  12. * all copies or substantial portions of the Software.
  13. *
  14. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  17. * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20. * OTHER DEALINGS IN THE SOFTWARE.
  21. *
  22. */
  23. #include "drmP.h"
  24. #include "radeon.h"
  25. #include "sumod.h"
  26. #include "r600_dpm.h"
  27. #include "cypress_dpm.h"
  28. #include "sumo_dpm.h"
  29. #include <linux/seq_file.h>
  30. #define SUMO_MAX_DEEPSLEEP_DIVIDER_ID 5
  31. #define SUMO_MINIMUM_ENGINE_CLOCK 800
  32. #define BOOST_DPM_LEVEL 7
  33. static const u32 sumo_utc[SUMO_PM_NUMBER_OF_TC] =
  34. {
  35. SUMO_UTC_DFLT_00,
  36. SUMO_UTC_DFLT_01,
  37. SUMO_UTC_DFLT_02,
  38. SUMO_UTC_DFLT_03,
  39. SUMO_UTC_DFLT_04,
  40. SUMO_UTC_DFLT_05,
  41. SUMO_UTC_DFLT_06,
  42. SUMO_UTC_DFLT_07,
  43. SUMO_UTC_DFLT_08,
  44. SUMO_UTC_DFLT_09,
  45. SUMO_UTC_DFLT_10,
  46. SUMO_UTC_DFLT_11,
  47. SUMO_UTC_DFLT_12,
  48. SUMO_UTC_DFLT_13,
  49. SUMO_UTC_DFLT_14,
  50. };
  51. static const u32 sumo_dtc[SUMO_PM_NUMBER_OF_TC] =
  52. {
  53. SUMO_DTC_DFLT_00,
  54. SUMO_DTC_DFLT_01,
  55. SUMO_DTC_DFLT_02,
  56. SUMO_DTC_DFLT_03,
  57. SUMO_DTC_DFLT_04,
  58. SUMO_DTC_DFLT_05,
  59. SUMO_DTC_DFLT_06,
  60. SUMO_DTC_DFLT_07,
  61. SUMO_DTC_DFLT_08,
  62. SUMO_DTC_DFLT_09,
  63. SUMO_DTC_DFLT_10,
  64. SUMO_DTC_DFLT_11,
  65. SUMO_DTC_DFLT_12,
  66. SUMO_DTC_DFLT_13,
  67. SUMO_DTC_DFLT_14,
  68. };
  69. struct sumo_ps *sumo_get_ps(struct radeon_ps *rps)
  70. {
  71. struct sumo_ps *ps = rps->ps_priv;
  72. return ps;
  73. }
  74. struct sumo_power_info *sumo_get_pi(struct radeon_device *rdev)
  75. {
  76. struct sumo_power_info *pi = rdev->pm.dpm.priv;
  77. return pi;
  78. }
  79. static void sumo_gfx_clockgating_enable(struct radeon_device *rdev, bool enable)
  80. {
  81. if (enable)
  82. WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
  83. else {
  84. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
  85. WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
  86. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
  87. RREG32(GB_ADDR_CONFIG);
  88. }
  89. }
  90. #define CGCG_CGTT_LOCAL0_MASK 0xE5BFFFFF
  91. #define CGCG_CGTT_LOCAL1_MASK 0xEFFF07FF
  92. static void sumo_mg_clockgating_enable(struct radeon_device *rdev, bool enable)
  93. {
  94. u32 local0;
  95. u32 local1;
  96. local0 = RREG32(CG_CGTT_LOCAL_0);
  97. local1 = RREG32(CG_CGTT_LOCAL_1);
  98. if (enable) {
  99. WREG32(CG_CGTT_LOCAL_0, (0 & CGCG_CGTT_LOCAL0_MASK) | (local0 & ~CGCG_CGTT_LOCAL0_MASK) );
  100. WREG32(CG_CGTT_LOCAL_1, (0 & CGCG_CGTT_LOCAL1_MASK) | (local1 & ~CGCG_CGTT_LOCAL1_MASK) );
  101. } else {
  102. WREG32(CG_CGTT_LOCAL_0, (0xFFFFFFFF & CGCG_CGTT_LOCAL0_MASK) | (local0 & ~CGCG_CGTT_LOCAL0_MASK) );
  103. WREG32(CG_CGTT_LOCAL_1, (0xFFFFCFFF & CGCG_CGTT_LOCAL1_MASK) | (local1 & ~CGCG_CGTT_LOCAL1_MASK) );
  104. }
  105. }
  106. static void sumo_program_git(struct radeon_device *rdev)
  107. {
  108. u32 p, u;
  109. u32 xclk = radeon_get_xclk(rdev);
  110. r600_calculate_u_and_p(SUMO_GICST_DFLT,
  111. xclk, 16, &p, &u);
  112. WREG32_P(CG_GIT, CG_GICST(p), ~CG_GICST_MASK);
  113. }
  114. static void sumo_program_grsd(struct radeon_device *rdev)
  115. {
  116. u32 p, u;
  117. u32 xclk = radeon_get_xclk(rdev);
  118. u32 grs = 256 * 25 / 100;
  119. r600_calculate_u_and_p(1, xclk, 14, &p, &u);
  120. WREG32(CG_GCOOR, PHC(grs) | SDC(p) | SU(u));
  121. }
  122. void sumo_gfx_clockgating_initialize(struct radeon_device *rdev)
  123. {
  124. sumo_program_git(rdev);
  125. sumo_program_grsd(rdev);
  126. }
  127. static void sumo_gfx_powergating_initialize(struct radeon_device *rdev)
  128. {
  129. u32 rcu_pwr_gating_cntl;
  130. u32 p, u;
  131. u32 p_c, p_p, d_p;
  132. u32 r_t, i_t;
  133. u32 xclk = radeon_get_xclk(rdev);
  134. if (rdev->family == CHIP_PALM) {
  135. p_c = 4;
  136. d_p = 10;
  137. r_t = 10;
  138. i_t = 4;
  139. p_p = 50 + 1000/200 + 6 * 32;
  140. } else {
  141. p_c = 16;
  142. d_p = 50;
  143. r_t = 50;
  144. i_t = 50;
  145. p_p = 113;
  146. }
  147. WREG32(CG_SCRATCH2, 0x01B60A17);
  148. r600_calculate_u_and_p(SUMO_GFXPOWERGATINGT_DFLT,
  149. xclk, 16, &p, &u);
  150. WREG32_P(CG_PWR_GATING_CNTL, PGP(p) | PGU(u),
  151. ~(PGP_MASK | PGU_MASK));
  152. r600_calculate_u_and_p(SUMO_VOLTAGEDROPT_DFLT,
  153. xclk, 16, &p, &u);
  154. WREG32_P(CG_CG_VOLTAGE_CNTL, PGP(p) | PGU(u),
  155. ~(PGP_MASK | PGU_MASK));
  156. if (rdev->family == CHIP_PALM) {
  157. WREG32_RCU(RCU_PWR_GATING_SEQ0, 0x10103210);
  158. WREG32_RCU(RCU_PWR_GATING_SEQ1, 0x10101010);
  159. } else {
  160. WREG32_RCU(RCU_PWR_GATING_SEQ0, 0x76543210);
  161. WREG32_RCU(RCU_PWR_GATING_SEQ1, 0xFEDCBA98);
  162. }
  163. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL);
  164. rcu_pwr_gating_cntl &=
  165. ~(RSVD_MASK | PCV_MASK | PGS_MASK);
  166. rcu_pwr_gating_cntl |= PCV(p_c) | PGS(1) | PWR_GATING_EN;
  167. if (rdev->family == CHIP_PALM) {
  168. rcu_pwr_gating_cntl &= ~PCP_MASK;
  169. rcu_pwr_gating_cntl |= PCP(0x77);
  170. }
  171. WREG32_RCU(RCU_PWR_GATING_CNTL, rcu_pwr_gating_cntl);
  172. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_2);
  173. rcu_pwr_gating_cntl &= ~(MPPU_MASK | MPPD_MASK);
  174. rcu_pwr_gating_cntl |= MPPU(p_p) | MPPD(50);
  175. WREG32_RCU(RCU_PWR_GATING_CNTL_2, rcu_pwr_gating_cntl);
  176. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_3);
  177. rcu_pwr_gating_cntl &= ~(DPPU_MASK | DPPD_MASK);
  178. rcu_pwr_gating_cntl |= DPPU(d_p) | DPPD(50);
  179. WREG32_RCU(RCU_PWR_GATING_CNTL_3, rcu_pwr_gating_cntl);
  180. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_4);
  181. rcu_pwr_gating_cntl &= ~(RT_MASK | IT_MASK);
  182. rcu_pwr_gating_cntl |= RT(r_t) | IT(i_t);
  183. WREG32_RCU(RCU_PWR_GATING_CNTL_4, rcu_pwr_gating_cntl);
  184. if (rdev->family == CHIP_PALM)
  185. WREG32_RCU(RCU_PWR_GATING_CNTL_5, 0xA02);
  186. sumo_smu_pg_init(rdev);
  187. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL);
  188. rcu_pwr_gating_cntl &=
  189. ~(RSVD_MASK | PCV_MASK | PGS_MASK);
  190. rcu_pwr_gating_cntl |= PCV(p_c) | PGS(4) | PWR_GATING_EN;
  191. if (rdev->family == CHIP_PALM) {
  192. rcu_pwr_gating_cntl &= ~PCP_MASK;
  193. rcu_pwr_gating_cntl |= PCP(0x77);
  194. }
  195. WREG32_RCU(RCU_PWR_GATING_CNTL, rcu_pwr_gating_cntl);
  196. if (rdev->family == CHIP_PALM) {
  197. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_2);
  198. rcu_pwr_gating_cntl &= ~(MPPU_MASK | MPPD_MASK);
  199. rcu_pwr_gating_cntl |= MPPU(113) | MPPD(50);
  200. WREG32_RCU(RCU_PWR_GATING_CNTL_2, rcu_pwr_gating_cntl);
  201. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_3);
  202. rcu_pwr_gating_cntl &= ~(DPPU_MASK | DPPD_MASK);
  203. rcu_pwr_gating_cntl |= DPPU(16) | DPPD(50);
  204. WREG32_RCU(RCU_PWR_GATING_CNTL_3, rcu_pwr_gating_cntl);
  205. }
  206. sumo_smu_pg_init(rdev);
  207. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL);
  208. rcu_pwr_gating_cntl &=
  209. ~(RSVD_MASK | PCV_MASK | PGS_MASK);
  210. rcu_pwr_gating_cntl |= PGS(5) | PWR_GATING_EN;
  211. if (rdev->family == CHIP_PALM) {
  212. rcu_pwr_gating_cntl |= PCV(4);
  213. rcu_pwr_gating_cntl &= ~PCP_MASK;
  214. rcu_pwr_gating_cntl |= PCP(0x77);
  215. } else
  216. rcu_pwr_gating_cntl |= PCV(11);
  217. WREG32_RCU(RCU_PWR_GATING_CNTL, rcu_pwr_gating_cntl);
  218. if (rdev->family == CHIP_PALM) {
  219. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_2);
  220. rcu_pwr_gating_cntl &= ~(MPPU_MASK | MPPD_MASK);
  221. rcu_pwr_gating_cntl |= MPPU(113) | MPPD(50);
  222. WREG32_RCU(RCU_PWR_GATING_CNTL_2, rcu_pwr_gating_cntl);
  223. rcu_pwr_gating_cntl = RREG32_RCU(RCU_PWR_GATING_CNTL_3);
  224. rcu_pwr_gating_cntl &= ~(DPPU_MASK | DPPD_MASK);
  225. rcu_pwr_gating_cntl |= DPPU(22) | DPPD(50);
  226. WREG32_RCU(RCU_PWR_GATING_CNTL_3, rcu_pwr_gating_cntl);
  227. }
  228. sumo_smu_pg_init(rdev);
  229. }
  230. static void sumo_gfx_powergating_enable(struct radeon_device *rdev, bool enable)
  231. {
  232. if (enable)
  233. WREG32_P(CG_PWR_GATING_CNTL, DYN_PWR_DOWN_EN, ~DYN_PWR_DOWN_EN);
  234. else {
  235. WREG32_P(CG_PWR_GATING_CNTL, 0, ~DYN_PWR_DOWN_EN);
  236. RREG32(GB_ADDR_CONFIG);
  237. }
  238. }
  239. static int sumo_enable_clock_power_gating(struct radeon_device *rdev)
  240. {
  241. struct sumo_power_info *pi = sumo_get_pi(rdev);
  242. if (pi->enable_gfx_clock_gating)
  243. sumo_gfx_clockgating_initialize(rdev);
  244. if (pi->enable_gfx_power_gating)
  245. sumo_gfx_powergating_initialize(rdev);
  246. if (pi->enable_mg_clock_gating)
  247. sumo_mg_clockgating_enable(rdev, true);
  248. if (pi->enable_gfx_clock_gating)
  249. sumo_gfx_clockgating_enable(rdev, true);
  250. if (pi->enable_gfx_power_gating)
  251. sumo_gfx_powergating_enable(rdev, true);
  252. return 0;
  253. }
  254. static void sumo_disable_clock_power_gating(struct radeon_device *rdev)
  255. {
  256. struct sumo_power_info *pi = sumo_get_pi(rdev);
  257. if (pi->enable_gfx_clock_gating)
  258. sumo_gfx_clockgating_enable(rdev, false);
  259. if (pi->enable_gfx_power_gating)
  260. sumo_gfx_powergating_enable(rdev, false);
  261. if (pi->enable_mg_clock_gating)
  262. sumo_mg_clockgating_enable(rdev, false);
  263. }
  264. static void sumo_calculate_bsp(struct radeon_device *rdev,
  265. u32 high_clk)
  266. {
  267. struct sumo_power_info *pi = sumo_get_pi(rdev);
  268. u32 xclk = radeon_get_xclk(rdev);
  269. pi->pasi = 65535 * 100 / high_clk;
  270. pi->asi = 65535 * 100 / high_clk;
  271. r600_calculate_u_and_p(pi->asi,
  272. xclk, 16, &pi->bsp, &pi->bsu);
  273. r600_calculate_u_and_p(pi->pasi,
  274. xclk, 16, &pi->pbsp, &pi->pbsu);
  275. pi->dsp = BSP(pi->bsp) | BSU(pi->bsu);
  276. pi->psp = BSP(pi->pbsp) | BSU(pi->pbsu);
  277. }
  278. static void sumo_init_bsp(struct radeon_device *rdev)
  279. {
  280. struct sumo_power_info *pi = sumo_get_pi(rdev);
  281. WREG32(CG_BSP_0, pi->psp);
  282. }
  283. static void sumo_program_bsp(struct radeon_device *rdev,
  284. struct radeon_ps *rps)
  285. {
  286. struct sumo_power_info *pi = sumo_get_pi(rdev);
  287. struct sumo_ps *ps = sumo_get_ps(rps);
  288. u32 i;
  289. u32 highest_engine_clock = ps->levels[ps->num_levels - 1].sclk;
  290. if (ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE)
  291. highest_engine_clock = pi->boost_pl.sclk;
  292. sumo_calculate_bsp(rdev, highest_engine_clock);
  293. for (i = 0; i < ps->num_levels - 1; i++)
  294. WREG32(CG_BSP_0 + (i * 4), pi->dsp);
  295. WREG32(CG_BSP_0 + (i * 4), pi->psp);
  296. if (ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE)
  297. WREG32(CG_BSP_0 + (BOOST_DPM_LEVEL * 4), pi->psp);
  298. }
  299. static void sumo_write_at(struct radeon_device *rdev,
  300. u32 index, u32 value)
  301. {
  302. if (index == 0)
  303. WREG32(CG_AT_0, value);
  304. else if (index == 1)
  305. WREG32(CG_AT_1, value);
  306. else if (index == 2)
  307. WREG32(CG_AT_2, value);
  308. else if (index == 3)
  309. WREG32(CG_AT_3, value);
  310. else if (index == 4)
  311. WREG32(CG_AT_4, value);
  312. else if (index == 5)
  313. WREG32(CG_AT_5, value);
  314. else if (index == 6)
  315. WREG32(CG_AT_6, value);
  316. else if (index == 7)
  317. WREG32(CG_AT_7, value);
  318. }
  319. static void sumo_program_at(struct radeon_device *rdev,
  320. struct radeon_ps *rps)
  321. {
  322. struct sumo_power_info *pi = sumo_get_pi(rdev);
  323. struct sumo_ps *ps = sumo_get_ps(rps);
  324. u32 asi;
  325. u32 i;
  326. u32 m_a;
  327. u32 a_t;
  328. u32 r[SUMO_MAX_HARDWARE_POWERLEVELS];
  329. u32 l[SUMO_MAX_HARDWARE_POWERLEVELS];
  330. r[0] = SUMO_R_DFLT0;
  331. r[1] = SUMO_R_DFLT1;
  332. r[2] = SUMO_R_DFLT2;
  333. r[3] = SUMO_R_DFLT3;
  334. r[4] = SUMO_R_DFLT4;
  335. l[0] = SUMO_L_DFLT0;
  336. l[1] = SUMO_L_DFLT1;
  337. l[2] = SUMO_L_DFLT2;
  338. l[3] = SUMO_L_DFLT3;
  339. l[4] = SUMO_L_DFLT4;
  340. for (i = 0; i < ps->num_levels; i++) {
  341. asi = (i == ps->num_levels - 1) ? pi->pasi : pi->asi;
  342. m_a = asi * ps->levels[i].sclk / 100;
  343. a_t = CG_R(m_a * r[i] / 100) | CG_L(m_a * l[i] / 100);
  344. sumo_write_at(rdev, i, a_t);
  345. }
  346. if (ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE) {
  347. asi = pi->pasi;
  348. m_a = asi * pi->boost_pl.sclk / 100;
  349. a_t = CG_R(m_a * r[ps->num_levels - 1] / 100) |
  350. CG_L(m_a * l[ps->num_levels - 1] / 100);
  351. sumo_write_at(rdev, BOOST_DPM_LEVEL, a_t);
  352. }
  353. }
  354. static void sumo_program_tp(struct radeon_device *rdev)
  355. {
  356. int i;
  357. enum r600_td td = R600_TD_DFLT;
  358. for (i = 0; i < SUMO_PM_NUMBER_OF_TC; i++) {
  359. WREG32_P(CG_FFCT_0 + (i * 4), UTC_0(sumo_utc[i]), ~UTC_0_MASK);
  360. WREG32_P(CG_FFCT_0 + (i * 4), DTC_0(sumo_dtc[i]), ~DTC_0_MASK);
  361. }
  362. if (td == R600_TD_AUTO)
  363. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_FORCE_TREND_SEL);
  364. else
  365. WREG32_P(SCLK_PWRMGT_CNTL, FIR_FORCE_TREND_SEL, ~FIR_FORCE_TREND_SEL);
  366. if (td == R600_TD_UP)
  367. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_TREND_MODE);
  368. if (td == R600_TD_DOWN)
  369. WREG32_P(SCLK_PWRMGT_CNTL, FIR_TREND_MODE, ~FIR_TREND_MODE);
  370. }
  371. void sumo_program_vc(struct radeon_device *rdev, u32 vrc)
  372. {
  373. WREG32(CG_FTV, vrc);
  374. }
  375. void sumo_clear_vc(struct radeon_device *rdev)
  376. {
  377. WREG32(CG_FTV, 0);
  378. }
  379. void sumo_program_sstp(struct radeon_device *rdev)
  380. {
  381. u32 p, u;
  382. u32 xclk = radeon_get_xclk(rdev);
  383. r600_calculate_u_and_p(SUMO_SST_DFLT,
  384. xclk, 16, &p, &u);
  385. WREG32(CG_SSP, SSTU(u) | SST(p));
  386. }
  387. static void sumo_set_divider_value(struct radeon_device *rdev,
  388. u32 index, u32 divider)
  389. {
  390. u32 reg_index = index / 4;
  391. u32 field_index = index % 4;
  392. if (field_index == 0)
  393. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  394. SCLK_FSTATE_0_DIV(divider), ~SCLK_FSTATE_0_DIV_MASK);
  395. else if (field_index == 1)
  396. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  397. SCLK_FSTATE_1_DIV(divider), ~SCLK_FSTATE_1_DIV_MASK);
  398. else if (field_index == 2)
  399. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  400. SCLK_FSTATE_2_DIV(divider), ~SCLK_FSTATE_2_DIV_MASK);
  401. else if (field_index == 3)
  402. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  403. SCLK_FSTATE_3_DIV(divider), ~SCLK_FSTATE_3_DIV_MASK);
  404. }
  405. static void sumo_set_ds_dividers(struct radeon_device *rdev,
  406. u32 index, u32 divider)
  407. {
  408. struct sumo_power_info *pi = sumo_get_pi(rdev);
  409. if (pi->enable_sclk_ds) {
  410. u32 dpm_ctrl = RREG32(CG_SCLK_DPM_CTRL_6);
  411. dpm_ctrl &= ~(0x7 << (index * 3));
  412. dpm_ctrl |= (divider << (index * 3));
  413. WREG32(CG_SCLK_DPM_CTRL_6, dpm_ctrl);
  414. }
  415. }
  416. static void sumo_set_ss_dividers(struct radeon_device *rdev,
  417. u32 index, u32 divider)
  418. {
  419. struct sumo_power_info *pi = sumo_get_pi(rdev);
  420. if (pi->enable_sclk_ds) {
  421. u32 dpm_ctrl = RREG32(CG_SCLK_DPM_CTRL_11);
  422. dpm_ctrl &= ~(0x7 << (index * 3));
  423. dpm_ctrl |= (divider << (index * 3));
  424. WREG32(CG_SCLK_DPM_CTRL_11, dpm_ctrl);
  425. }
  426. }
  427. static void sumo_set_vid(struct radeon_device *rdev, u32 index, u32 vid)
  428. {
  429. u32 voltage_cntl = RREG32(CG_DPM_VOLTAGE_CNTL);
  430. voltage_cntl &= ~(DPM_STATE0_LEVEL_MASK << (index * 2));
  431. voltage_cntl |= (vid << (DPM_STATE0_LEVEL_SHIFT + index * 2));
  432. WREG32(CG_DPM_VOLTAGE_CNTL, voltage_cntl);
  433. }
  434. static void sumo_set_allos_gnb_slow(struct radeon_device *rdev, u32 index, u32 gnb_slow)
  435. {
  436. struct sumo_power_info *pi = sumo_get_pi(rdev);
  437. u32 temp = gnb_slow;
  438. u32 cg_sclk_dpm_ctrl_3;
  439. if (pi->driver_nbps_policy_disable)
  440. temp = 1;
  441. cg_sclk_dpm_ctrl_3 = RREG32(CG_SCLK_DPM_CTRL_3);
  442. cg_sclk_dpm_ctrl_3 &= ~(GNB_SLOW_FSTATE_0_MASK << index);
  443. cg_sclk_dpm_ctrl_3 |= (temp << (GNB_SLOW_FSTATE_0_SHIFT + index));
  444. WREG32(CG_SCLK_DPM_CTRL_3, cg_sclk_dpm_ctrl_3);
  445. }
  446. static void sumo_program_power_level(struct radeon_device *rdev,
  447. struct sumo_pl *pl, u32 index)
  448. {
  449. struct sumo_power_info *pi = sumo_get_pi(rdev);
  450. int ret;
  451. struct atom_clock_dividers dividers;
  452. u32 ds_en = RREG32(DEEP_SLEEP_CNTL) & ENABLE_DS;
  453. ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  454. pl->sclk, false, &dividers);
  455. if (ret)
  456. return;
  457. sumo_set_divider_value(rdev, index, dividers.post_div);
  458. sumo_set_vid(rdev, index, pl->vddc_index);
  459. if (pl->ss_divider_index == 0 || pl->ds_divider_index == 0) {
  460. if (ds_en)
  461. WREG32_P(DEEP_SLEEP_CNTL, 0, ~ENABLE_DS);
  462. } else {
  463. sumo_set_ss_dividers(rdev, index, pl->ss_divider_index);
  464. sumo_set_ds_dividers(rdev, index, pl->ds_divider_index);
  465. if (!ds_en)
  466. WREG32_P(DEEP_SLEEP_CNTL, ENABLE_DS, ~ENABLE_DS);
  467. }
  468. sumo_set_allos_gnb_slow(rdev, index, pl->allow_gnb_slow);
  469. if (pi->enable_boost)
  470. sumo_set_tdp_limit(rdev, index, pl->sclk_dpm_tdp_limit);
  471. }
  472. static void sumo_power_level_enable(struct radeon_device *rdev, u32 index, bool enable)
  473. {
  474. u32 reg_index = index / 4;
  475. u32 field_index = index % 4;
  476. if (field_index == 0)
  477. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  478. enable ? SCLK_FSTATE_0_VLD : 0, ~SCLK_FSTATE_0_VLD);
  479. else if (field_index == 1)
  480. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  481. enable ? SCLK_FSTATE_1_VLD : 0, ~SCLK_FSTATE_1_VLD);
  482. else if (field_index == 2)
  483. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  484. enable ? SCLK_FSTATE_2_VLD : 0, ~SCLK_FSTATE_2_VLD);
  485. else if (field_index == 3)
  486. WREG32_P(CG_SCLK_DPM_CTRL + (reg_index * 4),
  487. enable ? SCLK_FSTATE_3_VLD : 0, ~SCLK_FSTATE_3_VLD);
  488. }
  489. static bool sumo_dpm_enabled(struct radeon_device *rdev)
  490. {
  491. if (RREG32(CG_SCLK_DPM_CTRL_3) & DPM_SCLK_ENABLE)
  492. return true;
  493. else
  494. return false;
  495. }
  496. static void sumo_start_dpm(struct radeon_device *rdev)
  497. {
  498. WREG32_P(CG_SCLK_DPM_CTRL_3, DPM_SCLK_ENABLE, ~DPM_SCLK_ENABLE);
  499. }
  500. static void sumo_stop_dpm(struct radeon_device *rdev)
  501. {
  502. WREG32_P(CG_SCLK_DPM_CTRL_3, 0, ~DPM_SCLK_ENABLE);
  503. }
  504. static void sumo_set_forced_mode(struct radeon_device *rdev, bool enable)
  505. {
  506. if (enable)
  507. WREG32_P(CG_SCLK_DPM_CTRL_3, FORCE_SCLK_STATE_EN, ~FORCE_SCLK_STATE_EN);
  508. else
  509. WREG32_P(CG_SCLK_DPM_CTRL_3, 0, ~FORCE_SCLK_STATE_EN);
  510. }
  511. static void sumo_set_forced_mode_enabled(struct radeon_device *rdev)
  512. {
  513. int i;
  514. sumo_set_forced_mode(rdev, true);
  515. for (i = 0; i < rdev->usec_timeout; i++) {
  516. if (RREG32(CG_SCLK_STATUS) & SCLK_OVERCLK_DETECT)
  517. break;
  518. udelay(1);
  519. }
  520. }
  521. static void sumo_wait_for_level_0(struct radeon_device *rdev)
  522. {
  523. int i;
  524. for (i = 0; i < rdev->usec_timeout; i++) {
  525. if ((RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURR_SCLK_INDEX_MASK) == 0)
  526. break;
  527. udelay(1);
  528. }
  529. for (i = 0; i < rdev->usec_timeout; i++) {
  530. if ((RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURR_INDEX_MASK) == 0)
  531. break;
  532. udelay(1);
  533. }
  534. }
  535. static void sumo_set_forced_mode_disabled(struct radeon_device *rdev)
  536. {
  537. sumo_set_forced_mode(rdev, false);
  538. }
  539. static void sumo_enable_power_level_0(struct radeon_device *rdev)
  540. {
  541. sumo_power_level_enable(rdev, 0, true);
  542. }
  543. static void sumo_patch_boost_state(struct radeon_device *rdev,
  544. struct radeon_ps *rps)
  545. {
  546. struct sumo_power_info *pi = sumo_get_pi(rdev);
  547. struct sumo_ps *new_ps = sumo_get_ps(rps);
  548. if (new_ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE) {
  549. pi->boost_pl = new_ps->levels[new_ps->num_levels - 1];
  550. pi->boost_pl.sclk = pi->sys_info.boost_sclk;
  551. pi->boost_pl.vddc_index = pi->sys_info.boost_vid_2bit;
  552. pi->boost_pl.sclk_dpm_tdp_limit = pi->sys_info.sclk_dpm_tdp_limit_boost;
  553. }
  554. }
  555. static void sumo_pre_notify_alt_vddnb_change(struct radeon_device *rdev,
  556. struct radeon_ps *new_rps,
  557. struct radeon_ps *old_rps)
  558. {
  559. struct sumo_ps *new_ps = sumo_get_ps(new_rps);
  560. struct sumo_ps *old_ps = sumo_get_ps(old_rps);
  561. u32 nbps1_old = 0;
  562. u32 nbps1_new = 0;
  563. if (old_ps != NULL)
  564. nbps1_old = (old_ps->flags & SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE) ? 1 : 0;
  565. nbps1_new = (new_ps->flags & SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE) ? 1 : 0;
  566. if (nbps1_old == 1 && nbps1_new == 0)
  567. sumo_smu_notify_alt_vddnb_change(rdev, 0, 0);
  568. }
  569. static void sumo_post_notify_alt_vddnb_change(struct radeon_device *rdev,
  570. struct radeon_ps *new_rps,
  571. struct radeon_ps *old_rps)
  572. {
  573. struct sumo_ps *new_ps = sumo_get_ps(new_rps);
  574. struct sumo_ps *old_ps = sumo_get_ps(old_rps);
  575. u32 nbps1_old = 0;
  576. u32 nbps1_new = 0;
  577. if (old_ps != NULL)
  578. nbps1_old = (old_ps->flags & SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE)? 1 : 0;
  579. nbps1_new = (new_ps->flags & SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE)? 1 : 0;
  580. if (nbps1_old == 0 && nbps1_new == 1)
  581. sumo_smu_notify_alt_vddnb_change(rdev, 1, 1);
  582. }
  583. static void sumo_enable_boost(struct radeon_device *rdev,
  584. struct radeon_ps *rps,
  585. bool enable)
  586. {
  587. struct sumo_ps *new_ps = sumo_get_ps(rps);
  588. if (enable) {
  589. if (new_ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE)
  590. sumo_boost_state_enable(rdev, true);
  591. } else
  592. sumo_boost_state_enable(rdev, false);
  593. }
  594. static void sumo_set_forced_level(struct radeon_device *rdev, u32 index)
  595. {
  596. WREG32_P(CG_SCLK_DPM_CTRL_3, FORCE_SCLK_STATE(index), ~FORCE_SCLK_STATE_MASK);
  597. }
  598. static void sumo_set_forced_level_0(struct radeon_device *rdev)
  599. {
  600. sumo_set_forced_level(rdev, 0);
  601. }
  602. static void sumo_program_wl(struct radeon_device *rdev,
  603. struct radeon_ps *rps)
  604. {
  605. struct sumo_ps *new_ps = sumo_get_ps(rps);
  606. u32 dpm_ctrl4 = RREG32(CG_SCLK_DPM_CTRL_4);
  607. dpm_ctrl4 &= 0xFFFFFF00;
  608. dpm_ctrl4 |= (1 << (new_ps->num_levels - 1));
  609. if (new_ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE)
  610. dpm_ctrl4 |= (1 << BOOST_DPM_LEVEL);
  611. WREG32(CG_SCLK_DPM_CTRL_4, dpm_ctrl4);
  612. }
  613. static void sumo_program_power_levels_0_to_n(struct radeon_device *rdev,
  614. struct radeon_ps *new_rps,
  615. struct radeon_ps *old_rps)
  616. {
  617. struct sumo_power_info *pi = sumo_get_pi(rdev);
  618. struct sumo_ps *new_ps = sumo_get_ps(new_rps);
  619. struct sumo_ps *old_ps = sumo_get_ps(old_rps);
  620. u32 i;
  621. u32 n_current_state_levels = (old_ps == NULL) ? 1 : old_ps->num_levels;
  622. for (i = 0; i < new_ps->num_levels; i++) {
  623. sumo_program_power_level(rdev, &new_ps->levels[i], i);
  624. sumo_power_level_enable(rdev, i, true);
  625. }
  626. for (i = new_ps->num_levels; i < n_current_state_levels; i++)
  627. sumo_power_level_enable(rdev, i, false);
  628. if (new_ps->flags & SUMO_POWERSTATE_FLAGS_BOOST_STATE)
  629. sumo_program_power_level(rdev, &pi->boost_pl, BOOST_DPM_LEVEL);
  630. }
  631. static void sumo_enable_acpi_pm(struct radeon_device *rdev)
  632. {
  633. WREG32_P(GENERAL_PWRMGT, STATIC_PM_EN, ~STATIC_PM_EN);
  634. }
  635. static void sumo_program_power_level_enter_state(struct radeon_device *rdev)
  636. {
  637. WREG32_P(CG_SCLK_DPM_CTRL_5, SCLK_FSTATE_BOOTUP(0), ~SCLK_FSTATE_BOOTUP_MASK);
  638. }
  639. static void sumo_program_acpi_power_level(struct radeon_device *rdev)
  640. {
  641. struct sumo_power_info *pi = sumo_get_pi(rdev);
  642. struct atom_clock_dividers dividers;
  643. int ret;
  644. ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  645. pi->acpi_pl.sclk,
  646. false, &dividers);
  647. if (ret)
  648. return;
  649. WREG32_P(CG_ACPI_CNTL, SCLK_ACPI_DIV(dividers.post_div), ~SCLK_ACPI_DIV_MASK);
  650. WREG32_P(CG_ACPI_VOLTAGE_CNTL, 0, ~ACPI_VOLTAGE_EN);
  651. }
  652. static void sumo_program_bootup_state(struct radeon_device *rdev)
  653. {
  654. struct sumo_power_info *pi = sumo_get_pi(rdev);
  655. u32 dpm_ctrl4 = RREG32(CG_SCLK_DPM_CTRL_4);
  656. u32 i;
  657. sumo_program_power_level(rdev, &pi->boot_pl, 0);
  658. dpm_ctrl4 &= 0xFFFFFF00;
  659. WREG32(CG_SCLK_DPM_CTRL_4, dpm_ctrl4);
  660. for (i = 1; i < 8; i++)
  661. sumo_power_level_enable(rdev, i, false);
  662. }
  663. static void sumo_setup_uvd_clocks(struct radeon_device *rdev,
  664. struct radeon_ps *new_rps,
  665. struct radeon_ps *old_rps)
  666. {
  667. struct sumo_power_info *pi = sumo_get_pi(rdev);
  668. if (pi->enable_gfx_power_gating) {
  669. sumo_gfx_powergating_enable(rdev, false);
  670. }
  671. radeon_set_uvd_clocks(rdev, new_rps->vclk, new_rps->dclk);
  672. if (pi->enable_gfx_power_gating) {
  673. sumo_gfx_powergating_enable(rdev, true);
  674. }
  675. }
  676. static void sumo_set_uvd_clock_before_set_eng_clock(struct radeon_device *rdev,
  677. struct radeon_ps *new_rps,
  678. struct radeon_ps *old_rps)
  679. {
  680. struct sumo_ps *new_ps = sumo_get_ps(new_rps);
  681. struct sumo_ps *current_ps = sumo_get_ps(old_rps);
  682. if ((new_rps->vclk == old_rps->vclk) &&
  683. (new_rps->dclk == old_rps->dclk))
  684. return;
  685. if (new_ps->levels[new_ps->num_levels - 1].sclk >=
  686. current_ps->levels[current_ps->num_levels - 1].sclk)
  687. return;
  688. sumo_setup_uvd_clocks(rdev, new_rps, old_rps);
  689. }
  690. static void sumo_set_uvd_clock_after_set_eng_clock(struct radeon_device *rdev,
  691. struct radeon_ps *new_rps,
  692. struct radeon_ps *old_rps)
  693. {
  694. struct sumo_ps *new_ps = sumo_get_ps(new_rps);
  695. struct sumo_ps *current_ps = sumo_get_ps(old_rps);
  696. if ((new_rps->vclk == old_rps->vclk) &&
  697. (new_rps->dclk == old_rps->dclk))
  698. return;
  699. if (new_ps->levels[new_ps->num_levels - 1].sclk <
  700. current_ps->levels[current_ps->num_levels - 1].sclk)
  701. return;
  702. sumo_setup_uvd_clocks(rdev, new_rps, old_rps);
  703. }
  704. void sumo_take_smu_control(struct radeon_device *rdev, bool enable)
  705. {
  706. /* This bit selects who handles display phy powergating.
  707. * Clear the bit to let atom handle it.
  708. * Set it to let the driver handle it.
  709. * For now we just let atom handle it.
  710. */
  711. #if 0
  712. u32 v = RREG32(DOUT_SCRATCH3);
  713. if (enable)
  714. v |= 0x4;
  715. else
  716. v &= 0xFFFFFFFB;
  717. WREG32(DOUT_SCRATCH3, v);
  718. #endif
  719. }
  720. static void sumo_enable_sclk_ds(struct radeon_device *rdev, bool enable)
  721. {
  722. if (enable) {
  723. u32 deep_sleep_cntl = RREG32(DEEP_SLEEP_CNTL);
  724. u32 deep_sleep_cntl2 = RREG32(DEEP_SLEEP_CNTL2);
  725. u32 t = 1;
  726. deep_sleep_cntl &= ~R_DIS;
  727. deep_sleep_cntl &= ~HS_MASK;
  728. deep_sleep_cntl |= HS(t > 4095 ? 4095 : t);
  729. deep_sleep_cntl2 |= LB_UFP_EN;
  730. deep_sleep_cntl2 &= INOUT_C_MASK;
  731. deep_sleep_cntl2 |= INOUT_C(0xf);
  732. WREG32(DEEP_SLEEP_CNTL2, deep_sleep_cntl2);
  733. WREG32(DEEP_SLEEP_CNTL, deep_sleep_cntl);
  734. } else
  735. WREG32_P(DEEP_SLEEP_CNTL, 0, ~ENABLE_DS);
  736. }
  737. static void sumo_program_bootup_at(struct radeon_device *rdev)
  738. {
  739. WREG32_P(CG_AT_0, CG_R(0xffff), ~CG_R_MASK);
  740. WREG32_P(CG_AT_0, CG_L(0), ~CG_L_MASK);
  741. }
  742. static void sumo_reset_am(struct radeon_device *rdev)
  743. {
  744. WREG32_P(SCLK_PWRMGT_CNTL, FIR_RESET, ~FIR_RESET);
  745. }
  746. static void sumo_start_am(struct radeon_device *rdev)
  747. {
  748. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_RESET);
  749. }
  750. static void sumo_program_ttp(struct radeon_device *rdev)
  751. {
  752. u32 xclk = radeon_get_xclk(rdev);
  753. u32 p, u;
  754. u32 cg_sclk_dpm_ctrl_5 = RREG32(CG_SCLK_DPM_CTRL_5);
  755. r600_calculate_u_and_p(1000,
  756. xclk, 16, &p, &u);
  757. cg_sclk_dpm_ctrl_5 &= ~(TT_TP_MASK | TT_TU_MASK);
  758. cg_sclk_dpm_ctrl_5 |= TT_TP(p) | TT_TU(u);
  759. WREG32(CG_SCLK_DPM_CTRL_5, cg_sclk_dpm_ctrl_5);
  760. }
  761. static void sumo_program_ttt(struct radeon_device *rdev)
  762. {
  763. u32 cg_sclk_dpm_ctrl_3 = RREG32(CG_SCLK_DPM_CTRL_3);
  764. struct sumo_power_info *pi = sumo_get_pi(rdev);
  765. cg_sclk_dpm_ctrl_3 &= ~(GNB_TT_MASK | GNB_THERMTHRO_MASK);
  766. cg_sclk_dpm_ctrl_3 |= GNB_TT(pi->thermal_auto_throttling + 49);
  767. WREG32(CG_SCLK_DPM_CTRL_3, cg_sclk_dpm_ctrl_3);
  768. }
  769. static void sumo_enable_voltage_scaling(struct radeon_device *rdev, bool enable)
  770. {
  771. if (enable) {
  772. WREG32_P(CG_DPM_VOLTAGE_CNTL, DPM_VOLTAGE_EN, ~DPM_VOLTAGE_EN);
  773. WREG32_P(CG_CG_VOLTAGE_CNTL, 0, ~CG_VOLTAGE_EN);
  774. } else {
  775. WREG32_P(CG_CG_VOLTAGE_CNTL, CG_VOLTAGE_EN, ~CG_VOLTAGE_EN);
  776. WREG32_P(CG_DPM_VOLTAGE_CNTL, 0, ~DPM_VOLTAGE_EN);
  777. }
  778. }
  779. static void sumo_override_cnb_thermal_events(struct radeon_device *rdev)
  780. {
  781. WREG32_P(CG_SCLK_DPM_CTRL_3, CNB_THERMTHRO_MASK_SCLK,
  782. ~CNB_THERMTHRO_MASK_SCLK);
  783. }
  784. static void sumo_program_dc_hto(struct radeon_device *rdev)
  785. {
  786. u32 cg_sclk_dpm_ctrl_4 = RREG32(CG_SCLK_DPM_CTRL_4);
  787. u32 p, u;
  788. u32 xclk = radeon_get_xclk(rdev);
  789. r600_calculate_u_and_p(100000,
  790. xclk, 14, &p, &u);
  791. cg_sclk_dpm_ctrl_4 &= ~(DC_HDC_MASK | DC_HU_MASK);
  792. cg_sclk_dpm_ctrl_4 |= DC_HDC(p) | DC_HU(u);
  793. WREG32(CG_SCLK_DPM_CTRL_4, cg_sclk_dpm_ctrl_4);
  794. }
  795. static void sumo_force_nbp_state(struct radeon_device *rdev,
  796. struct radeon_ps *rps)
  797. {
  798. struct sumo_power_info *pi = sumo_get_pi(rdev);
  799. struct sumo_ps *new_ps = sumo_get_ps(rps);
  800. if (!pi->driver_nbps_policy_disable) {
  801. if (new_ps->flags & SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE)
  802. WREG32_P(CG_SCLK_DPM_CTRL_3, FORCE_NB_PSTATE_1, ~FORCE_NB_PSTATE_1);
  803. else
  804. WREG32_P(CG_SCLK_DPM_CTRL_3, 0, ~FORCE_NB_PSTATE_1);
  805. }
  806. }
  807. u32 sumo_get_sleep_divider_from_id(u32 id)
  808. {
  809. return 1 << id;
  810. }
  811. u32 sumo_get_sleep_divider_id_from_clock(struct radeon_device *rdev,
  812. u32 sclk,
  813. u32 min_sclk_in_sr)
  814. {
  815. struct sumo_power_info *pi = sumo_get_pi(rdev);
  816. u32 i;
  817. u32 temp;
  818. u32 min = (min_sclk_in_sr > SUMO_MINIMUM_ENGINE_CLOCK) ?
  819. min_sclk_in_sr : SUMO_MINIMUM_ENGINE_CLOCK;
  820. if (sclk < min)
  821. return 0;
  822. if (!pi->enable_sclk_ds)
  823. return 0;
  824. for (i = SUMO_MAX_DEEPSLEEP_DIVIDER_ID; ; i--) {
  825. temp = sclk / sumo_get_sleep_divider_from_id(i);
  826. if (temp >= min || i == 0)
  827. break;
  828. }
  829. return i;
  830. }
  831. static u32 sumo_get_valid_engine_clock(struct radeon_device *rdev,
  832. u32 lower_limit)
  833. {
  834. struct sumo_power_info *pi = sumo_get_pi(rdev);
  835. u32 i;
  836. for (i = 0; i < pi->sys_info.sclk_voltage_mapping_table.num_max_dpm_entries; i++) {
  837. if (pi->sys_info.sclk_voltage_mapping_table.entries[i].sclk_frequency >= lower_limit)
  838. return pi->sys_info.sclk_voltage_mapping_table.entries[i].sclk_frequency;
  839. }
  840. return pi->sys_info.sclk_voltage_mapping_table.entries[pi->sys_info.sclk_voltage_mapping_table.num_max_dpm_entries - 1].sclk_frequency;
  841. }
  842. static void sumo_patch_thermal_state(struct radeon_device *rdev,
  843. struct sumo_ps *ps,
  844. struct sumo_ps *current_ps)
  845. {
  846. struct sumo_power_info *pi = sumo_get_pi(rdev);
  847. u32 sclk_in_sr = pi->sys_info.min_sclk; /* ??? */
  848. u32 current_vddc;
  849. u32 current_sclk;
  850. u32 current_index = 0;
  851. if (current_ps) {
  852. current_vddc = current_ps->levels[current_index].vddc_index;
  853. current_sclk = current_ps->levels[current_index].sclk;
  854. } else {
  855. current_vddc = pi->boot_pl.vddc_index;
  856. current_sclk = pi->boot_pl.sclk;
  857. }
  858. ps->levels[0].vddc_index = current_vddc;
  859. if (ps->levels[0].sclk > current_sclk)
  860. ps->levels[0].sclk = current_sclk;
  861. ps->levels[0].ss_divider_index =
  862. sumo_get_sleep_divider_id_from_clock(rdev, ps->levels[0].sclk, sclk_in_sr);
  863. ps->levels[0].ds_divider_index =
  864. sumo_get_sleep_divider_id_from_clock(rdev, ps->levels[0].sclk, SUMO_MINIMUM_ENGINE_CLOCK);
  865. if (ps->levels[0].ds_divider_index > ps->levels[0].ss_divider_index + 1)
  866. ps->levels[0].ds_divider_index = ps->levels[0].ss_divider_index + 1;
  867. if (ps->levels[0].ss_divider_index == ps->levels[0].ds_divider_index) {
  868. if (ps->levels[0].ss_divider_index > 1)
  869. ps->levels[0].ss_divider_index = ps->levels[0].ss_divider_index - 1;
  870. }
  871. if (ps->levels[0].ss_divider_index == 0)
  872. ps->levels[0].ds_divider_index = 0;
  873. if (ps->levels[0].ds_divider_index == 0)
  874. ps->levels[0].ss_divider_index = 0;
  875. }
  876. static void sumo_apply_state_adjust_rules(struct radeon_device *rdev,
  877. struct radeon_ps *new_rps,
  878. struct radeon_ps *old_rps)
  879. {
  880. struct sumo_ps *ps = sumo_get_ps(new_rps);
  881. struct sumo_ps *current_ps = sumo_get_ps(old_rps);
  882. struct sumo_power_info *pi = sumo_get_pi(rdev);
  883. u32 min_voltage = 0; /* ??? */
  884. u32 min_sclk = pi->sys_info.min_sclk; /* XXX check against disp reqs */
  885. u32 sclk_in_sr = pi->sys_info.min_sclk; /* ??? */
  886. u32 i;
  887. if (new_rps->class & ATOM_PPLIB_CLASSIFICATION_THERMAL)
  888. return sumo_patch_thermal_state(rdev, ps, current_ps);
  889. if (pi->enable_boost) {
  890. if (new_rps->class & ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE)
  891. ps->flags |= SUMO_POWERSTATE_FLAGS_BOOST_STATE;
  892. }
  893. if ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_UI_BATTERY) ||
  894. (new_rps->class & ATOM_PPLIB_CLASSIFICATION_SDSTATE) ||
  895. (new_rps->class & ATOM_PPLIB_CLASSIFICATION_HDSTATE))
  896. ps->flags |= SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE;
  897. for (i = 0; i < ps->num_levels; i++) {
  898. if (ps->levels[i].vddc_index < min_voltage)
  899. ps->levels[i].vddc_index = min_voltage;
  900. if (ps->levels[i].sclk < min_sclk)
  901. ps->levels[i].sclk =
  902. sumo_get_valid_engine_clock(rdev, min_sclk);
  903. ps->levels[i].ss_divider_index =
  904. sumo_get_sleep_divider_id_from_clock(rdev, ps->levels[i].sclk, sclk_in_sr);
  905. ps->levels[i].ds_divider_index =
  906. sumo_get_sleep_divider_id_from_clock(rdev, ps->levels[i].sclk, SUMO_MINIMUM_ENGINE_CLOCK);
  907. if (ps->levels[i].ds_divider_index > ps->levels[i].ss_divider_index + 1)
  908. ps->levels[i].ds_divider_index = ps->levels[i].ss_divider_index + 1;
  909. if (ps->levels[i].ss_divider_index == ps->levels[i].ds_divider_index) {
  910. if (ps->levels[i].ss_divider_index > 1)
  911. ps->levels[i].ss_divider_index = ps->levels[i].ss_divider_index - 1;
  912. }
  913. if (ps->levels[i].ss_divider_index == 0)
  914. ps->levels[i].ds_divider_index = 0;
  915. if (ps->levels[i].ds_divider_index == 0)
  916. ps->levels[i].ss_divider_index = 0;
  917. if (ps->flags & SUMO_POWERSTATE_FLAGS_FORCE_NBPS1_STATE)
  918. ps->levels[i].allow_gnb_slow = 1;
  919. else if ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE) ||
  920. (new_rps->class2 & ATOM_PPLIB_CLASSIFICATION2_MVC))
  921. ps->levels[i].allow_gnb_slow = 0;
  922. else if (i == ps->num_levels - 1)
  923. ps->levels[i].allow_gnb_slow = 0;
  924. else
  925. ps->levels[i].allow_gnb_slow = 1;
  926. }
  927. }
  928. static void sumo_cleanup_asic(struct radeon_device *rdev)
  929. {
  930. sumo_take_smu_control(rdev, false);
  931. }
  932. static int sumo_set_thermal_temperature_range(struct radeon_device *rdev,
  933. int min_temp, int max_temp)
  934. {
  935. int low_temp = 0 * 1000;
  936. int high_temp = 255 * 1000;
  937. if (low_temp < min_temp)
  938. low_temp = min_temp;
  939. if (high_temp > max_temp)
  940. high_temp = max_temp;
  941. if (high_temp < low_temp) {
  942. DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
  943. return -EINVAL;
  944. }
  945. WREG32_P(CG_THERMAL_INT, DIG_THERM_INTH(49 + (high_temp / 1000)), ~DIG_THERM_INTH_MASK);
  946. WREG32_P(CG_THERMAL_INT, DIG_THERM_INTL(49 + (low_temp / 1000)), ~DIG_THERM_INTL_MASK);
  947. rdev->pm.dpm.thermal.min_temp = low_temp;
  948. rdev->pm.dpm.thermal.max_temp = high_temp;
  949. return 0;
  950. }
  951. static void sumo_update_current_ps(struct radeon_device *rdev,
  952. struct radeon_ps *rps)
  953. {
  954. struct sumo_ps *new_ps = sumo_get_ps(rps);
  955. struct sumo_power_info *pi = sumo_get_pi(rdev);
  956. pi->current_rps = *rps;
  957. pi->current_ps = *new_ps;
  958. pi->current_rps.ps_priv = &pi->current_ps;
  959. }
  960. static void sumo_update_requested_ps(struct radeon_device *rdev,
  961. struct radeon_ps *rps)
  962. {
  963. struct sumo_ps *new_ps = sumo_get_ps(rps);
  964. struct sumo_power_info *pi = sumo_get_pi(rdev);
  965. pi->requested_rps = *rps;
  966. pi->requested_ps = *new_ps;
  967. pi->requested_rps.ps_priv = &pi->requested_ps;
  968. }
  969. int sumo_dpm_enable(struct radeon_device *rdev)
  970. {
  971. struct sumo_power_info *pi = sumo_get_pi(rdev);
  972. int ret;
  973. if (sumo_dpm_enabled(rdev))
  974. return -EINVAL;
  975. ret = sumo_enable_clock_power_gating(rdev);
  976. if (ret)
  977. return ret;
  978. sumo_program_bootup_state(rdev);
  979. sumo_init_bsp(rdev);
  980. sumo_reset_am(rdev);
  981. sumo_program_tp(rdev);
  982. sumo_program_bootup_at(rdev);
  983. sumo_start_am(rdev);
  984. if (pi->enable_auto_thermal_throttling) {
  985. sumo_program_ttp(rdev);
  986. sumo_program_ttt(rdev);
  987. }
  988. sumo_program_dc_hto(rdev);
  989. sumo_program_power_level_enter_state(rdev);
  990. sumo_enable_voltage_scaling(rdev, true);
  991. sumo_program_sstp(rdev);
  992. sumo_program_vc(rdev, SUMO_VRC_DFLT);
  993. sumo_override_cnb_thermal_events(rdev);
  994. sumo_start_dpm(rdev);
  995. sumo_wait_for_level_0(rdev);
  996. if (pi->enable_sclk_ds)
  997. sumo_enable_sclk_ds(rdev, true);
  998. if (pi->enable_boost)
  999. sumo_enable_boost_timer(rdev);
  1000. if (rdev->irq.installed &&
  1001. r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  1002. ret = sumo_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
  1003. if (ret)
  1004. return ret;
  1005. rdev->irq.dpm_thermal = true;
  1006. radeon_irq_set(rdev);
  1007. }
  1008. sumo_update_current_ps(rdev, rdev->pm.dpm.boot_ps);
  1009. return 0;
  1010. }
  1011. void sumo_dpm_disable(struct radeon_device *rdev)
  1012. {
  1013. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1014. if (!sumo_dpm_enabled(rdev))
  1015. return;
  1016. sumo_disable_clock_power_gating(rdev);
  1017. if (pi->enable_sclk_ds)
  1018. sumo_enable_sclk_ds(rdev, false);
  1019. sumo_clear_vc(rdev);
  1020. sumo_wait_for_level_0(rdev);
  1021. sumo_stop_dpm(rdev);
  1022. sumo_enable_voltage_scaling(rdev, false);
  1023. if (rdev->irq.installed &&
  1024. r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  1025. rdev->irq.dpm_thermal = false;
  1026. radeon_irq_set(rdev);
  1027. }
  1028. sumo_update_current_ps(rdev, rdev->pm.dpm.boot_ps);
  1029. }
  1030. int sumo_dpm_pre_set_power_state(struct radeon_device *rdev)
  1031. {
  1032. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1033. struct radeon_ps requested_ps = *rdev->pm.dpm.requested_ps;
  1034. struct radeon_ps *new_ps = &requested_ps;
  1035. sumo_update_requested_ps(rdev, new_ps);
  1036. if (pi->enable_dynamic_patch_ps)
  1037. sumo_apply_state_adjust_rules(rdev,
  1038. &pi->requested_rps,
  1039. &pi->current_rps);
  1040. return 0;
  1041. }
  1042. int sumo_dpm_set_power_state(struct radeon_device *rdev)
  1043. {
  1044. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1045. struct radeon_ps *new_ps = &pi->requested_rps;
  1046. struct radeon_ps *old_ps = &pi->current_rps;
  1047. if (pi->enable_dpm)
  1048. sumo_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
  1049. if (pi->enable_boost) {
  1050. sumo_enable_boost(rdev, new_ps, false);
  1051. sumo_patch_boost_state(rdev, new_ps);
  1052. }
  1053. if (pi->enable_dpm) {
  1054. sumo_pre_notify_alt_vddnb_change(rdev, new_ps, old_ps);
  1055. sumo_enable_power_level_0(rdev);
  1056. sumo_set_forced_level_0(rdev);
  1057. sumo_set_forced_mode_enabled(rdev);
  1058. sumo_wait_for_level_0(rdev);
  1059. sumo_program_power_levels_0_to_n(rdev, new_ps, old_ps);
  1060. sumo_program_wl(rdev, new_ps);
  1061. sumo_program_bsp(rdev, new_ps);
  1062. sumo_program_at(rdev, new_ps);
  1063. sumo_force_nbp_state(rdev, new_ps);
  1064. sumo_set_forced_mode_disabled(rdev);
  1065. sumo_set_forced_mode_enabled(rdev);
  1066. sumo_set_forced_mode_disabled(rdev);
  1067. sumo_post_notify_alt_vddnb_change(rdev, new_ps, old_ps);
  1068. }
  1069. if (pi->enable_boost)
  1070. sumo_enable_boost(rdev, new_ps, true);
  1071. if (pi->enable_dpm)
  1072. sumo_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
  1073. return 0;
  1074. }
  1075. void sumo_dpm_post_set_power_state(struct radeon_device *rdev)
  1076. {
  1077. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1078. struct radeon_ps *new_ps = &pi->requested_rps;
  1079. sumo_update_current_ps(rdev, new_ps);
  1080. }
  1081. void sumo_dpm_reset_asic(struct radeon_device *rdev)
  1082. {
  1083. sumo_program_bootup_state(rdev);
  1084. sumo_enable_power_level_0(rdev);
  1085. sumo_set_forced_level_0(rdev);
  1086. sumo_set_forced_mode_enabled(rdev);
  1087. sumo_wait_for_level_0(rdev);
  1088. sumo_set_forced_mode_disabled(rdev);
  1089. sumo_set_forced_mode_enabled(rdev);
  1090. sumo_set_forced_mode_disabled(rdev);
  1091. }
  1092. void sumo_dpm_setup_asic(struct radeon_device *rdev)
  1093. {
  1094. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1095. sumo_initialize_m3_arb(rdev);
  1096. pi->fw_version = sumo_get_running_fw_version(rdev);
  1097. DRM_INFO("Found smc ucode version: 0x%08x\n", pi->fw_version);
  1098. sumo_program_acpi_power_level(rdev);
  1099. sumo_enable_acpi_pm(rdev);
  1100. sumo_take_smu_control(rdev, true);
  1101. }
  1102. void sumo_dpm_display_configuration_changed(struct radeon_device *rdev)
  1103. {
  1104. }
  1105. union power_info {
  1106. struct _ATOM_POWERPLAY_INFO info;
  1107. struct _ATOM_POWERPLAY_INFO_V2 info_2;
  1108. struct _ATOM_POWERPLAY_INFO_V3 info_3;
  1109. struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
  1110. struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
  1111. struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
  1112. };
  1113. union pplib_clock_info {
  1114. struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
  1115. struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
  1116. struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
  1117. struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
  1118. };
  1119. union pplib_power_state {
  1120. struct _ATOM_PPLIB_STATE v1;
  1121. struct _ATOM_PPLIB_STATE_V2 v2;
  1122. };
  1123. static void sumo_patch_boot_state(struct radeon_device *rdev,
  1124. struct sumo_ps *ps)
  1125. {
  1126. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1127. ps->num_levels = 1;
  1128. ps->flags = 0;
  1129. ps->levels[0] = pi->boot_pl;
  1130. }
  1131. static void sumo_parse_pplib_non_clock_info(struct radeon_device *rdev,
  1132. struct radeon_ps *rps,
  1133. struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
  1134. u8 table_rev)
  1135. {
  1136. struct sumo_ps *ps = sumo_get_ps(rps);
  1137. rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
  1138. rps->class = le16_to_cpu(non_clock_info->usClassification);
  1139. rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
  1140. if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
  1141. rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
  1142. rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
  1143. } else {
  1144. rps->vclk = 0;
  1145. rps->dclk = 0;
  1146. }
  1147. if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
  1148. rdev->pm.dpm.boot_ps = rps;
  1149. sumo_patch_boot_state(rdev, ps);
  1150. }
  1151. if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
  1152. rdev->pm.dpm.uvd_ps = rps;
  1153. }
  1154. static void sumo_parse_pplib_clock_info(struct radeon_device *rdev,
  1155. struct radeon_ps *rps, int index,
  1156. union pplib_clock_info *clock_info)
  1157. {
  1158. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1159. struct sumo_ps *ps = sumo_get_ps(rps);
  1160. struct sumo_pl *pl = &ps->levels[index];
  1161. u32 sclk;
  1162. sclk = le16_to_cpu(clock_info->sumo.usEngineClockLow);
  1163. sclk |= clock_info->sumo.ucEngineClockHigh << 16;
  1164. pl->sclk = sclk;
  1165. pl->vddc_index = clock_info->sumo.vddcIndex;
  1166. pl->sclk_dpm_tdp_limit = clock_info->sumo.tdpLimit;
  1167. ps->num_levels = index + 1;
  1168. if (pi->enable_sclk_ds) {
  1169. pl->ds_divider_index = 5;
  1170. pl->ss_divider_index = 4;
  1171. }
  1172. }
  1173. static int sumo_parse_power_table(struct radeon_device *rdev)
  1174. {
  1175. struct radeon_mode_info *mode_info = &rdev->mode_info;
  1176. struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
  1177. union pplib_power_state *power_state;
  1178. int i, j, k, non_clock_array_index, clock_array_index;
  1179. union pplib_clock_info *clock_info;
  1180. struct _StateArray *state_array;
  1181. struct _ClockInfoArray *clock_info_array;
  1182. struct _NonClockInfoArray *non_clock_info_array;
  1183. union power_info *power_info;
  1184. int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
  1185. u16 data_offset;
  1186. u8 frev, crev;
  1187. u8 *power_state_offset;
  1188. struct sumo_ps *ps;
  1189. if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
  1190. &frev, &crev, &data_offset))
  1191. return -EINVAL;
  1192. power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
  1193. state_array = (struct _StateArray *)
  1194. (mode_info->atom_context->bios + data_offset +
  1195. le16_to_cpu(power_info->pplib.usStateArrayOffset));
  1196. clock_info_array = (struct _ClockInfoArray *)
  1197. (mode_info->atom_context->bios + data_offset +
  1198. le16_to_cpu(power_info->pplib.usClockInfoArrayOffset));
  1199. non_clock_info_array = (struct _NonClockInfoArray *)
  1200. (mode_info->atom_context->bios + data_offset +
  1201. le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset));
  1202. rdev->pm.dpm.ps = kzalloc(sizeof(struct radeon_ps) *
  1203. state_array->ucNumEntries, GFP_KERNEL);
  1204. if (!rdev->pm.dpm.ps)
  1205. return -ENOMEM;
  1206. power_state_offset = (u8 *)state_array->states;
  1207. rdev->pm.dpm.platform_caps = le32_to_cpu(power_info->pplib.ulPlatformCaps);
  1208. rdev->pm.dpm.backbias_response_time = le16_to_cpu(power_info->pplib.usBackbiasTime);
  1209. rdev->pm.dpm.voltage_response_time = le16_to_cpu(power_info->pplib.usVoltageTime);
  1210. for (i = 0; i < state_array->ucNumEntries; i++) {
  1211. power_state = (union pplib_power_state *)power_state_offset;
  1212. non_clock_array_index = power_state->v2.nonClockInfoIndex;
  1213. non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
  1214. &non_clock_info_array->nonClockInfo[non_clock_array_index];
  1215. if (!rdev->pm.power_state[i].clock_info)
  1216. return -EINVAL;
  1217. ps = kzalloc(sizeof(struct sumo_ps), GFP_KERNEL);
  1218. if (ps == NULL) {
  1219. kfree(rdev->pm.dpm.ps);
  1220. return -ENOMEM;
  1221. }
  1222. rdev->pm.dpm.ps[i].ps_priv = ps;
  1223. k = 0;
  1224. for (j = 0; j < power_state->v2.ucNumDPMLevels; j++) {
  1225. clock_array_index = power_state->v2.clockInfoIndex[j];
  1226. if (k >= SUMO_MAX_HARDWARE_POWERLEVELS)
  1227. break;
  1228. clock_info = (union pplib_clock_info *)
  1229. &clock_info_array->clockInfo[clock_array_index * clock_info_array->ucEntrySize];
  1230. sumo_parse_pplib_clock_info(rdev,
  1231. &rdev->pm.dpm.ps[i], k,
  1232. clock_info);
  1233. k++;
  1234. }
  1235. sumo_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
  1236. non_clock_info,
  1237. non_clock_info_array->ucEntrySize);
  1238. power_state_offset += 2 + power_state->v2.ucNumDPMLevels;
  1239. }
  1240. rdev->pm.dpm.num_ps = state_array->ucNumEntries;
  1241. return 0;
  1242. }
  1243. u32 sumo_convert_vid2_to_vid7(struct radeon_device *rdev,
  1244. struct sumo_vid_mapping_table *vid_mapping_table,
  1245. u32 vid_2bit)
  1246. {
  1247. u32 i;
  1248. for (i = 0; i < vid_mapping_table->num_entries; i++) {
  1249. if (vid_mapping_table->entries[i].vid_2bit == vid_2bit)
  1250. return vid_mapping_table->entries[i].vid_7bit;
  1251. }
  1252. return vid_mapping_table->entries[vid_mapping_table->num_entries - 1].vid_7bit;
  1253. }
  1254. static u16 sumo_convert_voltage_index_to_value(struct radeon_device *rdev,
  1255. u32 vid_2bit)
  1256. {
  1257. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1258. u32 vid_7bit = sumo_convert_vid2_to_vid7(rdev, &pi->sys_info.vid_mapping_table, vid_2bit);
  1259. if (vid_7bit > 0x7C)
  1260. return 0;
  1261. return (15500 - vid_7bit * 125 + 5) / 10;
  1262. }
  1263. static void sumo_construct_display_voltage_mapping_table(struct radeon_device *rdev,
  1264. struct sumo_disp_clock_voltage_mapping_table *disp_clk_voltage_mapping_table,
  1265. ATOM_CLK_VOLT_CAPABILITY *table)
  1266. {
  1267. u32 i;
  1268. for (i = 0; i < SUMO_MAX_NUMBER_VOLTAGES; i++) {
  1269. if (table[i].ulMaximumSupportedCLK == 0)
  1270. break;
  1271. disp_clk_voltage_mapping_table->display_clock_frequency[i] =
  1272. table[i].ulMaximumSupportedCLK;
  1273. }
  1274. disp_clk_voltage_mapping_table->num_max_voltage_levels = i;
  1275. if (disp_clk_voltage_mapping_table->num_max_voltage_levels == 0) {
  1276. disp_clk_voltage_mapping_table->display_clock_frequency[0] = 80000;
  1277. disp_clk_voltage_mapping_table->num_max_voltage_levels = 1;
  1278. }
  1279. }
  1280. void sumo_construct_sclk_voltage_mapping_table(struct radeon_device *rdev,
  1281. struct sumo_sclk_voltage_mapping_table *sclk_voltage_mapping_table,
  1282. ATOM_AVAILABLE_SCLK_LIST *table)
  1283. {
  1284. u32 i;
  1285. u32 n = 0;
  1286. u32 prev_sclk = 0;
  1287. for (i = 0; i < SUMO_MAX_HARDWARE_POWERLEVELS; i++) {
  1288. if (table[i].ulSupportedSCLK > prev_sclk) {
  1289. sclk_voltage_mapping_table->entries[n].sclk_frequency =
  1290. table[i].ulSupportedSCLK;
  1291. sclk_voltage_mapping_table->entries[n].vid_2bit =
  1292. table[i].usVoltageIndex;
  1293. prev_sclk = table[i].ulSupportedSCLK;
  1294. n++;
  1295. }
  1296. }
  1297. sclk_voltage_mapping_table->num_max_dpm_entries = n;
  1298. }
  1299. void sumo_construct_vid_mapping_table(struct radeon_device *rdev,
  1300. struct sumo_vid_mapping_table *vid_mapping_table,
  1301. ATOM_AVAILABLE_SCLK_LIST *table)
  1302. {
  1303. u32 i, j;
  1304. for (i = 0; i < SUMO_MAX_HARDWARE_POWERLEVELS; i++) {
  1305. if (table[i].ulSupportedSCLK != 0) {
  1306. vid_mapping_table->entries[table[i].usVoltageIndex].vid_7bit =
  1307. table[i].usVoltageID;
  1308. vid_mapping_table->entries[table[i].usVoltageIndex].vid_2bit =
  1309. table[i].usVoltageIndex;
  1310. }
  1311. }
  1312. for (i = 0; i < SUMO_MAX_NUMBER_VOLTAGES; i++) {
  1313. if (vid_mapping_table->entries[i].vid_7bit == 0) {
  1314. for (j = i + 1; j < SUMO_MAX_NUMBER_VOLTAGES; j++) {
  1315. if (vid_mapping_table->entries[j].vid_7bit != 0) {
  1316. vid_mapping_table->entries[i] =
  1317. vid_mapping_table->entries[j];
  1318. vid_mapping_table->entries[j].vid_7bit = 0;
  1319. break;
  1320. }
  1321. }
  1322. if (j == SUMO_MAX_NUMBER_VOLTAGES)
  1323. break;
  1324. }
  1325. }
  1326. vid_mapping_table->num_entries = i;
  1327. }
  1328. union igp_info {
  1329. struct _ATOM_INTEGRATED_SYSTEM_INFO info;
  1330. struct _ATOM_INTEGRATED_SYSTEM_INFO_V2 info_2;
  1331. struct _ATOM_INTEGRATED_SYSTEM_INFO_V5 info_5;
  1332. struct _ATOM_INTEGRATED_SYSTEM_INFO_V6 info_6;
  1333. };
  1334. static int sumo_parse_sys_info_table(struct radeon_device *rdev)
  1335. {
  1336. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1337. struct radeon_mode_info *mode_info = &rdev->mode_info;
  1338. int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
  1339. union igp_info *igp_info;
  1340. u8 frev, crev;
  1341. u16 data_offset;
  1342. int i;
  1343. if (atom_parse_data_header(mode_info->atom_context, index, NULL,
  1344. &frev, &crev, &data_offset)) {
  1345. igp_info = (union igp_info *)(mode_info->atom_context->bios +
  1346. data_offset);
  1347. if (crev != 6) {
  1348. DRM_ERROR("Unsupported IGP table: %d %d\n", frev, crev);
  1349. return -EINVAL;
  1350. }
  1351. pi->sys_info.bootup_sclk = le32_to_cpu(igp_info->info_6.ulBootUpEngineClock);
  1352. pi->sys_info.min_sclk = le32_to_cpu(igp_info->info_6.ulMinEngineClock);
  1353. pi->sys_info.bootup_uma_clk = le32_to_cpu(igp_info->info_6.ulBootUpUMAClock);
  1354. pi->sys_info.bootup_nb_voltage_index =
  1355. le16_to_cpu(igp_info->info_6.usBootUpNBVoltage);
  1356. if (igp_info->info_6.ucHtcTmpLmt == 0)
  1357. pi->sys_info.htc_tmp_lmt = 203;
  1358. else
  1359. pi->sys_info.htc_tmp_lmt = igp_info->info_6.ucHtcTmpLmt;
  1360. if (igp_info->info_6.ucHtcHystLmt == 0)
  1361. pi->sys_info.htc_hyst_lmt = 5;
  1362. else
  1363. pi->sys_info.htc_hyst_lmt = igp_info->info_6.ucHtcHystLmt;
  1364. if (pi->sys_info.htc_tmp_lmt <= pi->sys_info.htc_hyst_lmt) {
  1365. DRM_ERROR("The htcTmpLmt should be larger than htcHystLmt.\n");
  1366. }
  1367. for (i = 0; i < NUMBER_OF_M3ARB_PARAM_SETS; i++) {
  1368. pi->sys_info.csr_m3_arb_cntl_default[i] =
  1369. le32_to_cpu(igp_info->info_6.ulCSR_M3_ARB_CNTL_DEFAULT[i]);
  1370. pi->sys_info.csr_m3_arb_cntl_uvd[i] =
  1371. le32_to_cpu(igp_info->info_6.ulCSR_M3_ARB_CNTL_UVD[i]);
  1372. pi->sys_info.csr_m3_arb_cntl_fs3d[i] =
  1373. le32_to_cpu(igp_info->info_6.ulCSR_M3_ARB_CNTL_FS3D[i]);
  1374. }
  1375. pi->sys_info.sclk_dpm_boost_margin =
  1376. le32_to_cpu(igp_info->info_6.SclkDpmBoostMargin);
  1377. pi->sys_info.sclk_dpm_throttle_margin =
  1378. le32_to_cpu(igp_info->info_6.SclkDpmThrottleMargin);
  1379. pi->sys_info.sclk_dpm_tdp_limit_pg =
  1380. le16_to_cpu(igp_info->info_6.SclkDpmTdpLimitPG);
  1381. pi->sys_info.gnb_tdp_limit = le16_to_cpu(igp_info->info_6.GnbTdpLimit);
  1382. pi->sys_info.sclk_dpm_tdp_limit_boost =
  1383. le16_to_cpu(igp_info->info_6.SclkDpmTdpLimitBoost);
  1384. pi->sys_info.boost_sclk = le32_to_cpu(igp_info->info_6.ulBoostEngineCLock);
  1385. pi->sys_info.boost_vid_2bit = igp_info->info_6.ulBoostVid_2bit;
  1386. if (igp_info->info_6.EnableBoost)
  1387. pi->sys_info.enable_boost = true;
  1388. else
  1389. pi->sys_info.enable_boost = false;
  1390. sumo_construct_display_voltage_mapping_table(rdev,
  1391. &pi->sys_info.disp_clk_voltage_mapping_table,
  1392. igp_info->info_6.sDISPCLK_Voltage);
  1393. sumo_construct_sclk_voltage_mapping_table(rdev,
  1394. &pi->sys_info.sclk_voltage_mapping_table,
  1395. igp_info->info_6.sAvail_SCLK);
  1396. sumo_construct_vid_mapping_table(rdev, &pi->sys_info.vid_mapping_table,
  1397. igp_info->info_6.sAvail_SCLK);
  1398. }
  1399. return 0;
  1400. }
  1401. static void sumo_construct_boot_and_acpi_state(struct radeon_device *rdev)
  1402. {
  1403. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1404. pi->boot_pl.sclk = pi->sys_info.bootup_sclk;
  1405. pi->boot_pl.vddc_index = pi->sys_info.bootup_nb_voltage_index;
  1406. pi->boot_pl.ds_divider_index = 0;
  1407. pi->boot_pl.ss_divider_index = 0;
  1408. pi->boot_pl.allow_gnb_slow = 1;
  1409. pi->acpi_pl = pi->boot_pl;
  1410. pi->current_ps.num_levels = 1;
  1411. pi->current_ps.levels[0] = pi->boot_pl;
  1412. }
  1413. int sumo_dpm_init(struct radeon_device *rdev)
  1414. {
  1415. struct sumo_power_info *pi;
  1416. u32 hw_rev = (RREG32(HW_REV) & ATI_REV_ID_MASK) >> ATI_REV_ID_SHIFT;
  1417. int ret;
  1418. pi = kzalloc(sizeof(struct sumo_power_info), GFP_KERNEL);
  1419. if (pi == NULL)
  1420. return -ENOMEM;
  1421. rdev->pm.dpm.priv = pi;
  1422. pi->driver_nbps_policy_disable = false;
  1423. if ((rdev->family == CHIP_PALM) && (hw_rev < 3))
  1424. pi->disable_gfx_power_gating_in_uvd = true;
  1425. else
  1426. pi->disable_gfx_power_gating_in_uvd = false;
  1427. pi->enable_alt_vddnb = true;
  1428. pi->enable_sclk_ds = true;
  1429. pi->enable_dynamic_m3_arbiter = false;
  1430. pi->enable_dynamic_patch_ps = true;
  1431. pi->enable_gfx_power_gating = true;
  1432. pi->enable_gfx_clock_gating = true;
  1433. pi->enable_mg_clock_gating = true;
  1434. pi->enable_auto_thermal_throttling = true;
  1435. ret = sumo_parse_sys_info_table(rdev);
  1436. if (ret)
  1437. return ret;
  1438. sumo_construct_boot_and_acpi_state(rdev);
  1439. ret = sumo_parse_power_table(rdev);
  1440. if (ret)
  1441. return ret;
  1442. pi->pasi = CYPRESS_HASI_DFLT;
  1443. pi->asi = RV770_ASI_DFLT;
  1444. pi->thermal_auto_throttling = pi->sys_info.htc_tmp_lmt;
  1445. pi->enable_boost = pi->sys_info.enable_boost;
  1446. pi->enable_dpm = true;
  1447. return 0;
  1448. }
  1449. void sumo_dpm_print_power_state(struct radeon_device *rdev,
  1450. struct radeon_ps *rps)
  1451. {
  1452. int i;
  1453. struct sumo_ps *ps = sumo_get_ps(rps);
  1454. r600_dpm_print_class_info(rps->class, rps->class2);
  1455. r600_dpm_print_cap_info(rps->caps);
  1456. printk("\tuvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  1457. for (i = 0; i < ps->num_levels; i++) {
  1458. struct sumo_pl *pl = &ps->levels[i];
  1459. printk("\t\tpower level %d sclk: %u vddc: %u\n",
  1460. i, pl->sclk,
  1461. sumo_convert_voltage_index_to_value(rdev, pl->vddc_index));
  1462. }
  1463. r600_dpm_print_ps_status(rdev, rps);
  1464. }
  1465. void sumo_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
  1466. struct seq_file *m)
  1467. {
  1468. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1469. struct radeon_ps *rps = rdev->pm.dpm.current_ps;
  1470. struct sumo_ps *ps = sumo_get_ps(rps);
  1471. struct sumo_pl *pl;
  1472. u32 current_index =
  1473. (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURR_INDEX_MASK) >>
  1474. CURR_INDEX_SHIFT;
  1475. if (current_index == BOOST_DPM_LEVEL) {
  1476. pl = &pi->boost_pl;
  1477. seq_printf(m, "uvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  1478. seq_printf(m, "power level %d sclk: %u vddc: %u\n",
  1479. current_index, pl->sclk,
  1480. sumo_convert_voltage_index_to_value(rdev, pl->vddc_index));
  1481. } else if (current_index >= ps->num_levels) {
  1482. seq_printf(m, "invalid dpm profile %d\n", current_index);
  1483. } else {
  1484. pl = &ps->levels[current_index];
  1485. seq_printf(m, "uvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  1486. seq_printf(m, "power level %d sclk: %u vddc: %u\n",
  1487. current_index, pl->sclk,
  1488. sumo_convert_voltage_index_to_value(rdev, pl->vddc_index));
  1489. }
  1490. }
  1491. void sumo_dpm_fini(struct radeon_device *rdev)
  1492. {
  1493. int i;
  1494. sumo_cleanup_asic(rdev); /* ??? */
  1495. for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
  1496. kfree(rdev->pm.dpm.ps[i].ps_priv);
  1497. }
  1498. kfree(rdev->pm.dpm.ps);
  1499. kfree(rdev->pm.dpm.priv);
  1500. }
  1501. u32 sumo_dpm_get_sclk(struct radeon_device *rdev, bool low)
  1502. {
  1503. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1504. struct sumo_ps *requested_state = sumo_get_ps(&pi->requested_rps);
  1505. if (low)
  1506. return requested_state->levels[0].sclk;
  1507. else
  1508. return requested_state->levels[requested_state->num_levels - 1].sclk;
  1509. }
  1510. u32 sumo_dpm_get_mclk(struct radeon_device *rdev, bool low)
  1511. {
  1512. struct sumo_power_info *pi = sumo_get_pi(rdev);
  1513. return pi->sys_info.bootup_uma_clk;
  1514. }