rv770_dpm.c 69 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523
  1. /*
  2. * Copyright 2011 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. * Authors: Alex Deucher
  23. */
  24. #include "drmP.h"
  25. #include "radeon.h"
  26. #include "rv770d.h"
  27. #include "r600_dpm.h"
  28. #include "rv770_dpm.h"
  29. #include "cypress_dpm.h"
  30. #include "atom.h"
  31. #include <linux/seq_file.h>
  32. #define MC_CG_ARB_FREQ_F0 0x0a
  33. #define MC_CG_ARB_FREQ_F1 0x0b
  34. #define MC_CG_ARB_FREQ_F2 0x0c
  35. #define MC_CG_ARB_FREQ_F3 0x0d
  36. #define MC_CG_SEQ_DRAMCONF_S0 0x05
  37. #define MC_CG_SEQ_DRAMCONF_S1 0x06
  38. #define PCIE_BUS_CLK 10000
  39. #define TCLK (PCIE_BUS_CLK / 10)
  40. #define SMC_RAM_END 0xC000
  41. struct rv7xx_ps *rv770_get_ps(struct radeon_ps *rps)
  42. {
  43. struct rv7xx_ps *ps = rps->ps_priv;
  44. return ps;
  45. }
  46. struct rv7xx_power_info *rv770_get_pi(struct radeon_device *rdev)
  47. {
  48. struct rv7xx_power_info *pi = rdev->pm.dpm.priv;
  49. return pi;
  50. }
  51. struct evergreen_power_info *evergreen_get_pi(struct radeon_device *rdev)
  52. {
  53. struct evergreen_power_info *pi = rdev->pm.dpm.priv;
  54. return pi;
  55. }
  56. static void rv770_enable_bif_dynamic_pcie_gen2(struct radeon_device *rdev,
  57. bool enable)
  58. {
  59. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  60. u32 tmp;
  61. tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL);
  62. if (enable) {
  63. tmp &= ~LC_HW_VOLTAGE_IF_CONTROL_MASK;
  64. tmp |= LC_HW_VOLTAGE_IF_CONTROL(1);
  65. tmp |= LC_GEN2_EN_STRAP;
  66. } else {
  67. if (!pi->boot_in_gen2) {
  68. tmp &= ~LC_HW_VOLTAGE_IF_CONTROL_MASK;
  69. tmp &= ~LC_GEN2_EN_STRAP;
  70. }
  71. }
  72. if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2) ||
  73. (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2))
  74. WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp);
  75. }
  76. static void rv770_enable_l0s(struct radeon_device *rdev)
  77. {
  78. u32 tmp;
  79. tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL) & ~LC_L0S_INACTIVITY_MASK;
  80. tmp |= LC_L0S_INACTIVITY(3);
  81. WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp);
  82. }
  83. static void rv770_enable_l1(struct radeon_device *rdev)
  84. {
  85. u32 tmp;
  86. tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL);
  87. tmp &= ~LC_L1_INACTIVITY_MASK;
  88. tmp |= LC_L1_INACTIVITY(4);
  89. tmp &= ~LC_PMI_TO_L1_DIS;
  90. tmp &= ~LC_ASPM_TO_L1_DIS;
  91. WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp);
  92. }
  93. static void rv770_enable_pll_sleep_in_l1(struct radeon_device *rdev)
  94. {
  95. u32 tmp;
  96. tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL) & ~LC_L1_INACTIVITY_MASK;
  97. tmp |= LC_L1_INACTIVITY(8);
  98. WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp);
  99. /* NOTE, this is a PCIE indirect reg, not PCIE PORT */
  100. tmp = RREG32_PCIE(PCIE_P_CNTL);
  101. tmp |= P_PLL_PWRDN_IN_L1L23;
  102. tmp &= ~P_PLL_BUF_PDNB;
  103. tmp &= ~P_PLL_PDNB;
  104. tmp |= P_ALLOW_PRX_FRONTEND_SHUTOFF;
  105. WREG32_PCIE(PCIE_P_CNTL, tmp);
  106. }
  107. static void rv770_gfx_clock_gating_enable(struct radeon_device *rdev,
  108. bool enable)
  109. {
  110. if (enable)
  111. WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
  112. else {
  113. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
  114. WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
  115. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
  116. RREG32(GB_TILING_CONFIG);
  117. }
  118. }
  119. static void rv770_mg_clock_gating_enable(struct radeon_device *rdev,
  120. bool enable)
  121. {
  122. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  123. if (enable) {
  124. u32 mgcg_cgtt_local0;
  125. if (rdev->family == CHIP_RV770)
  126. mgcg_cgtt_local0 = RV770_MGCGTTLOCAL0_DFLT;
  127. else
  128. mgcg_cgtt_local0 = RV7XX_MGCGTTLOCAL0_DFLT;
  129. WREG32(CG_CGTT_LOCAL_0, mgcg_cgtt_local0);
  130. WREG32(CG_CGTT_LOCAL_1, (RV770_MGCGTTLOCAL1_DFLT & 0xFFFFCFFF));
  131. if (pi->mgcgtssm)
  132. WREG32(CGTS_SM_CTRL_REG, RV770_MGCGCGTSSMCTRL_DFLT);
  133. } else {
  134. WREG32(CG_CGTT_LOCAL_0, 0xFFFFFFFF);
  135. WREG32(CG_CGTT_LOCAL_1, 0xFFFFCFFF);
  136. }
  137. }
  138. void rv770_restore_cgcg(struct radeon_device *rdev)
  139. {
  140. bool dpm_en = false, cg_en = false;
  141. if (RREG32(GENERAL_PWRMGT) & GLOBAL_PWRMGT_EN)
  142. dpm_en = true;
  143. if (RREG32(SCLK_PWRMGT_CNTL) & DYN_GFX_CLK_OFF_EN)
  144. cg_en = true;
  145. if (dpm_en && !cg_en)
  146. WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
  147. }
  148. static void rv770_start_dpm(struct radeon_device *rdev)
  149. {
  150. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~SCLK_PWRMGT_OFF);
  151. WREG32_P(MCLK_PWRMGT_CNTL, 0, ~MPLL_PWRMGT_OFF);
  152. WREG32_P(GENERAL_PWRMGT, GLOBAL_PWRMGT_EN, ~GLOBAL_PWRMGT_EN);
  153. }
  154. void rv770_stop_dpm(struct radeon_device *rdev)
  155. {
  156. PPSMC_Result result;
  157. result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_TwoLevelsDisabled);
  158. if (result != PPSMC_Result_OK)
  159. DRM_ERROR("Could not force DPM to low.\n");
  160. WREG32_P(GENERAL_PWRMGT, 0, ~GLOBAL_PWRMGT_EN);
  161. WREG32_P(SCLK_PWRMGT_CNTL, SCLK_PWRMGT_OFF, ~SCLK_PWRMGT_OFF);
  162. WREG32_P(MCLK_PWRMGT_CNTL, MPLL_PWRMGT_OFF, ~MPLL_PWRMGT_OFF);
  163. }
  164. bool rv770_dpm_enabled(struct radeon_device *rdev)
  165. {
  166. if (RREG32(GENERAL_PWRMGT) & GLOBAL_PWRMGT_EN)
  167. return true;
  168. else
  169. return false;
  170. }
  171. void rv770_enable_thermal_protection(struct radeon_device *rdev,
  172. bool enable)
  173. {
  174. if (enable)
  175. WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS);
  176. else
  177. WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS);
  178. }
  179. void rv770_enable_acpi_pm(struct radeon_device *rdev)
  180. {
  181. WREG32_P(GENERAL_PWRMGT, STATIC_PM_EN, ~STATIC_PM_EN);
  182. }
  183. u8 rv770_get_seq_value(struct radeon_device *rdev,
  184. struct rv7xx_pl *pl)
  185. {
  186. return (pl->flags & ATOM_PPLIB_R600_FLAGS_LOWPOWER) ?
  187. MC_CG_SEQ_DRAMCONF_S0 : MC_CG_SEQ_DRAMCONF_S1;
  188. }
  189. int rv770_read_smc_soft_register(struct radeon_device *rdev,
  190. u16 reg_offset, u32 *value)
  191. {
  192. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  193. return rv770_read_smc_sram_dword(rdev,
  194. pi->soft_regs_start + reg_offset,
  195. value, pi->sram_end);
  196. }
  197. int rv770_write_smc_soft_register(struct radeon_device *rdev,
  198. u16 reg_offset, u32 value)
  199. {
  200. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  201. return rv770_write_smc_sram_dword(rdev,
  202. pi->soft_regs_start + reg_offset,
  203. value, pi->sram_end);
  204. }
  205. int rv770_populate_smc_t(struct radeon_device *rdev,
  206. struct radeon_ps *radeon_state,
  207. RV770_SMC_SWSTATE *smc_state)
  208. {
  209. struct rv7xx_ps *state = rv770_get_ps(radeon_state);
  210. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  211. int i;
  212. int a_n;
  213. int a_d;
  214. u8 l[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE];
  215. u8 r[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE];
  216. u32 a_t;
  217. l[0] = 0;
  218. r[2] = 100;
  219. a_n = (int)state->medium.sclk * pi->lmp +
  220. (int)state->low.sclk * (R600_AH_DFLT - pi->rlp);
  221. a_d = (int)state->low.sclk * (100 - (int)pi->rlp) +
  222. (int)state->medium.sclk * pi->lmp;
  223. l[1] = (u8)(pi->lmp - (int)pi->lmp * a_n / a_d);
  224. r[0] = (u8)(pi->rlp + (100 - (int)pi->rlp) * a_n / a_d);
  225. a_n = (int)state->high.sclk * pi->lhp + (int)state->medium.sclk *
  226. (R600_AH_DFLT - pi->rmp);
  227. a_d = (int)state->medium.sclk * (100 - (int)pi->rmp) +
  228. (int)state->high.sclk * pi->lhp;
  229. l[2] = (u8)(pi->lhp - (int)pi->lhp * a_n / a_d);
  230. r[1] = (u8)(pi->rmp + (100 - (int)pi->rmp) * a_n / a_d);
  231. for (i = 0; i < (RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1); i++) {
  232. a_t = CG_R(r[i] * pi->bsp / 200) | CG_L(l[i] * pi->bsp / 200);
  233. smc_state->levels[i].aT = cpu_to_be32(a_t);
  234. }
  235. a_t = CG_R(r[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1] * pi->pbsp / 200) |
  236. CG_L(l[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1] * pi->pbsp / 200);
  237. smc_state->levels[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1].aT =
  238. cpu_to_be32(a_t);
  239. return 0;
  240. }
  241. int rv770_populate_smc_sp(struct radeon_device *rdev,
  242. struct radeon_ps *radeon_state,
  243. RV770_SMC_SWSTATE *smc_state)
  244. {
  245. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  246. int i;
  247. for (i = 0; i < (RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1); i++)
  248. smc_state->levels[i].bSP = cpu_to_be32(pi->dsp);
  249. smc_state->levels[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1].bSP =
  250. cpu_to_be32(pi->psp);
  251. return 0;
  252. }
  253. static void rv770_calculate_fractional_mpll_feedback_divider(u32 memory_clock,
  254. u32 reference_clock,
  255. bool gddr5,
  256. struct atom_clock_dividers *dividers,
  257. u32 *clkf,
  258. u32 *clkfrac)
  259. {
  260. u32 post_divider, reference_divider, feedback_divider8;
  261. u32 fyclk;
  262. if (gddr5)
  263. fyclk = (memory_clock * 8) / 2;
  264. else
  265. fyclk = (memory_clock * 4) / 2;
  266. post_divider = dividers->post_div;
  267. reference_divider = dividers->ref_div;
  268. feedback_divider8 =
  269. (8 * fyclk * reference_divider * post_divider) / reference_clock;
  270. *clkf = feedback_divider8 / 8;
  271. *clkfrac = feedback_divider8 % 8;
  272. }
  273. static int rv770_encode_yclk_post_div(u32 postdiv, u32 *encoded_postdiv)
  274. {
  275. int ret = 0;
  276. switch (postdiv) {
  277. case 1:
  278. *encoded_postdiv = 0;
  279. break;
  280. case 2:
  281. *encoded_postdiv = 1;
  282. break;
  283. case 4:
  284. *encoded_postdiv = 2;
  285. break;
  286. case 8:
  287. *encoded_postdiv = 3;
  288. break;
  289. case 16:
  290. *encoded_postdiv = 4;
  291. break;
  292. default:
  293. ret = -EINVAL;
  294. break;
  295. }
  296. return ret;
  297. }
  298. u32 rv770_map_clkf_to_ibias(struct radeon_device *rdev, u32 clkf)
  299. {
  300. if (clkf <= 0x10)
  301. return 0x4B;
  302. if (clkf <= 0x19)
  303. return 0x5B;
  304. if (clkf <= 0x21)
  305. return 0x2B;
  306. if (clkf <= 0x27)
  307. return 0x6C;
  308. if (clkf <= 0x31)
  309. return 0x9D;
  310. return 0xC6;
  311. }
  312. static int rv770_populate_mclk_value(struct radeon_device *rdev,
  313. u32 engine_clock, u32 memory_clock,
  314. RV7XX_SMC_MCLK_VALUE *mclk)
  315. {
  316. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  317. u8 encoded_reference_dividers[] = { 0, 16, 17, 20, 21 };
  318. u32 mpll_ad_func_cntl =
  319. pi->clk_regs.rv770.mpll_ad_func_cntl;
  320. u32 mpll_ad_func_cntl_2 =
  321. pi->clk_regs.rv770.mpll_ad_func_cntl_2;
  322. u32 mpll_dq_func_cntl =
  323. pi->clk_regs.rv770.mpll_dq_func_cntl;
  324. u32 mpll_dq_func_cntl_2 =
  325. pi->clk_regs.rv770.mpll_dq_func_cntl_2;
  326. u32 mclk_pwrmgt_cntl =
  327. pi->clk_regs.rv770.mclk_pwrmgt_cntl;
  328. u32 dll_cntl = pi->clk_regs.rv770.dll_cntl;
  329. struct atom_clock_dividers dividers;
  330. u32 reference_clock = rdev->clock.mpll.reference_freq;
  331. u32 clkf, clkfrac;
  332. u32 postdiv_yclk;
  333. u32 ibias;
  334. int ret;
  335. ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_MEMORY_PLL_PARAM,
  336. memory_clock, false, &dividers);
  337. if (ret)
  338. return ret;
  339. if ((dividers.ref_div < 1) || (dividers.ref_div > 5))
  340. return -EINVAL;
  341. rv770_calculate_fractional_mpll_feedback_divider(memory_clock, reference_clock,
  342. pi->mem_gddr5,
  343. &dividers, &clkf, &clkfrac);
  344. ret = rv770_encode_yclk_post_div(dividers.post_div, &postdiv_yclk);
  345. if (ret)
  346. return ret;
  347. ibias = rv770_map_clkf_to_ibias(rdev, clkf);
  348. mpll_ad_func_cntl &= ~(CLKR_MASK |
  349. YCLK_POST_DIV_MASK |
  350. CLKF_MASK |
  351. CLKFRAC_MASK |
  352. IBIAS_MASK);
  353. mpll_ad_func_cntl |= CLKR(encoded_reference_dividers[dividers.ref_div - 1]);
  354. mpll_ad_func_cntl |= YCLK_POST_DIV(postdiv_yclk);
  355. mpll_ad_func_cntl |= CLKF(clkf);
  356. mpll_ad_func_cntl |= CLKFRAC(clkfrac);
  357. mpll_ad_func_cntl |= IBIAS(ibias);
  358. if (dividers.vco_mode)
  359. mpll_ad_func_cntl_2 |= VCO_MODE;
  360. else
  361. mpll_ad_func_cntl_2 &= ~VCO_MODE;
  362. if (pi->mem_gddr5) {
  363. rv770_calculate_fractional_mpll_feedback_divider(memory_clock,
  364. reference_clock,
  365. pi->mem_gddr5,
  366. &dividers, &clkf, &clkfrac);
  367. ibias = rv770_map_clkf_to_ibias(rdev, clkf);
  368. ret = rv770_encode_yclk_post_div(dividers.post_div, &postdiv_yclk);
  369. if (ret)
  370. return ret;
  371. mpll_dq_func_cntl &= ~(CLKR_MASK |
  372. YCLK_POST_DIV_MASK |
  373. CLKF_MASK |
  374. CLKFRAC_MASK |
  375. IBIAS_MASK);
  376. mpll_dq_func_cntl |= CLKR(encoded_reference_dividers[dividers.ref_div - 1]);
  377. mpll_dq_func_cntl |= YCLK_POST_DIV(postdiv_yclk);
  378. mpll_dq_func_cntl |= CLKF(clkf);
  379. mpll_dq_func_cntl |= CLKFRAC(clkfrac);
  380. mpll_dq_func_cntl |= IBIAS(ibias);
  381. if (dividers.vco_mode)
  382. mpll_dq_func_cntl_2 |= VCO_MODE;
  383. else
  384. mpll_dq_func_cntl_2 &= ~VCO_MODE;
  385. }
  386. mclk->mclk770.mclk_value = cpu_to_be32(memory_clock);
  387. mclk->mclk770.vMPLL_AD_FUNC_CNTL = cpu_to_be32(mpll_ad_func_cntl);
  388. mclk->mclk770.vMPLL_AD_FUNC_CNTL_2 = cpu_to_be32(mpll_ad_func_cntl_2);
  389. mclk->mclk770.vMPLL_DQ_FUNC_CNTL = cpu_to_be32(mpll_dq_func_cntl);
  390. mclk->mclk770.vMPLL_DQ_FUNC_CNTL_2 = cpu_to_be32(mpll_dq_func_cntl_2);
  391. mclk->mclk770.vMCLK_PWRMGT_CNTL = cpu_to_be32(mclk_pwrmgt_cntl);
  392. mclk->mclk770.vDLL_CNTL = cpu_to_be32(dll_cntl);
  393. return 0;
  394. }
  395. static int rv770_populate_sclk_value(struct radeon_device *rdev,
  396. u32 engine_clock,
  397. RV770_SMC_SCLK_VALUE *sclk)
  398. {
  399. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  400. struct atom_clock_dividers dividers;
  401. u32 spll_func_cntl =
  402. pi->clk_regs.rv770.cg_spll_func_cntl;
  403. u32 spll_func_cntl_2 =
  404. pi->clk_regs.rv770.cg_spll_func_cntl_2;
  405. u32 spll_func_cntl_3 =
  406. pi->clk_regs.rv770.cg_spll_func_cntl_3;
  407. u32 cg_spll_spread_spectrum =
  408. pi->clk_regs.rv770.cg_spll_spread_spectrum;
  409. u32 cg_spll_spread_spectrum_2 =
  410. pi->clk_regs.rv770.cg_spll_spread_spectrum_2;
  411. u64 tmp;
  412. u32 reference_clock = rdev->clock.spll.reference_freq;
  413. u32 reference_divider, post_divider;
  414. u32 fbdiv;
  415. int ret;
  416. ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  417. engine_clock, false, &dividers);
  418. if (ret)
  419. return ret;
  420. reference_divider = 1 + dividers.ref_div;
  421. if (dividers.enable_post_div)
  422. post_divider = (0x0f & (dividers.post_div >> 4)) + (0x0f & dividers.post_div) + 2;
  423. else
  424. post_divider = 1;
  425. tmp = (u64) engine_clock * reference_divider * post_divider * 16384;
  426. do_div(tmp, reference_clock);
  427. fbdiv = (u32) tmp;
  428. if (dividers.enable_post_div)
  429. spll_func_cntl |= SPLL_DIVEN;
  430. else
  431. spll_func_cntl &= ~SPLL_DIVEN;
  432. spll_func_cntl &= ~(SPLL_HILEN_MASK | SPLL_LOLEN_MASK | SPLL_REF_DIV_MASK);
  433. spll_func_cntl |= SPLL_REF_DIV(dividers.ref_div);
  434. spll_func_cntl |= SPLL_HILEN((dividers.post_div >> 4) & 0xf);
  435. spll_func_cntl |= SPLL_LOLEN(dividers.post_div & 0xf);
  436. spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
  437. spll_func_cntl_2 |= SCLK_MUX_SEL(2);
  438. spll_func_cntl_3 &= ~SPLL_FB_DIV_MASK;
  439. spll_func_cntl_3 |= SPLL_FB_DIV(fbdiv);
  440. spll_func_cntl_3 |= SPLL_DITHEN;
  441. if (pi->sclk_ss) {
  442. struct radeon_atom_ss ss;
  443. u32 vco_freq = engine_clock * post_divider;
  444. if (radeon_atombios_get_asic_ss_info(rdev, &ss,
  445. ASIC_INTERNAL_ENGINE_SS, vco_freq)) {
  446. u32 clk_s = reference_clock * 5 / (reference_divider * ss.rate);
  447. u32 clk_v = ss.percentage * fbdiv / (clk_s * 10000);
  448. cg_spll_spread_spectrum &= ~CLKS_MASK;
  449. cg_spll_spread_spectrum |= CLKS(clk_s);
  450. cg_spll_spread_spectrum |= SSEN;
  451. cg_spll_spread_spectrum_2 &= ~CLKV_MASK;
  452. cg_spll_spread_spectrum_2 |= CLKV(clk_v);
  453. }
  454. }
  455. sclk->sclk_value = cpu_to_be32(engine_clock);
  456. sclk->vCG_SPLL_FUNC_CNTL = cpu_to_be32(spll_func_cntl);
  457. sclk->vCG_SPLL_FUNC_CNTL_2 = cpu_to_be32(spll_func_cntl_2);
  458. sclk->vCG_SPLL_FUNC_CNTL_3 = cpu_to_be32(spll_func_cntl_3);
  459. sclk->vCG_SPLL_SPREAD_SPECTRUM = cpu_to_be32(cg_spll_spread_spectrum);
  460. sclk->vCG_SPLL_SPREAD_SPECTRUM_2 = cpu_to_be32(cg_spll_spread_spectrum_2);
  461. return 0;
  462. }
  463. int rv770_populate_vddc_value(struct radeon_device *rdev, u16 vddc,
  464. RV770_SMC_VOLTAGE_VALUE *voltage)
  465. {
  466. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  467. int i;
  468. if (!pi->voltage_control) {
  469. voltage->index = 0;
  470. voltage->value = 0;
  471. return 0;
  472. }
  473. for (i = 0; i < pi->valid_vddc_entries; i++) {
  474. if (vddc <= pi->vddc_table[i].vddc) {
  475. voltage->index = pi->vddc_table[i].vddc_index;
  476. voltage->value = cpu_to_be16(vddc);
  477. break;
  478. }
  479. }
  480. if (i == pi->valid_vddc_entries)
  481. return -EINVAL;
  482. return 0;
  483. }
  484. int rv770_populate_mvdd_value(struct radeon_device *rdev, u32 mclk,
  485. RV770_SMC_VOLTAGE_VALUE *voltage)
  486. {
  487. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  488. if (!pi->mvdd_control) {
  489. voltage->index = MVDD_HIGH_INDEX;
  490. voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
  491. return 0;
  492. }
  493. if (mclk <= pi->mvdd_split_frequency) {
  494. voltage->index = MVDD_LOW_INDEX;
  495. voltage->value = cpu_to_be16(MVDD_LOW_VALUE);
  496. } else {
  497. voltage->index = MVDD_HIGH_INDEX;
  498. voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
  499. }
  500. return 0;
  501. }
  502. static int rv770_convert_power_level_to_smc(struct radeon_device *rdev,
  503. struct rv7xx_pl *pl,
  504. RV770_SMC_HW_PERFORMANCE_LEVEL *level,
  505. u8 watermark_level)
  506. {
  507. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  508. int ret;
  509. level->gen2PCIE = pi->pcie_gen2 ?
  510. ((pl->flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2) ? 1 : 0) : 0;
  511. level->gen2XSP = (pl->flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2) ? 1 : 0;
  512. level->backbias = (pl->flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE) ? 1 : 0;
  513. level->displayWatermark = watermark_level;
  514. if (rdev->family == CHIP_RV740)
  515. ret = rv740_populate_sclk_value(rdev, pl->sclk,
  516. &level->sclk);
  517. else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  518. ret = rv730_populate_sclk_value(rdev, pl->sclk,
  519. &level->sclk);
  520. else
  521. ret = rv770_populate_sclk_value(rdev, pl->sclk,
  522. &level->sclk);
  523. if (ret)
  524. return ret;
  525. if (rdev->family == CHIP_RV740) {
  526. if (pi->mem_gddr5) {
  527. if (pl->mclk <= pi->mclk_strobe_mode_threshold)
  528. level->strobeMode =
  529. rv740_get_mclk_frequency_ratio(pl->mclk) | 0x10;
  530. else
  531. level->strobeMode = 0;
  532. if (pl->mclk > pi->mclk_edc_enable_threshold)
  533. level->mcFlags = SMC_MC_EDC_RD_FLAG | SMC_MC_EDC_WR_FLAG;
  534. else
  535. level->mcFlags = 0;
  536. }
  537. ret = rv740_populate_mclk_value(rdev, pl->sclk,
  538. pl->mclk, &level->mclk);
  539. } else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  540. ret = rv730_populate_mclk_value(rdev, pl->sclk,
  541. pl->mclk, &level->mclk);
  542. else
  543. ret = rv770_populate_mclk_value(rdev, pl->sclk,
  544. pl->mclk, &level->mclk);
  545. if (ret)
  546. return ret;
  547. ret = rv770_populate_vddc_value(rdev, pl->vddc,
  548. &level->vddc);
  549. if (ret)
  550. return ret;
  551. ret = rv770_populate_mvdd_value(rdev, pl->mclk, &level->mvdd);
  552. return ret;
  553. }
  554. static int rv770_convert_power_state_to_smc(struct radeon_device *rdev,
  555. struct radeon_ps *radeon_state,
  556. RV770_SMC_SWSTATE *smc_state)
  557. {
  558. struct rv7xx_ps *state = rv770_get_ps(radeon_state);
  559. int ret;
  560. if (!(radeon_state->caps & ATOM_PPLIB_DISALLOW_ON_DC))
  561. smc_state->flags |= PPSMC_SWSTATE_FLAG_DC;
  562. ret = rv770_convert_power_level_to_smc(rdev,
  563. &state->low,
  564. &smc_state->levels[0],
  565. PPSMC_DISPLAY_WATERMARK_LOW);
  566. if (ret)
  567. return ret;
  568. ret = rv770_convert_power_level_to_smc(rdev,
  569. &state->medium,
  570. &smc_state->levels[1],
  571. PPSMC_DISPLAY_WATERMARK_LOW);
  572. if (ret)
  573. return ret;
  574. ret = rv770_convert_power_level_to_smc(rdev,
  575. &state->high,
  576. &smc_state->levels[2],
  577. PPSMC_DISPLAY_WATERMARK_HIGH);
  578. if (ret)
  579. return ret;
  580. smc_state->levels[0].arbValue = MC_CG_ARB_FREQ_F1;
  581. smc_state->levels[1].arbValue = MC_CG_ARB_FREQ_F2;
  582. smc_state->levels[2].arbValue = MC_CG_ARB_FREQ_F3;
  583. smc_state->levels[0].seqValue = rv770_get_seq_value(rdev,
  584. &state->low);
  585. smc_state->levels[1].seqValue = rv770_get_seq_value(rdev,
  586. &state->medium);
  587. smc_state->levels[2].seqValue = rv770_get_seq_value(rdev,
  588. &state->high);
  589. rv770_populate_smc_sp(rdev, radeon_state, smc_state);
  590. return rv770_populate_smc_t(rdev, radeon_state, smc_state);
  591. }
  592. u32 rv770_calculate_memory_refresh_rate(struct radeon_device *rdev,
  593. u32 engine_clock)
  594. {
  595. u32 dram_rows;
  596. u32 dram_refresh_rate;
  597. u32 mc_arb_rfsh_rate;
  598. u32 tmp;
  599. tmp = (RREG32(MC_ARB_RAMCFG) & NOOFROWS_MASK) >> NOOFROWS_SHIFT;
  600. dram_rows = 1 << (tmp + 10);
  601. tmp = RREG32(MC_SEQ_MISC0) & 3;
  602. dram_refresh_rate = 1 << (tmp + 3);
  603. mc_arb_rfsh_rate = ((engine_clock * 10) * dram_refresh_rate / dram_rows - 32) / 64;
  604. return mc_arb_rfsh_rate;
  605. }
  606. static void rv770_program_memory_timing_parameters(struct radeon_device *rdev,
  607. struct radeon_ps *radeon_state)
  608. {
  609. struct rv7xx_ps *state = rv770_get_ps(radeon_state);
  610. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  611. u32 sqm_ratio;
  612. u32 arb_refresh_rate;
  613. u32 high_clock;
  614. if (state->high.sclk < (state->low.sclk * 0xFF / 0x40))
  615. high_clock = state->high.sclk;
  616. else
  617. high_clock = (state->low.sclk * 0xFF / 0x40);
  618. radeon_atom_set_engine_dram_timings(rdev, high_clock,
  619. state->high.mclk);
  620. sqm_ratio =
  621. STATE0(64 * high_clock / pi->boot_sclk) |
  622. STATE1(64 * high_clock / state->low.sclk) |
  623. STATE2(64 * high_clock / state->medium.sclk) |
  624. STATE3(64 * high_clock / state->high.sclk);
  625. WREG32(MC_ARB_SQM_RATIO, sqm_ratio);
  626. arb_refresh_rate =
  627. POWERMODE0(rv770_calculate_memory_refresh_rate(rdev, pi->boot_sclk)) |
  628. POWERMODE1(rv770_calculate_memory_refresh_rate(rdev, state->low.sclk)) |
  629. POWERMODE2(rv770_calculate_memory_refresh_rate(rdev, state->medium.sclk)) |
  630. POWERMODE3(rv770_calculate_memory_refresh_rate(rdev, state->high.sclk));
  631. WREG32(MC_ARB_RFSH_RATE, arb_refresh_rate);
  632. }
  633. void rv770_enable_backbias(struct radeon_device *rdev,
  634. bool enable)
  635. {
  636. if (enable)
  637. WREG32_P(GENERAL_PWRMGT, BACKBIAS_PAD_EN, ~BACKBIAS_PAD_EN);
  638. else
  639. WREG32_P(GENERAL_PWRMGT, 0, ~(BACKBIAS_VALUE | BACKBIAS_PAD_EN));
  640. }
  641. static void rv770_enable_spread_spectrum(struct radeon_device *rdev,
  642. bool enable)
  643. {
  644. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  645. if (enable) {
  646. if (pi->sclk_ss)
  647. WREG32_P(GENERAL_PWRMGT, DYN_SPREAD_SPECTRUM_EN, ~DYN_SPREAD_SPECTRUM_EN);
  648. if (pi->mclk_ss) {
  649. if (rdev->family == CHIP_RV740)
  650. rv740_enable_mclk_spread_spectrum(rdev, true);
  651. }
  652. } else {
  653. WREG32_P(CG_SPLL_SPREAD_SPECTRUM, 0, ~SSEN);
  654. WREG32_P(GENERAL_PWRMGT, 0, ~DYN_SPREAD_SPECTRUM_EN);
  655. WREG32_P(CG_MPLL_SPREAD_SPECTRUM, 0, ~SSEN);
  656. if (rdev->family == CHIP_RV740)
  657. rv740_enable_mclk_spread_spectrum(rdev, false);
  658. }
  659. }
  660. static void rv770_program_mpll_timing_parameters(struct radeon_device *rdev)
  661. {
  662. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  663. if ((rdev->family == CHIP_RV770) && !pi->mem_gddr5) {
  664. WREG32(MPLL_TIME,
  665. (MPLL_LOCK_TIME(R600_MPLLLOCKTIME_DFLT * pi->ref_div) |
  666. MPLL_RESET_TIME(R600_MPLLRESETTIME_DFLT)));
  667. }
  668. }
  669. void rv770_setup_bsp(struct radeon_device *rdev)
  670. {
  671. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  672. u32 xclk = radeon_get_xclk(rdev);
  673. r600_calculate_u_and_p(pi->asi,
  674. xclk,
  675. 16,
  676. &pi->bsp,
  677. &pi->bsu);
  678. r600_calculate_u_and_p(pi->pasi,
  679. xclk,
  680. 16,
  681. &pi->pbsp,
  682. &pi->pbsu);
  683. pi->dsp = BSP(pi->bsp) | BSU(pi->bsu);
  684. pi->psp = BSP(pi->pbsp) | BSU(pi->pbsu);
  685. WREG32(CG_BSP, pi->dsp);
  686. }
  687. void rv770_program_git(struct radeon_device *rdev)
  688. {
  689. WREG32_P(CG_GIT, CG_GICST(R600_GICST_DFLT), ~CG_GICST_MASK);
  690. }
  691. void rv770_program_tp(struct radeon_device *rdev)
  692. {
  693. int i;
  694. enum r600_td td = R600_TD_DFLT;
  695. for (i = 0; i < R600_PM_NUMBER_OF_TC; i++)
  696. WREG32(CG_FFCT_0 + (i * 4), (UTC_0(r600_utc[i]) | DTC_0(r600_dtc[i])));
  697. if (td == R600_TD_AUTO)
  698. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_FORCE_TREND_SEL);
  699. else
  700. WREG32_P(SCLK_PWRMGT_CNTL, FIR_FORCE_TREND_SEL, ~FIR_FORCE_TREND_SEL);
  701. if (td == R600_TD_UP)
  702. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_TREND_MODE);
  703. if (td == R600_TD_DOWN)
  704. WREG32_P(SCLK_PWRMGT_CNTL, FIR_TREND_MODE, ~FIR_TREND_MODE);
  705. }
  706. void rv770_program_tpp(struct radeon_device *rdev)
  707. {
  708. WREG32(CG_TPC, R600_TPC_DFLT);
  709. }
  710. void rv770_program_sstp(struct radeon_device *rdev)
  711. {
  712. WREG32(CG_SSP, (SSTU(R600_SSTU_DFLT) | SST(R600_SST_DFLT)));
  713. }
  714. void rv770_program_engine_speed_parameters(struct radeon_device *rdev)
  715. {
  716. WREG32_P(SPLL_CNTL_MODE, SPLL_DIV_SYNC, ~SPLL_DIV_SYNC);
  717. }
  718. static void rv770_enable_display_gap(struct radeon_device *rdev)
  719. {
  720. u32 tmp = RREG32(CG_DISPLAY_GAP_CNTL);
  721. tmp &= ~(DISP1_GAP_MCHG_MASK | DISP2_GAP_MCHG_MASK);
  722. tmp |= (DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE) |
  723. DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE));
  724. WREG32(CG_DISPLAY_GAP_CNTL, tmp);
  725. }
  726. void rv770_program_vc(struct radeon_device *rdev)
  727. {
  728. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  729. WREG32(CG_FTV, pi->vrc);
  730. }
  731. void rv770_clear_vc(struct radeon_device *rdev)
  732. {
  733. WREG32(CG_FTV, 0);
  734. }
  735. int rv770_upload_firmware(struct radeon_device *rdev)
  736. {
  737. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  738. int ret;
  739. rv770_reset_smc(rdev);
  740. rv770_stop_smc_clock(rdev);
  741. ret = rv770_load_smc_ucode(rdev, pi->sram_end);
  742. if (ret)
  743. return ret;
  744. return 0;
  745. }
  746. static int rv770_populate_smc_acpi_state(struct radeon_device *rdev,
  747. RV770_SMC_STATETABLE *table)
  748. {
  749. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  750. u32 mpll_ad_func_cntl =
  751. pi->clk_regs.rv770.mpll_ad_func_cntl;
  752. u32 mpll_ad_func_cntl_2 =
  753. pi->clk_regs.rv770.mpll_ad_func_cntl_2;
  754. u32 mpll_dq_func_cntl =
  755. pi->clk_regs.rv770.mpll_dq_func_cntl;
  756. u32 mpll_dq_func_cntl_2 =
  757. pi->clk_regs.rv770.mpll_dq_func_cntl_2;
  758. u32 spll_func_cntl =
  759. pi->clk_regs.rv770.cg_spll_func_cntl;
  760. u32 spll_func_cntl_2 =
  761. pi->clk_regs.rv770.cg_spll_func_cntl_2;
  762. u32 spll_func_cntl_3 =
  763. pi->clk_regs.rv770.cg_spll_func_cntl_3;
  764. u32 mclk_pwrmgt_cntl;
  765. u32 dll_cntl;
  766. table->ACPIState = table->initialState;
  767. table->ACPIState.flags &= ~PPSMC_SWSTATE_FLAG_DC;
  768. if (pi->acpi_vddc) {
  769. rv770_populate_vddc_value(rdev, pi->acpi_vddc,
  770. &table->ACPIState.levels[0].vddc);
  771. if (pi->pcie_gen2) {
  772. if (pi->acpi_pcie_gen2)
  773. table->ACPIState.levels[0].gen2PCIE = 1;
  774. else
  775. table->ACPIState.levels[0].gen2PCIE = 0;
  776. } else
  777. table->ACPIState.levels[0].gen2PCIE = 0;
  778. if (pi->acpi_pcie_gen2)
  779. table->ACPIState.levels[0].gen2XSP = 1;
  780. else
  781. table->ACPIState.levels[0].gen2XSP = 0;
  782. } else {
  783. rv770_populate_vddc_value(rdev, pi->min_vddc_in_table,
  784. &table->ACPIState.levels[0].vddc);
  785. table->ACPIState.levels[0].gen2PCIE = 0;
  786. }
  787. mpll_ad_func_cntl_2 |= BIAS_GEN_PDNB | RESET_EN;
  788. mpll_dq_func_cntl_2 |= BIAS_GEN_PDNB | RESET_EN;
  789. mclk_pwrmgt_cntl = (MRDCKA0_RESET |
  790. MRDCKA1_RESET |
  791. MRDCKB0_RESET |
  792. MRDCKB1_RESET |
  793. MRDCKC0_RESET |
  794. MRDCKC1_RESET |
  795. MRDCKD0_RESET |
  796. MRDCKD1_RESET);
  797. dll_cntl = 0xff000000;
  798. spll_func_cntl |= SPLL_RESET | SPLL_SLEEP | SPLL_BYPASS_EN;
  799. spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
  800. spll_func_cntl_2 |= SCLK_MUX_SEL(4);
  801. table->ACPIState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL = cpu_to_be32(mpll_ad_func_cntl);
  802. table->ACPIState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL_2 = cpu_to_be32(mpll_ad_func_cntl_2);
  803. table->ACPIState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL = cpu_to_be32(mpll_dq_func_cntl);
  804. table->ACPIState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL_2 = cpu_to_be32(mpll_dq_func_cntl_2);
  805. table->ACPIState.levels[0].mclk.mclk770.vMCLK_PWRMGT_CNTL = cpu_to_be32(mclk_pwrmgt_cntl);
  806. table->ACPIState.levels[0].mclk.mclk770.vDLL_CNTL = cpu_to_be32(dll_cntl);
  807. table->ACPIState.levels[0].mclk.mclk770.mclk_value = 0;
  808. table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL = cpu_to_be32(spll_func_cntl);
  809. table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_2 = cpu_to_be32(spll_func_cntl_2);
  810. table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_3 = cpu_to_be32(spll_func_cntl_3);
  811. table->ACPIState.levels[0].sclk.sclk_value = 0;
  812. rv770_populate_mvdd_value(rdev, 0, &table->ACPIState.levels[0].mvdd);
  813. table->ACPIState.levels[1] = table->ACPIState.levels[0];
  814. table->ACPIState.levels[2] = table->ACPIState.levels[0];
  815. return 0;
  816. }
  817. int rv770_populate_initial_mvdd_value(struct radeon_device *rdev,
  818. RV770_SMC_VOLTAGE_VALUE *voltage)
  819. {
  820. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  821. if ((pi->s0_vid_lower_smio_cntl & pi->mvdd_mask_low) ==
  822. (pi->mvdd_low_smio[MVDD_LOW_INDEX] & pi->mvdd_mask_low) ) {
  823. voltage->index = MVDD_LOW_INDEX;
  824. voltage->value = cpu_to_be16(MVDD_LOW_VALUE);
  825. } else {
  826. voltage->index = MVDD_HIGH_INDEX;
  827. voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
  828. }
  829. return 0;
  830. }
  831. static int rv770_populate_smc_initial_state(struct radeon_device *rdev,
  832. struct radeon_ps *radeon_state,
  833. RV770_SMC_STATETABLE *table)
  834. {
  835. struct rv7xx_ps *initial_state = rv770_get_ps(radeon_state);
  836. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  837. u32 a_t;
  838. table->initialState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL =
  839. cpu_to_be32(pi->clk_regs.rv770.mpll_ad_func_cntl);
  840. table->initialState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL_2 =
  841. cpu_to_be32(pi->clk_regs.rv770.mpll_ad_func_cntl_2);
  842. table->initialState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL =
  843. cpu_to_be32(pi->clk_regs.rv770.mpll_dq_func_cntl);
  844. table->initialState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL_2 =
  845. cpu_to_be32(pi->clk_regs.rv770.mpll_dq_func_cntl_2);
  846. table->initialState.levels[0].mclk.mclk770.vMCLK_PWRMGT_CNTL =
  847. cpu_to_be32(pi->clk_regs.rv770.mclk_pwrmgt_cntl);
  848. table->initialState.levels[0].mclk.mclk770.vDLL_CNTL =
  849. cpu_to_be32(pi->clk_regs.rv770.dll_cntl);
  850. table->initialState.levels[0].mclk.mclk770.vMPLL_SS =
  851. cpu_to_be32(pi->clk_regs.rv770.mpll_ss1);
  852. table->initialState.levels[0].mclk.mclk770.vMPLL_SS2 =
  853. cpu_to_be32(pi->clk_regs.rv770.mpll_ss2);
  854. table->initialState.levels[0].mclk.mclk770.mclk_value =
  855. cpu_to_be32(initial_state->low.mclk);
  856. table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL =
  857. cpu_to_be32(pi->clk_regs.rv770.cg_spll_func_cntl);
  858. table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_2 =
  859. cpu_to_be32(pi->clk_regs.rv770.cg_spll_func_cntl_2);
  860. table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_3 =
  861. cpu_to_be32(pi->clk_regs.rv770.cg_spll_func_cntl_3);
  862. table->initialState.levels[0].sclk.vCG_SPLL_SPREAD_SPECTRUM =
  863. cpu_to_be32(pi->clk_regs.rv770.cg_spll_spread_spectrum);
  864. table->initialState.levels[0].sclk.vCG_SPLL_SPREAD_SPECTRUM_2 =
  865. cpu_to_be32(pi->clk_regs.rv770.cg_spll_spread_spectrum_2);
  866. table->initialState.levels[0].sclk.sclk_value =
  867. cpu_to_be32(initial_state->low.sclk);
  868. table->initialState.levels[0].arbValue = MC_CG_ARB_FREQ_F0;
  869. table->initialState.levels[0].seqValue =
  870. rv770_get_seq_value(rdev, &initial_state->low);
  871. rv770_populate_vddc_value(rdev,
  872. initial_state->low.vddc,
  873. &table->initialState.levels[0].vddc);
  874. rv770_populate_initial_mvdd_value(rdev,
  875. &table->initialState.levels[0].mvdd);
  876. a_t = CG_R(0xffff) | CG_L(0);
  877. table->initialState.levels[0].aT = cpu_to_be32(a_t);
  878. table->initialState.levels[0].bSP = cpu_to_be32(pi->dsp);
  879. if (pi->boot_in_gen2)
  880. table->initialState.levels[0].gen2PCIE = 1;
  881. else
  882. table->initialState.levels[0].gen2PCIE = 0;
  883. if (initial_state->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2)
  884. table->initialState.levels[0].gen2XSP = 1;
  885. else
  886. table->initialState.levels[0].gen2XSP = 0;
  887. if (rdev->family == CHIP_RV740) {
  888. if (pi->mem_gddr5) {
  889. if (initial_state->low.mclk <= pi->mclk_strobe_mode_threshold)
  890. table->initialState.levels[0].strobeMode =
  891. rv740_get_mclk_frequency_ratio(initial_state->low.mclk) | 0x10;
  892. else
  893. table->initialState.levels[0].strobeMode = 0;
  894. if (initial_state->low.mclk >= pi->mclk_edc_enable_threshold)
  895. table->initialState.levels[0].mcFlags = SMC_MC_EDC_RD_FLAG | SMC_MC_EDC_WR_FLAG;
  896. else
  897. table->initialState.levels[0].mcFlags = 0;
  898. }
  899. }
  900. table->initialState.levels[1] = table->initialState.levels[0];
  901. table->initialState.levels[2] = table->initialState.levels[0];
  902. table->initialState.flags |= PPSMC_SWSTATE_FLAG_DC;
  903. return 0;
  904. }
  905. static int rv770_populate_smc_vddc_table(struct radeon_device *rdev,
  906. RV770_SMC_STATETABLE *table)
  907. {
  908. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  909. int i;
  910. for (i = 0; i < pi->valid_vddc_entries; i++) {
  911. table->highSMIO[pi->vddc_table[i].vddc_index] =
  912. pi->vddc_table[i].high_smio;
  913. table->lowSMIO[pi->vddc_table[i].vddc_index] =
  914. cpu_to_be32(pi->vddc_table[i].low_smio);
  915. }
  916. table->voltageMaskTable.highMask[RV770_SMC_VOLTAGEMASK_VDDC] = 0;
  917. table->voltageMaskTable.lowMask[RV770_SMC_VOLTAGEMASK_VDDC] =
  918. cpu_to_be32(pi->vddc_mask_low);
  919. for (i = 0;
  920. ((i < pi->valid_vddc_entries) &&
  921. (pi->max_vddc_in_table >
  922. pi->vddc_table[i].vddc));
  923. i++);
  924. table->maxVDDCIndexInPPTable =
  925. pi->vddc_table[i].vddc_index;
  926. return 0;
  927. }
  928. static int rv770_populate_smc_mvdd_table(struct radeon_device *rdev,
  929. RV770_SMC_STATETABLE *table)
  930. {
  931. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  932. if (pi->mvdd_control) {
  933. table->lowSMIO[MVDD_HIGH_INDEX] |=
  934. cpu_to_be32(pi->mvdd_low_smio[MVDD_HIGH_INDEX]);
  935. table->lowSMIO[MVDD_LOW_INDEX] |=
  936. cpu_to_be32(pi->mvdd_low_smio[MVDD_LOW_INDEX]);
  937. table->voltageMaskTable.highMask[RV770_SMC_VOLTAGEMASK_MVDD] = 0;
  938. table->voltageMaskTable.lowMask[RV770_SMC_VOLTAGEMASK_MVDD] =
  939. cpu_to_be32(pi->mvdd_mask_low);
  940. }
  941. return 0;
  942. }
  943. static int rv770_init_smc_table(struct radeon_device *rdev,
  944. struct radeon_ps *radeon_boot_state)
  945. {
  946. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  947. struct rv7xx_ps *boot_state = rv770_get_ps(radeon_boot_state);
  948. RV770_SMC_STATETABLE *table = &pi->smc_statetable;
  949. int ret;
  950. memset(table, 0, sizeof(RV770_SMC_STATETABLE));
  951. pi->boot_sclk = boot_state->low.sclk;
  952. rv770_populate_smc_vddc_table(rdev, table);
  953. rv770_populate_smc_mvdd_table(rdev, table);
  954. switch (rdev->pm.int_thermal_type) {
  955. case THERMAL_TYPE_RV770:
  956. case THERMAL_TYPE_ADT7473_WITH_INTERNAL:
  957. table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_INTERNAL;
  958. break;
  959. case THERMAL_TYPE_NONE:
  960. table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_NONE;
  961. break;
  962. case THERMAL_TYPE_EXTERNAL_GPIO:
  963. default:
  964. table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_EXTERNAL;
  965. break;
  966. }
  967. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_HARDWAREDC) {
  968. table->systemFlags |= PPSMC_SYSTEMFLAG_GPIO_DC;
  969. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_DONT_WAIT_FOR_VBLANK_ON_ALERT)
  970. table->extraFlags |= PPSMC_EXTRAFLAGS_AC2DC_DONT_WAIT_FOR_VBLANK;
  971. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_GOTO_BOOT_ON_ALERT)
  972. table->extraFlags |= PPSMC_EXTRAFLAGS_AC2DC_ACTION_GOTOINITIALSTATE;
  973. }
  974. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC)
  975. table->systemFlags |= PPSMC_SYSTEMFLAG_STEPVDDC;
  976. if (pi->mem_gddr5)
  977. table->systemFlags |= PPSMC_SYSTEMFLAG_GDDR5;
  978. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  979. ret = rv730_populate_smc_initial_state(rdev, radeon_boot_state, table);
  980. else
  981. ret = rv770_populate_smc_initial_state(rdev, radeon_boot_state, table);
  982. if (ret)
  983. return ret;
  984. if (rdev->family == CHIP_RV740)
  985. ret = rv740_populate_smc_acpi_state(rdev, table);
  986. else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  987. ret = rv730_populate_smc_acpi_state(rdev, table);
  988. else
  989. ret = rv770_populate_smc_acpi_state(rdev, table);
  990. if (ret)
  991. return ret;
  992. table->driverState = table->initialState;
  993. return rv770_copy_bytes_to_smc(rdev,
  994. pi->state_table_start,
  995. (const u8 *)table,
  996. sizeof(RV770_SMC_STATETABLE),
  997. pi->sram_end);
  998. }
  999. static int rv770_construct_vddc_table(struct radeon_device *rdev)
  1000. {
  1001. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1002. u16 min, max, step;
  1003. u32 steps = 0;
  1004. u8 vddc_index = 0;
  1005. u32 i;
  1006. radeon_atom_get_min_voltage(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, &min);
  1007. radeon_atom_get_max_voltage(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, &max);
  1008. radeon_atom_get_voltage_step(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, &step);
  1009. steps = (max - min) / step + 1;
  1010. if (steps > MAX_NO_VREG_STEPS)
  1011. return -EINVAL;
  1012. for (i = 0; i < steps; i++) {
  1013. u32 gpio_pins, gpio_mask;
  1014. pi->vddc_table[i].vddc = (u16)(min + i * step);
  1015. radeon_atom_get_voltage_gpio_settings(rdev,
  1016. pi->vddc_table[i].vddc,
  1017. SET_VOLTAGE_TYPE_ASIC_VDDC,
  1018. &gpio_pins, &gpio_mask);
  1019. pi->vddc_table[i].low_smio = gpio_pins & gpio_mask;
  1020. pi->vddc_table[i].high_smio = 0;
  1021. pi->vddc_mask_low = gpio_mask;
  1022. if (i > 0) {
  1023. if ((pi->vddc_table[i].low_smio !=
  1024. pi->vddc_table[i - 1].low_smio ) ||
  1025. (pi->vddc_table[i].high_smio !=
  1026. pi->vddc_table[i - 1].high_smio))
  1027. vddc_index++;
  1028. }
  1029. pi->vddc_table[i].vddc_index = vddc_index;
  1030. }
  1031. pi->valid_vddc_entries = (u8)steps;
  1032. return 0;
  1033. }
  1034. static u32 rv770_get_mclk_split_point(struct atom_memory_info *memory_info)
  1035. {
  1036. if (memory_info->mem_type == MEM_TYPE_GDDR3)
  1037. return 30000;
  1038. return 0;
  1039. }
  1040. static int rv770_get_mvdd_pin_configuration(struct radeon_device *rdev)
  1041. {
  1042. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1043. u32 gpio_pins, gpio_mask;
  1044. radeon_atom_get_voltage_gpio_settings(rdev,
  1045. MVDD_HIGH_VALUE, SET_VOLTAGE_TYPE_ASIC_MVDDC,
  1046. &gpio_pins, &gpio_mask);
  1047. pi->mvdd_mask_low = gpio_mask;
  1048. pi->mvdd_low_smio[MVDD_HIGH_INDEX] =
  1049. gpio_pins & gpio_mask;
  1050. radeon_atom_get_voltage_gpio_settings(rdev,
  1051. MVDD_LOW_VALUE, SET_VOLTAGE_TYPE_ASIC_MVDDC,
  1052. &gpio_pins, &gpio_mask);
  1053. pi->mvdd_low_smio[MVDD_LOW_INDEX] =
  1054. gpio_pins & gpio_mask;
  1055. return 0;
  1056. }
  1057. u8 rv770_get_memory_module_index(struct radeon_device *rdev)
  1058. {
  1059. return (u8) ((RREG32(BIOS_SCRATCH_4) >> 16) & 0xff);
  1060. }
  1061. static int rv770_get_mvdd_configuration(struct radeon_device *rdev)
  1062. {
  1063. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1064. u8 memory_module_index;
  1065. struct atom_memory_info memory_info;
  1066. memory_module_index = rv770_get_memory_module_index(rdev);
  1067. if (radeon_atom_get_memory_info(rdev, memory_module_index, &memory_info)) {
  1068. pi->mvdd_control = false;
  1069. return 0;
  1070. }
  1071. pi->mvdd_split_frequency =
  1072. rv770_get_mclk_split_point(&memory_info);
  1073. if (pi->mvdd_split_frequency == 0) {
  1074. pi->mvdd_control = false;
  1075. return 0;
  1076. }
  1077. return rv770_get_mvdd_pin_configuration(rdev);
  1078. }
  1079. void rv770_enable_voltage_control(struct radeon_device *rdev,
  1080. bool enable)
  1081. {
  1082. if (enable)
  1083. WREG32_P(GENERAL_PWRMGT, VOLT_PWRMGT_EN, ~VOLT_PWRMGT_EN);
  1084. else
  1085. WREG32_P(GENERAL_PWRMGT, 0, ~VOLT_PWRMGT_EN);
  1086. }
  1087. static void rv770_program_display_gap(struct radeon_device *rdev)
  1088. {
  1089. u32 tmp = RREG32(CG_DISPLAY_GAP_CNTL);
  1090. tmp &= ~(DISP1_GAP_MCHG_MASK | DISP2_GAP_MCHG_MASK);
  1091. if (rdev->pm.dpm.new_active_crtcs & 1) {
  1092. tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK);
  1093. tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
  1094. } else if (rdev->pm.dpm.new_active_crtcs & 2) {
  1095. tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
  1096. tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK);
  1097. } else {
  1098. tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
  1099. tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
  1100. }
  1101. WREG32(CG_DISPLAY_GAP_CNTL, tmp);
  1102. }
  1103. static void rv770_enable_dynamic_pcie_gen2(struct radeon_device *rdev,
  1104. bool enable)
  1105. {
  1106. rv770_enable_bif_dynamic_pcie_gen2(rdev, enable);
  1107. if (enable)
  1108. WREG32_P(GENERAL_PWRMGT, ENABLE_GEN2PCIE, ~ENABLE_GEN2PCIE);
  1109. else
  1110. WREG32_P(GENERAL_PWRMGT, 0, ~ENABLE_GEN2PCIE);
  1111. }
  1112. static void r7xx_program_memory_timing_parameters(struct radeon_device *rdev,
  1113. struct radeon_ps *radeon_new_state)
  1114. {
  1115. if ((rdev->family == CHIP_RV730) ||
  1116. (rdev->family == CHIP_RV710) ||
  1117. (rdev->family == CHIP_RV740))
  1118. rv730_program_memory_timing_parameters(rdev, radeon_new_state);
  1119. else
  1120. rv770_program_memory_timing_parameters(rdev, radeon_new_state);
  1121. }
  1122. static int rv770_upload_sw_state(struct radeon_device *rdev,
  1123. struct radeon_ps *radeon_new_state)
  1124. {
  1125. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1126. u16 address = pi->state_table_start +
  1127. offsetof(RV770_SMC_STATETABLE, driverState);
  1128. RV770_SMC_SWSTATE state = { 0 };
  1129. int ret;
  1130. ret = rv770_convert_power_state_to_smc(rdev, radeon_new_state, &state);
  1131. if (ret)
  1132. return ret;
  1133. return rv770_copy_bytes_to_smc(rdev, address, (const u8 *)&state,
  1134. sizeof(RV770_SMC_SWSTATE),
  1135. pi->sram_end);
  1136. }
  1137. int rv770_halt_smc(struct radeon_device *rdev)
  1138. {
  1139. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_Halt) != PPSMC_Result_OK)
  1140. return -EINVAL;
  1141. if (rv770_wait_for_smc_inactive(rdev) != PPSMC_Result_OK)
  1142. return -EINVAL;
  1143. return 0;
  1144. }
  1145. int rv770_resume_smc(struct radeon_device *rdev)
  1146. {
  1147. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_Resume) != PPSMC_Result_OK)
  1148. return -EINVAL;
  1149. return 0;
  1150. }
  1151. int rv770_set_sw_state(struct radeon_device *rdev)
  1152. {
  1153. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_SwitchToSwState) != PPSMC_Result_OK)
  1154. return -EINVAL;
  1155. return 0;
  1156. }
  1157. int rv770_set_boot_state(struct radeon_device *rdev)
  1158. {
  1159. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_SwitchToInitialState) != PPSMC_Result_OK)
  1160. return -EINVAL;
  1161. return 0;
  1162. }
  1163. void rv770_set_uvd_clock_before_set_eng_clock(struct radeon_device *rdev,
  1164. struct radeon_ps *new_ps,
  1165. struct radeon_ps *old_ps)
  1166. {
  1167. struct rv7xx_ps *new_state = rv770_get_ps(new_ps);
  1168. struct rv7xx_ps *current_state = rv770_get_ps(old_ps);
  1169. if ((new_ps->vclk == old_ps->vclk) &&
  1170. (new_ps->dclk == old_ps->dclk))
  1171. return;
  1172. if (new_state->high.sclk >= current_state->high.sclk)
  1173. return;
  1174. radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk);
  1175. }
  1176. void rv770_set_uvd_clock_after_set_eng_clock(struct radeon_device *rdev,
  1177. struct radeon_ps *new_ps,
  1178. struct radeon_ps *old_ps)
  1179. {
  1180. struct rv7xx_ps *new_state = rv770_get_ps(new_ps);
  1181. struct rv7xx_ps *current_state = rv770_get_ps(old_ps);
  1182. if ((new_ps->vclk == old_ps->vclk) &&
  1183. (new_ps->dclk == old_ps->dclk))
  1184. return;
  1185. if (new_state->high.sclk < current_state->high.sclk)
  1186. return;
  1187. radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk);
  1188. }
  1189. int rv770_restrict_performance_levels_before_switch(struct radeon_device *rdev)
  1190. {
  1191. if (rv770_send_msg_to_smc(rdev, (PPSMC_Msg)(PPSMC_MSG_NoForcedLevel)) != PPSMC_Result_OK)
  1192. return -EINVAL;
  1193. if (rv770_send_msg_to_smc(rdev, (PPSMC_Msg)(PPSMC_MSG_TwoLevelsDisabled)) != PPSMC_Result_OK)
  1194. return -EINVAL;
  1195. return 0;
  1196. }
  1197. int rv770_dpm_force_performance_level(struct radeon_device *rdev,
  1198. enum radeon_dpm_forced_level level)
  1199. {
  1200. PPSMC_Msg msg;
  1201. if (level == RADEON_DPM_FORCED_LEVEL_HIGH) {
  1202. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_ZeroLevelsDisabled) != PPSMC_Result_OK)
  1203. return -EINVAL;
  1204. msg = PPSMC_MSG_ForceHigh;
  1205. } else if (level == RADEON_DPM_FORCED_LEVEL_LOW) {
  1206. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_NoForcedLevel) != PPSMC_Result_OK)
  1207. return -EINVAL;
  1208. msg = (PPSMC_Msg)(PPSMC_MSG_TwoLevelsDisabled);
  1209. } else {
  1210. if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_NoForcedLevel) != PPSMC_Result_OK)
  1211. return -EINVAL;
  1212. msg = (PPSMC_Msg)(PPSMC_MSG_ZeroLevelsDisabled);
  1213. }
  1214. if (rv770_send_msg_to_smc(rdev, msg) != PPSMC_Result_OK)
  1215. return -EINVAL;
  1216. rdev->pm.dpm.forced_level = level;
  1217. return 0;
  1218. }
  1219. void r7xx_start_smc(struct radeon_device *rdev)
  1220. {
  1221. rv770_start_smc(rdev);
  1222. rv770_start_smc_clock(rdev);
  1223. }
  1224. void r7xx_stop_smc(struct radeon_device *rdev)
  1225. {
  1226. rv770_reset_smc(rdev);
  1227. rv770_stop_smc_clock(rdev);
  1228. }
  1229. static void rv770_read_clock_registers(struct radeon_device *rdev)
  1230. {
  1231. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1232. pi->clk_regs.rv770.cg_spll_func_cntl =
  1233. RREG32(CG_SPLL_FUNC_CNTL);
  1234. pi->clk_regs.rv770.cg_spll_func_cntl_2 =
  1235. RREG32(CG_SPLL_FUNC_CNTL_2);
  1236. pi->clk_regs.rv770.cg_spll_func_cntl_3 =
  1237. RREG32(CG_SPLL_FUNC_CNTL_3);
  1238. pi->clk_regs.rv770.cg_spll_spread_spectrum =
  1239. RREG32(CG_SPLL_SPREAD_SPECTRUM);
  1240. pi->clk_regs.rv770.cg_spll_spread_spectrum_2 =
  1241. RREG32(CG_SPLL_SPREAD_SPECTRUM_2);
  1242. pi->clk_regs.rv770.mpll_ad_func_cntl =
  1243. RREG32(MPLL_AD_FUNC_CNTL);
  1244. pi->clk_regs.rv770.mpll_ad_func_cntl_2 =
  1245. RREG32(MPLL_AD_FUNC_CNTL_2);
  1246. pi->clk_regs.rv770.mpll_dq_func_cntl =
  1247. RREG32(MPLL_DQ_FUNC_CNTL);
  1248. pi->clk_regs.rv770.mpll_dq_func_cntl_2 =
  1249. RREG32(MPLL_DQ_FUNC_CNTL_2);
  1250. pi->clk_regs.rv770.mclk_pwrmgt_cntl =
  1251. RREG32(MCLK_PWRMGT_CNTL);
  1252. pi->clk_regs.rv770.dll_cntl = RREG32(DLL_CNTL);
  1253. }
  1254. static void r7xx_read_clock_registers(struct radeon_device *rdev)
  1255. {
  1256. if (rdev->family == CHIP_RV740)
  1257. rv740_read_clock_registers(rdev);
  1258. else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1259. rv730_read_clock_registers(rdev);
  1260. else
  1261. rv770_read_clock_registers(rdev);
  1262. }
  1263. void rv770_read_voltage_smio_registers(struct radeon_device *rdev)
  1264. {
  1265. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1266. pi->s0_vid_lower_smio_cntl =
  1267. RREG32(S0_VID_LOWER_SMIO_CNTL);
  1268. }
  1269. void rv770_reset_smio_status(struct radeon_device *rdev)
  1270. {
  1271. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1272. u32 sw_smio_index, vid_smio_cntl;
  1273. sw_smio_index =
  1274. (RREG32(GENERAL_PWRMGT) & SW_SMIO_INDEX_MASK) >> SW_SMIO_INDEX_SHIFT;
  1275. switch (sw_smio_index) {
  1276. case 3:
  1277. vid_smio_cntl = RREG32(S3_VID_LOWER_SMIO_CNTL);
  1278. break;
  1279. case 2:
  1280. vid_smio_cntl = RREG32(S2_VID_LOWER_SMIO_CNTL);
  1281. break;
  1282. case 1:
  1283. vid_smio_cntl = RREG32(S1_VID_LOWER_SMIO_CNTL);
  1284. break;
  1285. case 0:
  1286. return;
  1287. default:
  1288. vid_smio_cntl = pi->s0_vid_lower_smio_cntl;
  1289. break;
  1290. }
  1291. WREG32(S0_VID_LOWER_SMIO_CNTL, vid_smio_cntl);
  1292. WREG32_P(GENERAL_PWRMGT, SW_SMIO_INDEX(0), ~SW_SMIO_INDEX_MASK);
  1293. }
  1294. void rv770_get_memory_type(struct radeon_device *rdev)
  1295. {
  1296. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1297. u32 tmp;
  1298. tmp = RREG32(MC_SEQ_MISC0);
  1299. if (((tmp & MC_SEQ_MISC0_GDDR5_MASK) >> MC_SEQ_MISC0_GDDR5_SHIFT) ==
  1300. MC_SEQ_MISC0_GDDR5_VALUE)
  1301. pi->mem_gddr5 = true;
  1302. else
  1303. pi->mem_gddr5 = false;
  1304. }
  1305. void rv770_get_pcie_gen2_status(struct radeon_device *rdev)
  1306. {
  1307. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1308. u32 tmp;
  1309. tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL);
  1310. if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2) &&
  1311. (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2))
  1312. pi->pcie_gen2 = true;
  1313. else
  1314. pi->pcie_gen2 = false;
  1315. if (pi->pcie_gen2) {
  1316. if (tmp & LC_CURRENT_DATA_RATE)
  1317. pi->boot_in_gen2 = true;
  1318. else
  1319. pi->boot_in_gen2 = false;
  1320. } else
  1321. pi->boot_in_gen2 = false;
  1322. }
  1323. #if 0
  1324. static int rv770_enter_ulp_state(struct radeon_device *rdev)
  1325. {
  1326. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1327. if (pi->gfx_clock_gating) {
  1328. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
  1329. WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
  1330. WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
  1331. RREG32(GB_TILING_CONFIG);
  1332. }
  1333. WREG32_P(SMC_MSG, HOST_SMC_MSG(PPSMC_MSG_SwitchToMinimumPower),
  1334. ~HOST_SMC_MSG_MASK);
  1335. udelay(7000);
  1336. return 0;
  1337. }
  1338. static int rv770_exit_ulp_state(struct radeon_device *rdev)
  1339. {
  1340. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1341. int i;
  1342. WREG32_P(SMC_MSG, HOST_SMC_MSG(PPSMC_MSG_ResumeFromMinimumPower),
  1343. ~HOST_SMC_MSG_MASK);
  1344. udelay(7000);
  1345. for (i = 0; i < rdev->usec_timeout; i++) {
  1346. if (((RREG32(SMC_MSG) & HOST_SMC_RESP_MASK) >> HOST_SMC_RESP_SHIFT) == 1)
  1347. break;
  1348. udelay(1000);
  1349. }
  1350. if (pi->gfx_clock_gating)
  1351. WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
  1352. return 0;
  1353. }
  1354. #endif
  1355. static void rv770_get_mclk_odt_threshold(struct radeon_device *rdev)
  1356. {
  1357. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1358. u8 memory_module_index;
  1359. struct atom_memory_info memory_info;
  1360. pi->mclk_odt_threshold = 0;
  1361. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710)) {
  1362. memory_module_index = rv770_get_memory_module_index(rdev);
  1363. if (radeon_atom_get_memory_info(rdev, memory_module_index, &memory_info))
  1364. return;
  1365. if (memory_info.mem_type == MEM_TYPE_DDR2 ||
  1366. memory_info.mem_type == MEM_TYPE_DDR3)
  1367. pi->mclk_odt_threshold = 30000;
  1368. }
  1369. }
  1370. void rv770_get_max_vddc(struct radeon_device *rdev)
  1371. {
  1372. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1373. u16 vddc;
  1374. if (radeon_atom_get_max_vddc(rdev, 0, 0, &vddc))
  1375. pi->max_vddc = 0;
  1376. else
  1377. pi->max_vddc = vddc;
  1378. }
  1379. void rv770_program_response_times(struct radeon_device *rdev)
  1380. {
  1381. u32 voltage_response_time, backbias_response_time;
  1382. u32 acpi_delay_time, vbi_time_out;
  1383. u32 vddc_dly, bb_dly, acpi_dly, vbi_dly;
  1384. u32 reference_clock;
  1385. voltage_response_time = (u32)rdev->pm.dpm.voltage_response_time;
  1386. backbias_response_time = (u32)rdev->pm.dpm.backbias_response_time;
  1387. if (voltage_response_time == 0)
  1388. voltage_response_time = 1000;
  1389. if (backbias_response_time == 0)
  1390. backbias_response_time = 1000;
  1391. acpi_delay_time = 15000;
  1392. vbi_time_out = 100000;
  1393. reference_clock = radeon_get_xclk(rdev);
  1394. vddc_dly = (voltage_response_time * reference_clock) / 1600;
  1395. bb_dly = (backbias_response_time * reference_clock) / 1600;
  1396. acpi_dly = (acpi_delay_time * reference_clock) / 1600;
  1397. vbi_dly = (vbi_time_out * reference_clock) / 1600;
  1398. rv770_write_smc_soft_register(rdev,
  1399. RV770_SMC_SOFT_REGISTER_delay_vreg, vddc_dly);
  1400. rv770_write_smc_soft_register(rdev,
  1401. RV770_SMC_SOFT_REGISTER_delay_bbias, bb_dly);
  1402. rv770_write_smc_soft_register(rdev,
  1403. RV770_SMC_SOFT_REGISTER_delay_acpi, acpi_dly);
  1404. rv770_write_smc_soft_register(rdev,
  1405. RV770_SMC_SOFT_REGISTER_mclk_chg_timeout, vbi_dly);
  1406. #if 0
  1407. /* XXX look up hw revision */
  1408. if (WEKIVA_A21)
  1409. rv770_write_smc_soft_register(rdev,
  1410. RV770_SMC_SOFT_REGISTER_baby_step_timer,
  1411. 0x10);
  1412. #endif
  1413. }
  1414. static void rv770_program_dcodt_before_state_switch(struct radeon_device *rdev,
  1415. struct radeon_ps *radeon_new_state,
  1416. struct radeon_ps *radeon_current_state)
  1417. {
  1418. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1419. struct rv7xx_ps *new_state = rv770_get_ps(radeon_new_state);
  1420. struct rv7xx_ps *current_state = rv770_get_ps(radeon_current_state);
  1421. bool current_use_dc = false;
  1422. bool new_use_dc = false;
  1423. if (pi->mclk_odt_threshold == 0)
  1424. return;
  1425. if (current_state->high.mclk <= pi->mclk_odt_threshold)
  1426. current_use_dc = true;
  1427. if (new_state->high.mclk <= pi->mclk_odt_threshold)
  1428. new_use_dc = true;
  1429. if (current_use_dc == new_use_dc)
  1430. return;
  1431. if (!current_use_dc && new_use_dc)
  1432. return;
  1433. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1434. rv730_program_dcodt(rdev, new_use_dc);
  1435. }
  1436. static void rv770_program_dcodt_after_state_switch(struct radeon_device *rdev,
  1437. struct radeon_ps *radeon_new_state,
  1438. struct radeon_ps *radeon_current_state)
  1439. {
  1440. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1441. struct rv7xx_ps *new_state = rv770_get_ps(radeon_new_state);
  1442. struct rv7xx_ps *current_state = rv770_get_ps(radeon_current_state);
  1443. bool current_use_dc = false;
  1444. bool new_use_dc = false;
  1445. if (pi->mclk_odt_threshold == 0)
  1446. return;
  1447. if (current_state->high.mclk <= pi->mclk_odt_threshold)
  1448. current_use_dc = true;
  1449. if (new_state->high.mclk <= pi->mclk_odt_threshold)
  1450. new_use_dc = true;
  1451. if (current_use_dc == new_use_dc)
  1452. return;
  1453. if (current_use_dc && !new_use_dc)
  1454. return;
  1455. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1456. rv730_program_dcodt(rdev, new_use_dc);
  1457. }
  1458. static void rv770_retrieve_odt_values(struct radeon_device *rdev)
  1459. {
  1460. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1461. if (pi->mclk_odt_threshold == 0)
  1462. return;
  1463. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1464. rv730_get_odt_values(rdev);
  1465. }
  1466. static void rv770_set_dpm_event_sources(struct radeon_device *rdev, u32 sources)
  1467. {
  1468. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1469. bool want_thermal_protection;
  1470. enum radeon_dpm_event_src dpm_event_src;
  1471. switch (sources) {
  1472. case 0:
  1473. default:
  1474. want_thermal_protection = false;
  1475. break;
  1476. case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL):
  1477. want_thermal_protection = true;
  1478. dpm_event_src = RADEON_DPM_EVENT_SRC_DIGITAL;
  1479. break;
  1480. case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL):
  1481. want_thermal_protection = true;
  1482. dpm_event_src = RADEON_DPM_EVENT_SRC_EXTERNAL;
  1483. break;
  1484. case ((1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL) |
  1485. (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL)):
  1486. want_thermal_protection = true;
  1487. dpm_event_src = RADEON_DPM_EVENT_SRC_DIGIAL_OR_EXTERNAL;
  1488. break;
  1489. }
  1490. if (want_thermal_protection) {
  1491. WREG32_P(CG_THERMAL_CTRL, DPM_EVENT_SRC(dpm_event_src), ~DPM_EVENT_SRC_MASK);
  1492. if (pi->thermal_protection)
  1493. WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS);
  1494. } else {
  1495. WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS);
  1496. }
  1497. }
  1498. void rv770_enable_auto_throttle_source(struct radeon_device *rdev,
  1499. enum radeon_dpm_auto_throttle_src source,
  1500. bool enable)
  1501. {
  1502. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1503. if (enable) {
  1504. if (!(pi->active_auto_throttle_sources & (1 << source))) {
  1505. pi->active_auto_throttle_sources |= 1 << source;
  1506. rv770_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
  1507. }
  1508. } else {
  1509. if (pi->active_auto_throttle_sources & (1 << source)) {
  1510. pi->active_auto_throttle_sources &= ~(1 << source);
  1511. rv770_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
  1512. }
  1513. }
  1514. }
  1515. int rv770_set_thermal_temperature_range(struct radeon_device *rdev,
  1516. int min_temp, int max_temp)
  1517. {
  1518. int low_temp = 0 * 1000;
  1519. int high_temp = 255 * 1000;
  1520. if (low_temp < min_temp)
  1521. low_temp = min_temp;
  1522. if (high_temp > max_temp)
  1523. high_temp = max_temp;
  1524. if (high_temp < low_temp) {
  1525. DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
  1526. return -EINVAL;
  1527. }
  1528. WREG32_P(CG_THERMAL_INT, DIG_THERM_INTH(high_temp / 1000), ~DIG_THERM_INTH_MASK);
  1529. WREG32_P(CG_THERMAL_INT, DIG_THERM_INTL(low_temp / 1000), ~DIG_THERM_INTL_MASK);
  1530. WREG32_P(CG_THERMAL_CTRL, DIG_THERM_DPM(high_temp / 1000), ~DIG_THERM_DPM_MASK);
  1531. rdev->pm.dpm.thermal.min_temp = low_temp;
  1532. rdev->pm.dpm.thermal.max_temp = high_temp;
  1533. return 0;
  1534. }
  1535. int rv770_dpm_enable(struct radeon_device *rdev)
  1536. {
  1537. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1538. struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
  1539. int ret;
  1540. if (pi->gfx_clock_gating)
  1541. rv770_restore_cgcg(rdev);
  1542. if (rv770_dpm_enabled(rdev))
  1543. return -EINVAL;
  1544. if (pi->voltage_control) {
  1545. rv770_enable_voltage_control(rdev, true);
  1546. ret = rv770_construct_vddc_table(rdev);
  1547. if (ret) {
  1548. DRM_ERROR("rv770_construct_vddc_table failed\n");
  1549. return ret;
  1550. }
  1551. }
  1552. if (pi->dcodt)
  1553. rv770_retrieve_odt_values(rdev);
  1554. if (pi->mvdd_control) {
  1555. ret = rv770_get_mvdd_configuration(rdev);
  1556. if (ret) {
  1557. DRM_ERROR("rv770_get_mvdd_configuration failed\n");
  1558. return ret;
  1559. }
  1560. }
  1561. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS)
  1562. rv770_enable_backbias(rdev, true);
  1563. rv770_enable_spread_spectrum(rdev, true);
  1564. if (pi->thermal_protection)
  1565. rv770_enable_thermal_protection(rdev, true);
  1566. rv770_program_mpll_timing_parameters(rdev);
  1567. rv770_setup_bsp(rdev);
  1568. rv770_program_git(rdev);
  1569. rv770_program_tp(rdev);
  1570. rv770_program_tpp(rdev);
  1571. rv770_program_sstp(rdev);
  1572. rv770_program_engine_speed_parameters(rdev);
  1573. rv770_enable_display_gap(rdev);
  1574. rv770_program_vc(rdev);
  1575. if (pi->dynamic_pcie_gen2)
  1576. rv770_enable_dynamic_pcie_gen2(rdev, true);
  1577. ret = rv770_upload_firmware(rdev);
  1578. if (ret) {
  1579. DRM_ERROR("rv770_upload_firmware failed\n");
  1580. return ret;
  1581. }
  1582. ret = rv770_init_smc_table(rdev, boot_ps);
  1583. if (ret) {
  1584. DRM_ERROR("rv770_init_smc_table failed\n");
  1585. return ret;
  1586. }
  1587. rv770_program_response_times(rdev);
  1588. r7xx_start_smc(rdev);
  1589. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1590. rv730_start_dpm(rdev);
  1591. else
  1592. rv770_start_dpm(rdev);
  1593. if (pi->gfx_clock_gating)
  1594. rv770_gfx_clock_gating_enable(rdev, true);
  1595. if (pi->mg_clock_gating)
  1596. rv770_mg_clock_gating_enable(rdev, true);
  1597. if (rdev->irq.installed &&
  1598. r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  1599. PPSMC_Result result;
  1600. ret = rv770_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
  1601. if (ret)
  1602. return ret;
  1603. rdev->irq.dpm_thermal = true;
  1604. radeon_irq_set(rdev);
  1605. result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_EnableThermalInterrupt);
  1606. if (result != PPSMC_Result_OK)
  1607. DRM_DEBUG_KMS("Could not enable thermal interrupts.\n");
  1608. }
  1609. rv770_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, true);
  1610. return 0;
  1611. }
  1612. void rv770_dpm_disable(struct radeon_device *rdev)
  1613. {
  1614. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1615. if (!rv770_dpm_enabled(rdev))
  1616. return;
  1617. rv770_clear_vc(rdev);
  1618. if (pi->thermal_protection)
  1619. rv770_enable_thermal_protection(rdev, false);
  1620. rv770_enable_spread_spectrum(rdev, false);
  1621. if (pi->dynamic_pcie_gen2)
  1622. rv770_enable_dynamic_pcie_gen2(rdev, false);
  1623. if (rdev->irq.installed &&
  1624. r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  1625. rdev->irq.dpm_thermal = false;
  1626. radeon_irq_set(rdev);
  1627. }
  1628. if (pi->gfx_clock_gating)
  1629. rv770_gfx_clock_gating_enable(rdev, false);
  1630. if (pi->mg_clock_gating)
  1631. rv770_mg_clock_gating_enable(rdev, false);
  1632. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1633. rv730_stop_dpm(rdev);
  1634. else
  1635. rv770_stop_dpm(rdev);
  1636. r7xx_stop_smc(rdev);
  1637. rv770_reset_smio_status(rdev);
  1638. }
  1639. int rv770_dpm_set_power_state(struct radeon_device *rdev)
  1640. {
  1641. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1642. struct radeon_ps *new_ps = rdev->pm.dpm.requested_ps;
  1643. struct radeon_ps *old_ps = rdev->pm.dpm.current_ps;
  1644. int ret;
  1645. ret = rv770_restrict_performance_levels_before_switch(rdev);
  1646. if (ret) {
  1647. DRM_ERROR("rv770_restrict_performance_levels_before_switch failed\n");
  1648. return ret;
  1649. }
  1650. rv770_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
  1651. ret = rv770_halt_smc(rdev);
  1652. if (ret) {
  1653. DRM_ERROR("rv770_halt_smc failed\n");
  1654. return ret;
  1655. }
  1656. ret = rv770_upload_sw_state(rdev, new_ps);
  1657. if (ret) {
  1658. DRM_ERROR("rv770_upload_sw_state failed\n");
  1659. return ret;
  1660. }
  1661. r7xx_program_memory_timing_parameters(rdev, new_ps);
  1662. if (pi->dcodt)
  1663. rv770_program_dcodt_before_state_switch(rdev, new_ps, old_ps);
  1664. ret = rv770_resume_smc(rdev);
  1665. if (ret) {
  1666. DRM_ERROR("rv770_resume_smc failed\n");
  1667. return ret;
  1668. }
  1669. ret = rv770_set_sw_state(rdev);
  1670. if (ret) {
  1671. DRM_ERROR("rv770_set_sw_state failed\n");
  1672. return ret;
  1673. }
  1674. if (pi->dcodt)
  1675. rv770_program_dcodt_after_state_switch(rdev, new_ps, old_ps);
  1676. rv770_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
  1677. ret = rv770_dpm_force_performance_level(rdev, RADEON_DPM_FORCED_LEVEL_AUTO);
  1678. if (ret) {
  1679. DRM_ERROR("rv770_dpm_force_performance_level failed\n");
  1680. return ret;
  1681. }
  1682. return 0;
  1683. }
  1684. void rv770_dpm_reset_asic(struct radeon_device *rdev)
  1685. {
  1686. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1687. struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
  1688. rv770_restrict_performance_levels_before_switch(rdev);
  1689. if (pi->dcodt)
  1690. rv770_program_dcodt_before_state_switch(rdev, boot_ps, boot_ps);
  1691. rv770_set_boot_state(rdev);
  1692. if (pi->dcodt)
  1693. rv770_program_dcodt_after_state_switch(rdev, boot_ps, boot_ps);
  1694. }
  1695. void rv770_dpm_setup_asic(struct radeon_device *rdev)
  1696. {
  1697. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1698. r7xx_read_clock_registers(rdev);
  1699. rv770_read_voltage_smio_registers(rdev);
  1700. rv770_get_memory_type(rdev);
  1701. if (pi->dcodt)
  1702. rv770_get_mclk_odt_threshold(rdev);
  1703. rv770_get_pcie_gen2_status(rdev);
  1704. rv770_enable_acpi_pm(rdev);
  1705. if (radeon_aspm != 0) {
  1706. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L0s)
  1707. rv770_enable_l0s(rdev);
  1708. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L1)
  1709. rv770_enable_l1(rdev);
  1710. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_TURNOFFPLL_ASPML1)
  1711. rv770_enable_pll_sleep_in_l1(rdev);
  1712. }
  1713. }
  1714. void rv770_dpm_display_configuration_changed(struct radeon_device *rdev)
  1715. {
  1716. rv770_program_display_gap(rdev);
  1717. }
  1718. union power_info {
  1719. struct _ATOM_POWERPLAY_INFO info;
  1720. struct _ATOM_POWERPLAY_INFO_V2 info_2;
  1721. struct _ATOM_POWERPLAY_INFO_V3 info_3;
  1722. struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
  1723. struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
  1724. struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
  1725. };
  1726. union pplib_clock_info {
  1727. struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
  1728. struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
  1729. struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
  1730. struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
  1731. };
  1732. union pplib_power_state {
  1733. struct _ATOM_PPLIB_STATE v1;
  1734. struct _ATOM_PPLIB_STATE_V2 v2;
  1735. };
  1736. static void rv7xx_parse_pplib_non_clock_info(struct radeon_device *rdev,
  1737. struct radeon_ps *rps,
  1738. struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
  1739. u8 table_rev)
  1740. {
  1741. rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
  1742. rps->class = le16_to_cpu(non_clock_info->usClassification);
  1743. rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
  1744. if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
  1745. rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
  1746. rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
  1747. } else if (r600_is_uvd_state(rps->class, rps->class2)) {
  1748. rps->vclk = RV770_DEFAULT_VCLK_FREQ;
  1749. rps->dclk = RV770_DEFAULT_DCLK_FREQ;
  1750. } else {
  1751. rps->vclk = 0;
  1752. rps->dclk = 0;
  1753. }
  1754. if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT)
  1755. rdev->pm.dpm.boot_ps = rps;
  1756. if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
  1757. rdev->pm.dpm.uvd_ps = rps;
  1758. }
  1759. static void rv7xx_parse_pplib_clock_info(struct radeon_device *rdev,
  1760. struct radeon_ps *rps, int index,
  1761. union pplib_clock_info *clock_info)
  1762. {
  1763. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1764. struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1765. struct rv7xx_ps *ps = rv770_get_ps(rps);
  1766. u32 sclk, mclk;
  1767. u16 vddc;
  1768. struct rv7xx_pl *pl;
  1769. switch (index) {
  1770. case 0:
  1771. pl = &ps->low;
  1772. break;
  1773. case 1:
  1774. pl = &ps->medium;
  1775. break;
  1776. case 2:
  1777. default:
  1778. pl = &ps->high;
  1779. break;
  1780. }
  1781. if (rdev->family >= CHIP_CEDAR) {
  1782. sclk = le16_to_cpu(clock_info->evergreen.usEngineClockLow);
  1783. sclk |= clock_info->evergreen.ucEngineClockHigh << 16;
  1784. mclk = le16_to_cpu(clock_info->evergreen.usMemoryClockLow);
  1785. mclk |= clock_info->evergreen.ucMemoryClockHigh << 16;
  1786. pl->vddc = le16_to_cpu(clock_info->evergreen.usVDDC);
  1787. pl->vddci = le16_to_cpu(clock_info->evergreen.usVDDCI);
  1788. pl->flags = le32_to_cpu(clock_info->evergreen.ulFlags);
  1789. } else {
  1790. sclk = le16_to_cpu(clock_info->r600.usEngineClockLow);
  1791. sclk |= clock_info->r600.ucEngineClockHigh << 16;
  1792. mclk = le16_to_cpu(clock_info->r600.usMemoryClockLow);
  1793. mclk |= clock_info->r600.ucMemoryClockHigh << 16;
  1794. pl->vddc = le16_to_cpu(clock_info->r600.usVDDC);
  1795. pl->flags = le32_to_cpu(clock_info->r600.ulFlags);
  1796. }
  1797. pl->mclk = mclk;
  1798. pl->sclk = sclk;
  1799. /* patch up vddc if necessary */
  1800. if (pl->vddc == 0xff01) {
  1801. if (radeon_atom_get_max_vddc(rdev, 0, 0, &vddc) == 0)
  1802. pl->vddc = vddc;
  1803. }
  1804. if (rps->class & ATOM_PPLIB_CLASSIFICATION_ACPI) {
  1805. pi->acpi_vddc = pl->vddc;
  1806. if (rdev->family >= CHIP_CEDAR)
  1807. eg_pi->acpi_vddci = pl->vddci;
  1808. if (ps->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2)
  1809. pi->acpi_pcie_gen2 = true;
  1810. else
  1811. pi->acpi_pcie_gen2 = false;
  1812. }
  1813. if (rps->class2 & ATOM_PPLIB_CLASSIFICATION2_ULV) {
  1814. if (rdev->family >= CHIP_BARTS) {
  1815. eg_pi->ulv.supported = true;
  1816. eg_pi->ulv.pl = pl;
  1817. }
  1818. }
  1819. if (pi->min_vddc_in_table > pl->vddc)
  1820. pi->min_vddc_in_table = pl->vddc;
  1821. if (pi->max_vddc_in_table < pl->vddc)
  1822. pi->max_vddc_in_table = pl->vddc;
  1823. /* patch up boot state */
  1824. if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
  1825. u16 vddc, vddci, mvdd;
  1826. radeon_atombios_get_default_voltages(rdev, &vddc, &vddci, &mvdd);
  1827. pl->mclk = rdev->clock.default_mclk;
  1828. pl->sclk = rdev->clock.default_sclk;
  1829. pl->vddc = vddc;
  1830. pl->vddci = vddci;
  1831. }
  1832. if (rdev->family >= CHIP_BARTS) {
  1833. if ((rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) ==
  1834. ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE) {
  1835. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.sclk = pl->sclk;
  1836. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.mclk = pl->mclk;
  1837. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddc = pl->vddc;
  1838. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddci = pl->vddci;
  1839. }
  1840. }
  1841. }
  1842. int rv7xx_parse_power_table(struct radeon_device *rdev)
  1843. {
  1844. struct radeon_mode_info *mode_info = &rdev->mode_info;
  1845. struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
  1846. union pplib_power_state *power_state;
  1847. int i, j;
  1848. union pplib_clock_info *clock_info;
  1849. union power_info *power_info;
  1850. int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
  1851. u16 data_offset;
  1852. u8 frev, crev;
  1853. struct rv7xx_ps *ps;
  1854. if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
  1855. &frev, &crev, &data_offset))
  1856. return -EINVAL;
  1857. power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
  1858. rdev->pm.dpm.ps = kzalloc(sizeof(struct radeon_ps) *
  1859. power_info->pplib.ucNumStates, GFP_KERNEL);
  1860. if (!rdev->pm.dpm.ps)
  1861. return -ENOMEM;
  1862. rdev->pm.dpm.platform_caps = le32_to_cpu(power_info->pplib.ulPlatformCaps);
  1863. rdev->pm.dpm.backbias_response_time = le16_to_cpu(power_info->pplib.usBackbiasTime);
  1864. rdev->pm.dpm.voltage_response_time = le16_to_cpu(power_info->pplib.usVoltageTime);
  1865. for (i = 0; i < power_info->pplib.ucNumStates; i++) {
  1866. power_state = (union pplib_power_state *)
  1867. (mode_info->atom_context->bios + data_offset +
  1868. le16_to_cpu(power_info->pplib.usStateArrayOffset) +
  1869. i * power_info->pplib.ucStateEntrySize);
  1870. non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
  1871. (mode_info->atom_context->bios + data_offset +
  1872. le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset) +
  1873. (power_state->v1.ucNonClockStateIndex *
  1874. power_info->pplib.ucNonClockSize));
  1875. if (power_info->pplib.ucStateEntrySize - 1) {
  1876. ps = kzalloc(sizeof(struct rv7xx_ps), GFP_KERNEL);
  1877. if (ps == NULL) {
  1878. kfree(rdev->pm.dpm.ps);
  1879. return -ENOMEM;
  1880. }
  1881. rdev->pm.dpm.ps[i].ps_priv = ps;
  1882. rv7xx_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
  1883. non_clock_info,
  1884. power_info->pplib.ucNonClockSize);
  1885. for (j = 0; j < (power_info->pplib.ucStateEntrySize - 1); j++) {
  1886. clock_info = (union pplib_clock_info *)
  1887. (mode_info->atom_context->bios + data_offset +
  1888. le16_to_cpu(power_info->pplib.usClockInfoArrayOffset) +
  1889. (power_state->v1.ucClockStateIndices[j] *
  1890. power_info->pplib.ucClockInfoSize));
  1891. rv7xx_parse_pplib_clock_info(rdev,
  1892. &rdev->pm.dpm.ps[i], j,
  1893. clock_info);
  1894. }
  1895. }
  1896. }
  1897. rdev->pm.dpm.num_ps = power_info->pplib.ucNumStates;
  1898. return 0;
  1899. }
  1900. int rv770_dpm_init(struct radeon_device *rdev)
  1901. {
  1902. struct rv7xx_power_info *pi;
  1903. int index = GetIndexIntoMasterTable(DATA, ASIC_InternalSS_Info);
  1904. uint16_t data_offset, size;
  1905. uint8_t frev, crev;
  1906. struct atom_clock_dividers dividers;
  1907. int ret;
  1908. pi = kzalloc(sizeof(struct rv7xx_power_info), GFP_KERNEL);
  1909. if (pi == NULL)
  1910. return -ENOMEM;
  1911. rdev->pm.dpm.priv = pi;
  1912. rv770_get_max_vddc(rdev);
  1913. pi->acpi_vddc = 0;
  1914. pi->min_vddc_in_table = 0;
  1915. pi->max_vddc_in_table = 0;
  1916. ret = rv7xx_parse_power_table(rdev);
  1917. if (ret)
  1918. return ret;
  1919. if (rdev->pm.dpm.voltage_response_time == 0)
  1920. rdev->pm.dpm.voltage_response_time = R600_VOLTAGERESPONSETIME_DFLT;
  1921. if (rdev->pm.dpm.backbias_response_time == 0)
  1922. rdev->pm.dpm.backbias_response_time = R600_BACKBIASRESPONSETIME_DFLT;
  1923. ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  1924. 0, false, &dividers);
  1925. if (ret)
  1926. pi->ref_div = dividers.ref_div + 1;
  1927. else
  1928. pi->ref_div = R600_REFERENCEDIVIDER_DFLT;
  1929. pi->mclk_strobe_mode_threshold = 30000;
  1930. pi->mclk_edc_enable_threshold = 30000;
  1931. pi->rlp = RV770_RLP_DFLT;
  1932. pi->rmp = RV770_RMP_DFLT;
  1933. pi->lhp = RV770_LHP_DFLT;
  1934. pi->lmp = RV770_LMP_DFLT;
  1935. pi->voltage_control =
  1936. radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, 0);
  1937. pi->mvdd_control =
  1938. radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_MVDDC, 0);
  1939. if (atom_parse_data_header(rdev->mode_info.atom_context, index, &size,
  1940. &frev, &crev, &data_offset)) {
  1941. pi->sclk_ss = true;
  1942. pi->mclk_ss = true;
  1943. pi->dynamic_ss = true;
  1944. } else {
  1945. pi->sclk_ss = false;
  1946. pi->mclk_ss = false;
  1947. pi->dynamic_ss = false;
  1948. }
  1949. pi->asi = RV770_ASI_DFLT;
  1950. pi->pasi = RV770_HASI_DFLT;
  1951. pi->vrc = RV770_VRC_DFLT;
  1952. pi->power_gating = false;
  1953. pi->gfx_clock_gating = true;
  1954. pi->mg_clock_gating = true;
  1955. pi->mgcgtssm = true;
  1956. pi->dynamic_pcie_gen2 = true;
  1957. if (pi->gfx_clock_gating &&
  1958. (rdev->pm.int_thermal_type != THERMAL_TYPE_NONE))
  1959. pi->thermal_protection = true;
  1960. else
  1961. pi->thermal_protection = false;
  1962. pi->display_gap = true;
  1963. if (rdev->flags & RADEON_IS_MOBILITY)
  1964. pi->dcodt = true;
  1965. else
  1966. pi->dcodt = false;
  1967. pi->ulps = true;
  1968. pi->mclk_stutter_mode_threshold = 0;
  1969. pi->sram_end = SMC_RAM_END;
  1970. pi->state_table_start = RV770_SMC_TABLE_ADDRESS;
  1971. pi->soft_regs_start = RV770_SMC_SOFT_REGISTERS_START;
  1972. return 0;
  1973. }
  1974. void rv770_dpm_print_power_state(struct radeon_device *rdev,
  1975. struct radeon_ps *rps)
  1976. {
  1977. struct rv7xx_ps *ps = rv770_get_ps(rps);
  1978. struct rv7xx_pl *pl;
  1979. r600_dpm_print_class_info(rps->class, rps->class2);
  1980. r600_dpm_print_cap_info(rps->caps);
  1981. printk("\tuvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  1982. if (rdev->family >= CHIP_CEDAR) {
  1983. pl = &ps->low;
  1984. printk("\t\tpower level 0 sclk: %u mclk: %u vddc: %u vddci: %u\n",
  1985. pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  1986. pl = &ps->medium;
  1987. printk("\t\tpower level 1 sclk: %u mclk: %u vddc: %u vddci: %u\n",
  1988. pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  1989. pl = &ps->high;
  1990. printk("\t\tpower level 2 sclk: %u mclk: %u vddc: %u vddci: %u\n",
  1991. pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  1992. } else {
  1993. pl = &ps->low;
  1994. printk("\t\tpower level 0 sclk: %u mclk: %u vddc: %u\n",
  1995. pl->sclk, pl->mclk, pl->vddc);
  1996. pl = &ps->medium;
  1997. printk("\t\tpower level 1 sclk: %u mclk: %u vddc: %u\n",
  1998. pl->sclk, pl->mclk, pl->vddc);
  1999. pl = &ps->high;
  2000. printk("\t\tpower level 2 sclk: %u mclk: %u vddc: %u\n",
  2001. pl->sclk, pl->mclk, pl->vddc);
  2002. }
  2003. r600_dpm_print_ps_status(rdev, rps);
  2004. }
  2005. void rv770_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
  2006. struct seq_file *m)
  2007. {
  2008. struct radeon_ps *rps = rdev->pm.dpm.current_ps;
  2009. struct rv7xx_ps *ps = rv770_get_ps(rps);
  2010. struct rv7xx_pl *pl;
  2011. u32 current_index =
  2012. (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_PROFILE_INDEX_MASK) >>
  2013. CURRENT_PROFILE_INDEX_SHIFT;
  2014. if (current_index > 2) {
  2015. seq_printf(m, "invalid dpm profile %d\n", current_index);
  2016. } else {
  2017. if (current_index == 0)
  2018. pl = &ps->low;
  2019. else if (current_index == 1)
  2020. pl = &ps->medium;
  2021. else /* current_index == 2 */
  2022. pl = &ps->high;
  2023. seq_printf(m, "uvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  2024. if (rdev->family >= CHIP_CEDAR) {
  2025. seq_printf(m, "power level %d sclk: %u mclk: %u vddc: %u vddci: %u\n",
  2026. current_index, pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  2027. } else {
  2028. seq_printf(m, "power level %d sclk: %u mclk: %u vddc: %u\n",
  2029. current_index, pl->sclk, pl->mclk, pl->vddc);
  2030. }
  2031. }
  2032. }
  2033. void rv770_dpm_fini(struct radeon_device *rdev)
  2034. {
  2035. int i;
  2036. for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
  2037. kfree(rdev->pm.dpm.ps[i].ps_priv);
  2038. }
  2039. kfree(rdev->pm.dpm.ps);
  2040. kfree(rdev->pm.dpm.priv);
  2041. }
  2042. u32 rv770_dpm_get_sclk(struct radeon_device *rdev, bool low)
  2043. {
  2044. struct rv7xx_ps *requested_state = rv770_get_ps(rdev->pm.dpm.requested_ps);
  2045. if (low)
  2046. return requested_state->low.sclk;
  2047. else
  2048. return requested_state->high.sclk;
  2049. }
  2050. u32 rv770_dpm_get_mclk(struct radeon_device *rdev, bool low)
  2051. {
  2052. struct rv7xx_ps *requested_state = rv770_get_ps(rdev->pm.dpm.requested_ps);
  2053. if (low)
  2054. return requested_state->low.mclk;
  2055. else
  2056. return requested_state->high.mclk;
  2057. }
  2058. bool rv770_dpm_vblank_too_short(struct radeon_device *rdev)
  2059. {
  2060. u32 vblank_time = r600_dpm_get_vblank_time(rdev);
  2061. if (vblank_time < 300)
  2062. return true;
  2063. else
  2064. return false;
  2065. }