rv770_dpm.c 68 KB

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