rv770_dpm.c 67 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419
  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, old_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. if (pi->gfx_clock_gating)
  1525. rv770_restore_cgcg(rdev);
  1526. if (rv770_dpm_enabled(rdev))
  1527. return -EINVAL;
  1528. if (pi->voltage_control) {
  1529. rv770_enable_voltage_control(rdev, true);
  1530. rv770_construct_vddc_table(rdev);
  1531. }
  1532. if (pi->dcodt)
  1533. rv770_retrieve_odt_values(rdev);
  1534. if (pi->mvdd_control)
  1535. rv770_get_mvdd_configuration(rdev);
  1536. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS)
  1537. rv770_enable_backbias(rdev, true);
  1538. rv770_enable_spread_spectrum(rdev, true);
  1539. if (pi->thermal_protection)
  1540. rv770_enable_thermal_protection(rdev, true);
  1541. rv770_program_mpll_timing_parameters(rdev);
  1542. rv770_setup_bsp(rdev);
  1543. rv770_program_git(rdev);
  1544. rv770_program_tp(rdev);
  1545. rv770_program_tpp(rdev);
  1546. rv770_program_sstp(rdev);
  1547. rv770_program_engine_speed_parameters(rdev);
  1548. rv770_enable_display_gap(rdev);
  1549. rv770_program_vc(rdev);
  1550. if (pi->dynamic_pcie_gen2)
  1551. rv770_enable_dynamic_pcie_gen2(rdev, true);
  1552. if (rv770_upload_firmware(rdev))
  1553. return -EINVAL;
  1554. /* get ucode version ? */
  1555. if (rv770_init_smc_table(rdev, boot_ps))
  1556. return -EINVAL;
  1557. rv770_program_response_times(rdev);
  1558. r7xx_start_smc(rdev);
  1559. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1560. rv730_start_dpm(rdev);
  1561. else
  1562. rv770_start_dpm(rdev);
  1563. if (pi->gfx_clock_gating)
  1564. rv770_gfx_clock_gating_enable(rdev, true);
  1565. if (pi->mg_clock_gating)
  1566. rv770_mg_clock_gating_enable(rdev, true);
  1567. if (rdev->irq.installed &&
  1568. r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  1569. PPSMC_Result result;
  1570. rv770_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
  1571. rdev->irq.dpm_thermal = true;
  1572. radeon_irq_set(rdev);
  1573. result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_EnableThermalInterrupt);
  1574. if (result != PPSMC_Result_OK)
  1575. DRM_DEBUG_KMS("Could not enable thermal interrupts.\n");
  1576. }
  1577. rv770_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, true);
  1578. return 0;
  1579. }
  1580. void rv770_dpm_disable(struct radeon_device *rdev)
  1581. {
  1582. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1583. if (!rv770_dpm_enabled(rdev))
  1584. return;
  1585. rv770_clear_vc(rdev);
  1586. if (pi->thermal_protection)
  1587. rv770_enable_thermal_protection(rdev, false);
  1588. rv770_enable_spread_spectrum(rdev, false);
  1589. if (pi->dynamic_pcie_gen2)
  1590. rv770_enable_dynamic_pcie_gen2(rdev, false);
  1591. if (rdev->irq.installed &&
  1592. r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  1593. rdev->irq.dpm_thermal = false;
  1594. radeon_irq_set(rdev);
  1595. }
  1596. if (pi->gfx_clock_gating)
  1597. rv770_gfx_clock_gating_enable(rdev, false);
  1598. if (pi->mg_clock_gating)
  1599. rv770_mg_clock_gating_enable(rdev, false);
  1600. if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
  1601. rv730_stop_dpm(rdev);
  1602. else
  1603. rv770_stop_dpm(rdev);
  1604. r7xx_stop_smc(rdev);
  1605. rv770_reset_smio_status(rdev);
  1606. }
  1607. int rv770_dpm_set_power_state(struct radeon_device *rdev)
  1608. {
  1609. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1610. struct radeon_ps *new_ps = rdev->pm.dpm.requested_ps;
  1611. struct radeon_ps *old_ps = rdev->pm.dpm.current_ps;
  1612. rv770_restrict_performance_levels_before_switch(rdev);
  1613. rv770_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
  1614. rv770_halt_smc(rdev);
  1615. rv770_upload_sw_state(rdev, new_ps);
  1616. r7xx_program_memory_timing_parameters(rdev, new_ps);
  1617. if (pi->dcodt)
  1618. rv770_program_dcodt_before_state_switch(rdev, new_ps, old_ps);
  1619. rv770_resume_smc(rdev);
  1620. rv770_set_sw_state(rdev);
  1621. if (pi->dcodt)
  1622. rv770_program_dcodt_after_state_switch(rdev, new_ps, old_ps);
  1623. rv770_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
  1624. rv770_unrestrict_performance_levels_after_switch(rdev);
  1625. return 0;
  1626. }
  1627. void rv770_dpm_reset_asic(struct radeon_device *rdev)
  1628. {
  1629. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1630. struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
  1631. rv770_restrict_performance_levels_before_switch(rdev);
  1632. if (pi->dcodt)
  1633. rv770_program_dcodt_before_state_switch(rdev, boot_ps, boot_ps);
  1634. rv770_set_boot_state(rdev);
  1635. if (pi->dcodt)
  1636. rv770_program_dcodt_after_state_switch(rdev, boot_ps, boot_ps);
  1637. }
  1638. void rv770_dpm_setup_asic(struct radeon_device *rdev)
  1639. {
  1640. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1641. r7xx_read_clock_registers(rdev);
  1642. rv770_read_voltage_smio_registers(rdev);
  1643. rv770_get_memory_type(rdev);
  1644. if (pi->dcodt)
  1645. rv770_get_mclk_odt_threshold(rdev);
  1646. rv770_get_pcie_gen2_status(rdev);
  1647. rv770_enable_acpi_pm(rdev);
  1648. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L0s)
  1649. rv770_enable_l0s(rdev);
  1650. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L1)
  1651. rv770_enable_l1(rdev);
  1652. if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_TURNOFFPLL_ASPML1)
  1653. rv770_enable_pll_sleep_in_l1(rdev);
  1654. }
  1655. void rv770_dpm_display_configuration_changed(struct radeon_device *rdev)
  1656. {
  1657. rv770_program_display_gap(rdev);
  1658. }
  1659. union power_info {
  1660. struct _ATOM_POWERPLAY_INFO info;
  1661. struct _ATOM_POWERPLAY_INFO_V2 info_2;
  1662. struct _ATOM_POWERPLAY_INFO_V3 info_3;
  1663. struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
  1664. struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
  1665. struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
  1666. };
  1667. union pplib_clock_info {
  1668. struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
  1669. struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
  1670. struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
  1671. struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
  1672. };
  1673. union pplib_power_state {
  1674. struct _ATOM_PPLIB_STATE v1;
  1675. struct _ATOM_PPLIB_STATE_V2 v2;
  1676. };
  1677. static void rv7xx_parse_pplib_non_clock_info(struct radeon_device *rdev,
  1678. struct radeon_ps *rps,
  1679. struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
  1680. u8 table_rev)
  1681. {
  1682. rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
  1683. rps->class = le16_to_cpu(non_clock_info->usClassification);
  1684. rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
  1685. if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
  1686. rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
  1687. rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
  1688. } else if (r600_is_uvd_state(rps->class, rps->class2)) {
  1689. rps->vclk = RV770_DEFAULT_VCLK_FREQ;
  1690. rps->dclk = RV770_DEFAULT_DCLK_FREQ;
  1691. } else {
  1692. rps->vclk = 0;
  1693. rps->dclk = 0;
  1694. }
  1695. if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT)
  1696. rdev->pm.dpm.boot_ps = rps;
  1697. if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
  1698. rdev->pm.dpm.uvd_ps = rps;
  1699. }
  1700. static void rv7xx_parse_pplib_clock_info(struct radeon_device *rdev,
  1701. struct radeon_ps *rps, int index,
  1702. union pplib_clock_info *clock_info)
  1703. {
  1704. struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1705. struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1706. struct rv7xx_ps *ps = rv770_get_ps(rps);
  1707. u32 sclk, mclk;
  1708. u16 vddc;
  1709. struct rv7xx_pl *pl;
  1710. switch (index) {
  1711. case 0:
  1712. pl = &ps->low;
  1713. break;
  1714. case 1:
  1715. pl = &ps->medium;
  1716. break;
  1717. case 2:
  1718. default:
  1719. pl = &ps->high;
  1720. break;
  1721. }
  1722. if (rdev->family >= CHIP_CEDAR) {
  1723. sclk = le16_to_cpu(clock_info->evergreen.usEngineClockLow);
  1724. sclk |= clock_info->evergreen.ucEngineClockHigh << 16;
  1725. mclk = le16_to_cpu(clock_info->evergreen.usMemoryClockLow);
  1726. mclk |= clock_info->evergreen.ucMemoryClockHigh << 16;
  1727. pl->vddc = le16_to_cpu(clock_info->evergreen.usVDDC);
  1728. pl->vddci = le16_to_cpu(clock_info->evergreen.usVDDCI);
  1729. pl->flags = le32_to_cpu(clock_info->evergreen.ulFlags);
  1730. } else {
  1731. sclk = le16_to_cpu(clock_info->r600.usEngineClockLow);
  1732. sclk |= clock_info->r600.ucEngineClockHigh << 16;
  1733. mclk = le16_to_cpu(clock_info->r600.usMemoryClockLow);
  1734. mclk |= clock_info->r600.ucMemoryClockHigh << 16;
  1735. pl->vddc = le16_to_cpu(clock_info->r600.usVDDC);
  1736. pl->flags = le32_to_cpu(clock_info->r600.ulFlags);
  1737. }
  1738. pl->mclk = mclk;
  1739. pl->sclk = sclk;
  1740. /* patch up vddc if necessary */
  1741. if (pl->vddc == 0xff01) {
  1742. if (radeon_atom_get_max_vddc(rdev, 0, 0, &vddc) == 0)
  1743. pl->vddc = vddc;
  1744. }
  1745. if (rps->class & ATOM_PPLIB_CLASSIFICATION_ACPI) {
  1746. pi->acpi_vddc = pl->vddc;
  1747. if (rdev->family >= CHIP_CEDAR)
  1748. eg_pi->acpi_vddci = pl->vddci;
  1749. if (ps->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2)
  1750. pi->acpi_pcie_gen2 = true;
  1751. else
  1752. pi->acpi_pcie_gen2 = false;
  1753. }
  1754. if (rps->class2 & ATOM_PPLIB_CLASSIFICATION2_ULV) {
  1755. if (rdev->family >= CHIP_BARTS) {
  1756. eg_pi->ulv.supported = true;
  1757. eg_pi->ulv.pl = pl;
  1758. }
  1759. }
  1760. if (pi->min_vddc_in_table > pl->vddc)
  1761. pi->min_vddc_in_table = pl->vddc;
  1762. if (pi->max_vddc_in_table < pl->vddc)
  1763. pi->max_vddc_in_table = pl->vddc;
  1764. /* patch up boot state */
  1765. if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
  1766. u16 vddc, vddci;
  1767. radeon_atombios_get_default_voltages(rdev, &vddc, &vddci);
  1768. pl->mclk = rdev->clock.default_mclk;
  1769. pl->sclk = rdev->clock.default_sclk;
  1770. pl->vddc = vddc;
  1771. pl->vddci = vddci;
  1772. }
  1773. if (rdev->family >= CHIP_BARTS) {
  1774. if ((rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) ==
  1775. ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE) {
  1776. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.sclk = pl->sclk;
  1777. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.mclk = pl->mclk;
  1778. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddc = pl->vddc;
  1779. rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddci = pl->vddci;
  1780. }
  1781. }
  1782. }
  1783. int rv7xx_parse_power_table(struct radeon_device *rdev)
  1784. {
  1785. struct radeon_mode_info *mode_info = &rdev->mode_info;
  1786. struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
  1787. union pplib_power_state *power_state;
  1788. int i, j;
  1789. union pplib_clock_info *clock_info;
  1790. union power_info *power_info;
  1791. int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
  1792. u16 data_offset;
  1793. u8 frev, crev;
  1794. struct rv7xx_ps *ps;
  1795. if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
  1796. &frev, &crev, &data_offset))
  1797. return -EINVAL;
  1798. power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
  1799. rdev->pm.dpm.ps = kzalloc(sizeof(struct radeon_ps) *
  1800. power_info->pplib.ucNumStates, GFP_KERNEL);
  1801. if (!rdev->pm.dpm.ps)
  1802. return -ENOMEM;
  1803. rdev->pm.dpm.platform_caps = le32_to_cpu(power_info->pplib.ulPlatformCaps);
  1804. rdev->pm.dpm.backbias_response_time = le16_to_cpu(power_info->pplib.usBackbiasTime);
  1805. rdev->pm.dpm.voltage_response_time = le16_to_cpu(power_info->pplib.usVoltageTime);
  1806. for (i = 0; i < power_info->pplib.ucNumStates; i++) {
  1807. power_state = (union pplib_power_state *)
  1808. (mode_info->atom_context->bios + data_offset +
  1809. le16_to_cpu(power_info->pplib.usStateArrayOffset) +
  1810. i * power_info->pplib.ucStateEntrySize);
  1811. non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
  1812. (mode_info->atom_context->bios + data_offset +
  1813. le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset) +
  1814. (power_state->v1.ucNonClockStateIndex *
  1815. power_info->pplib.ucNonClockSize));
  1816. if (power_info->pplib.ucStateEntrySize - 1) {
  1817. ps = kzalloc(sizeof(struct rv7xx_ps), GFP_KERNEL);
  1818. if (ps == NULL) {
  1819. kfree(rdev->pm.dpm.ps);
  1820. return -ENOMEM;
  1821. }
  1822. rdev->pm.dpm.ps[i].ps_priv = ps;
  1823. rv7xx_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
  1824. non_clock_info,
  1825. power_info->pplib.ucNonClockSize);
  1826. for (j = 0; j < (power_info->pplib.ucStateEntrySize - 1); j++) {
  1827. clock_info = (union pplib_clock_info *)
  1828. (mode_info->atom_context->bios + data_offset +
  1829. le16_to_cpu(power_info->pplib.usClockInfoArrayOffset) +
  1830. (power_state->v1.ucClockStateIndices[j] *
  1831. power_info->pplib.ucClockInfoSize));
  1832. rv7xx_parse_pplib_clock_info(rdev,
  1833. &rdev->pm.dpm.ps[i], j,
  1834. clock_info);
  1835. }
  1836. }
  1837. }
  1838. rdev->pm.dpm.num_ps = power_info->pplib.ucNumStates;
  1839. return 0;
  1840. }
  1841. int rv770_dpm_init(struct radeon_device *rdev)
  1842. {
  1843. struct rv7xx_power_info *pi;
  1844. int index = GetIndexIntoMasterTable(DATA, ASIC_InternalSS_Info);
  1845. uint16_t data_offset, size;
  1846. uint8_t frev, crev;
  1847. struct atom_clock_dividers dividers;
  1848. int ret;
  1849. pi = kzalloc(sizeof(struct rv7xx_power_info), GFP_KERNEL);
  1850. if (pi == NULL)
  1851. return -ENOMEM;
  1852. rdev->pm.dpm.priv = pi;
  1853. rv770_get_max_vddc(rdev);
  1854. pi->acpi_vddc = 0;
  1855. pi->min_vddc_in_table = 0;
  1856. pi->max_vddc_in_table = 0;
  1857. ret = rv7xx_parse_power_table(rdev);
  1858. if (ret)
  1859. return ret;
  1860. if (rdev->pm.dpm.voltage_response_time == 0)
  1861. rdev->pm.dpm.voltage_response_time = R600_VOLTAGERESPONSETIME_DFLT;
  1862. if (rdev->pm.dpm.backbias_response_time == 0)
  1863. rdev->pm.dpm.backbias_response_time = R600_BACKBIASRESPONSETIME_DFLT;
  1864. ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  1865. 0, false, &dividers);
  1866. if (ret)
  1867. pi->ref_div = dividers.ref_div + 1;
  1868. else
  1869. pi->ref_div = R600_REFERENCEDIVIDER_DFLT;
  1870. pi->mclk_strobe_mode_threshold = 30000;
  1871. pi->mclk_edc_enable_threshold = 30000;
  1872. pi->rlp = RV770_RLP_DFLT;
  1873. pi->rmp = RV770_RMP_DFLT;
  1874. pi->lhp = RV770_LHP_DFLT;
  1875. pi->lmp = RV770_LMP_DFLT;
  1876. pi->voltage_control =
  1877. radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC);
  1878. pi->mvdd_control =
  1879. radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_MVDDC);
  1880. if (atom_parse_data_header(rdev->mode_info.atom_context, index, &size,
  1881. &frev, &crev, &data_offset)) {
  1882. pi->sclk_ss = true;
  1883. pi->mclk_ss = true;
  1884. pi->dynamic_ss = true;
  1885. } else {
  1886. pi->sclk_ss = false;
  1887. pi->mclk_ss = false;
  1888. pi->dynamic_ss = false;
  1889. }
  1890. pi->asi = RV770_ASI_DFLT;
  1891. pi->pasi = RV770_HASI_DFLT;
  1892. pi->vrc = RV770_VRC_DFLT;
  1893. pi->power_gating = false;
  1894. pi->gfx_clock_gating = true;
  1895. pi->mg_clock_gating = true;
  1896. pi->mgcgtssm = true;
  1897. pi->dynamic_pcie_gen2 = true;
  1898. if (pi->gfx_clock_gating &&
  1899. (rdev->pm.int_thermal_type != THERMAL_TYPE_NONE))
  1900. pi->thermal_protection = true;
  1901. else
  1902. pi->thermal_protection = false;
  1903. pi->display_gap = true;
  1904. if (rdev->flags & RADEON_IS_MOBILITY)
  1905. pi->dcodt = true;
  1906. else
  1907. pi->dcodt = false;
  1908. pi->ulps = true;
  1909. pi->mclk_stutter_mode_threshold = 0;
  1910. pi->sram_end = SMC_RAM_END;
  1911. pi->state_table_start = RV770_SMC_TABLE_ADDRESS;
  1912. pi->soft_regs_start = RV770_SMC_SOFT_REGISTERS_START;
  1913. return 0;
  1914. }
  1915. void rv770_dpm_print_power_state(struct radeon_device *rdev,
  1916. struct radeon_ps *rps)
  1917. {
  1918. struct rv7xx_ps *ps = rv770_get_ps(rps);
  1919. struct rv7xx_pl *pl;
  1920. r600_dpm_print_class_info(rps->class, rps->class2);
  1921. r600_dpm_print_cap_info(rps->caps);
  1922. printk("\tuvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  1923. if (rdev->family >= CHIP_CEDAR) {
  1924. pl = &ps->low;
  1925. printk("\t\tpower level 0 sclk: %u mclk: %u vddc: %u vddci: %u\n",
  1926. pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  1927. pl = &ps->medium;
  1928. printk("\t\tpower level 1 sclk: %u mclk: %u vddc: %u vddci: %u\n",
  1929. pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  1930. pl = &ps->high;
  1931. printk("\t\tpower level 2 sclk: %u mclk: %u vddc: %u vddci: %u\n",
  1932. pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  1933. } else {
  1934. pl = &ps->low;
  1935. printk("\t\tpower level 0 sclk: %u mclk: %u vddc: %u\n",
  1936. pl->sclk, pl->mclk, pl->vddc);
  1937. pl = &ps->medium;
  1938. printk("\t\tpower level 1 sclk: %u mclk: %u vddc: %u\n",
  1939. pl->sclk, pl->mclk, pl->vddc);
  1940. pl = &ps->high;
  1941. printk("\t\tpower level 2 sclk: %u mclk: %u vddc: %u\n",
  1942. pl->sclk, pl->mclk, pl->vddc);
  1943. }
  1944. r600_dpm_print_ps_status(rdev, rps);
  1945. }
  1946. void rv770_dpm_fini(struct radeon_device *rdev)
  1947. {
  1948. int i;
  1949. for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
  1950. kfree(rdev->pm.dpm.ps[i].ps_priv);
  1951. }
  1952. kfree(rdev->pm.dpm.ps);
  1953. kfree(rdev->pm.dpm.priv);
  1954. }
  1955. u32 rv770_dpm_get_sclk(struct radeon_device *rdev, bool low)
  1956. {
  1957. struct rv7xx_ps *requested_state = rv770_get_ps(rdev->pm.dpm.requested_ps);
  1958. if (low)
  1959. return requested_state->low.sclk;
  1960. else
  1961. return requested_state->high.sclk;
  1962. }
  1963. u32 rv770_dpm_get_mclk(struct radeon_device *rdev, bool low)
  1964. {
  1965. struct rv7xx_ps *requested_state = rv770_get_ps(rdev->pm.dpm.requested_ps);
  1966. if (low)
  1967. return requested_state->low.mclk;
  1968. else
  1969. return requested_state->high.mclk;
  1970. }