atombios_crtc.c 48 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579
  1. /*
  2. * Copyright 2007-8 Advanced Micro Devices, Inc.
  3. * Copyright 2008 Red Hat Inc.
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining a
  6. * copy of this software and associated documentation files (the "Software"),
  7. * to deal in the Software without restriction, including without limitation
  8. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  9. * and/or sell copies of the Software, and to permit persons to whom the
  10. * Software is furnished to do so, subject to the following conditions:
  11. *
  12. * The above copyright notice and this permission notice shall be included in
  13. * all copies or substantial portions of the Software.
  14. *
  15. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  18. * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  19. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  20. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  21. * OTHER DEALINGS IN THE SOFTWARE.
  22. *
  23. * Authors: Dave Airlie
  24. * Alex Deucher
  25. */
  26. #include <drm/drmP.h>
  27. #include <drm/drm_crtc_helper.h>
  28. #include <drm/radeon_drm.h>
  29. #include <drm/drm_fixed.h>
  30. #include "radeon.h"
  31. #include "atom.h"
  32. #include "atom-bits.h"
  33. static void atombios_overscan_setup(struct drm_crtc *crtc,
  34. struct drm_display_mode *mode,
  35. struct drm_display_mode *adjusted_mode)
  36. {
  37. struct drm_device *dev = crtc->dev;
  38. struct radeon_device *rdev = dev->dev_private;
  39. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  40. SET_CRTC_OVERSCAN_PS_ALLOCATION args;
  41. int index = GetIndexIntoMasterTable(COMMAND, SetCRTC_OverScan);
  42. int a1, a2;
  43. memset(&args, 0, sizeof(args));
  44. args.ucCRTC = radeon_crtc->crtc_id;
  45. switch (radeon_crtc->rmx_type) {
  46. case RMX_CENTER:
  47. args.usOverscanTop = cpu_to_le16((adjusted_mode->crtc_vdisplay - mode->crtc_vdisplay) / 2);
  48. args.usOverscanBottom = cpu_to_le16((adjusted_mode->crtc_vdisplay - mode->crtc_vdisplay) / 2);
  49. args.usOverscanLeft = cpu_to_le16((adjusted_mode->crtc_hdisplay - mode->crtc_hdisplay) / 2);
  50. args.usOverscanRight = cpu_to_le16((adjusted_mode->crtc_hdisplay - mode->crtc_hdisplay) / 2);
  51. break;
  52. case RMX_ASPECT:
  53. a1 = mode->crtc_vdisplay * adjusted_mode->crtc_hdisplay;
  54. a2 = adjusted_mode->crtc_vdisplay * mode->crtc_hdisplay;
  55. if (a1 > a2) {
  56. args.usOverscanLeft = cpu_to_le16((adjusted_mode->crtc_hdisplay - (a2 / mode->crtc_vdisplay)) / 2);
  57. args.usOverscanRight = cpu_to_le16((adjusted_mode->crtc_hdisplay - (a2 / mode->crtc_vdisplay)) / 2);
  58. } else if (a2 > a1) {
  59. args.usOverscanTop = cpu_to_le16((adjusted_mode->crtc_vdisplay - (a1 / mode->crtc_hdisplay)) / 2);
  60. args.usOverscanBottom = cpu_to_le16((adjusted_mode->crtc_vdisplay - (a1 / mode->crtc_hdisplay)) / 2);
  61. }
  62. break;
  63. case RMX_FULL:
  64. default:
  65. args.usOverscanRight = cpu_to_le16(radeon_crtc->h_border);
  66. args.usOverscanLeft = cpu_to_le16(radeon_crtc->h_border);
  67. args.usOverscanBottom = cpu_to_le16(radeon_crtc->v_border);
  68. args.usOverscanTop = cpu_to_le16(radeon_crtc->v_border);
  69. break;
  70. }
  71. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  72. }
  73. static void atombios_scaler_setup(struct drm_crtc *crtc)
  74. {
  75. struct drm_device *dev = crtc->dev;
  76. struct radeon_device *rdev = dev->dev_private;
  77. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  78. ENABLE_SCALER_PS_ALLOCATION args;
  79. int index = GetIndexIntoMasterTable(COMMAND, EnableScaler);
  80. /* fixme - fill in enc_priv for atom dac */
  81. enum radeon_tv_std tv_std = TV_STD_NTSC;
  82. bool is_tv = false, is_cv = false;
  83. struct drm_encoder *encoder;
  84. if (!ASIC_IS_AVIVO(rdev) && radeon_crtc->crtc_id)
  85. return;
  86. list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
  87. /* find tv std */
  88. if (encoder->crtc == crtc) {
  89. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  90. if (radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT) {
  91. struct radeon_encoder_atom_dac *tv_dac = radeon_encoder->enc_priv;
  92. tv_std = tv_dac->tv_std;
  93. is_tv = true;
  94. }
  95. }
  96. }
  97. memset(&args, 0, sizeof(args));
  98. args.ucScaler = radeon_crtc->crtc_id;
  99. if (is_tv) {
  100. switch (tv_std) {
  101. case TV_STD_NTSC:
  102. default:
  103. args.ucTVStandard = ATOM_TV_NTSC;
  104. break;
  105. case TV_STD_PAL:
  106. args.ucTVStandard = ATOM_TV_PAL;
  107. break;
  108. case TV_STD_PAL_M:
  109. args.ucTVStandard = ATOM_TV_PALM;
  110. break;
  111. case TV_STD_PAL_60:
  112. args.ucTVStandard = ATOM_TV_PAL60;
  113. break;
  114. case TV_STD_NTSC_J:
  115. args.ucTVStandard = ATOM_TV_NTSCJ;
  116. break;
  117. case TV_STD_SCART_PAL:
  118. args.ucTVStandard = ATOM_TV_PAL; /* ??? */
  119. break;
  120. case TV_STD_SECAM:
  121. args.ucTVStandard = ATOM_TV_SECAM;
  122. break;
  123. case TV_STD_PAL_CN:
  124. args.ucTVStandard = ATOM_TV_PALCN;
  125. break;
  126. }
  127. args.ucEnable = SCALER_ENABLE_MULTITAP_MODE;
  128. } else if (is_cv) {
  129. args.ucTVStandard = ATOM_TV_CV;
  130. args.ucEnable = SCALER_ENABLE_MULTITAP_MODE;
  131. } else {
  132. switch (radeon_crtc->rmx_type) {
  133. case RMX_FULL:
  134. args.ucEnable = ATOM_SCALER_EXPANSION;
  135. break;
  136. case RMX_CENTER:
  137. args.ucEnable = ATOM_SCALER_CENTER;
  138. break;
  139. case RMX_ASPECT:
  140. args.ucEnable = ATOM_SCALER_EXPANSION;
  141. break;
  142. default:
  143. if (ASIC_IS_AVIVO(rdev))
  144. args.ucEnable = ATOM_SCALER_DISABLE;
  145. else
  146. args.ucEnable = ATOM_SCALER_CENTER;
  147. break;
  148. }
  149. }
  150. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  151. if ((is_tv || is_cv)
  152. && rdev->family >= CHIP_RV515 && rdev->family <= CHIP_R580) {
  153. atom_rv515_force_tv_scaler(rdev, radeon_crtc);
  154. }
  155. }
  156. static void atombios_lock_crtc(struct drm_crtc *crtc, int lock)
  157. {
  158. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  159. struct drm_device *dev = crtc->dev;
  160. struct radeon_device *rdev = dev->dev_private;
  161. int index =
  162. GetIndexIntoMasterTable(COMMAND, UpdateCRTC_DoubleBufferRegisters);
  163. ENABLE_CRTC_PS_ALLOCATION args;
  164. memset(&args, 0, sizeof(args));
  165. args.ucCRTC = radeon_crtc->crtc_id;
  166. args.ucEnable = lock;
  167. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  168. }
  169. static void atombios_enable_crtc(struct drm_crtc *crtc, int state)
  170. {
  171. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  172. struct drm_device *dev = crtc->dev;
  173. struct radeon_device *rdev = dev->dev_private;
  174. int index = GetIndexIntoMasterTable(COMMAND, EnableCRTC);
  175. ENABLE_CRTC_PS_ALLOCATION args;
  176. memset(&args, 0, sizeof(args));
  177. args.ucCRTC = radeon_crtc->crtc_id;
  178. args.ucEnable = state;
  179. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  180. }
  181. static void atombios_enable_crtc_memreq(struct drm_crtc *crtc, int state)
  182. {
  183. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  184. struct drm_device *dev = crtc->dev;
  185. struct radeon_device *rdev = dev->dev_private;
  186. int index = GetIndexIntoMasterTable(COMMAND, EnableCRTCMemReq);
  187. ENABLE_CRTC_PS_ALLOCATION args;
  188. memset(&args, 0, sizeof(args));
  189. args.ucCRTC = radeon_crtc->crtc_id;
  190. args.ucEnable = state;
  191. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  192. }
  193. static void atombios_blank_crtc(struct drm_crtc *crtc, int state)
  194. {
  195. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  196. struct drm_device *dev = crtc->dev;
  197. struct radeon_device *rdev = dev->dev_private;
  198. int index = GetIndexIntoMasterTable(COMMAND, BlankCRTC);
  199. BLANK_CRTC_PS_ALLOCATION args;
  200. memset(&args, 0, sizeof(args));
  201. args.ucCRTC = radeon_crtc->crtc_id;
  202. args.ucBlanking = state;
  203. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  204. }
  205. void atombios_crtc_dpms(struct drm_crtc *crtc, int mode)
  206. {
  207. struct drm_device *dev = crtc->dev;
  208. struct radeon_device *rdev = dev->dev_private;
  209. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  210. switch (mode) {
  211. case DRM_MODE_DPMS_ON:
  212. radeon_crtc->enabled = true;
  213. /* adjust pm to dpms changes BEFORE enabling crtcs */
  214. radeon_pm_compute_clocks(rdev);
  215. atombios_enable_crtc(crtc, ATOM_ENABLE);
  216. if (ASIC_IS_DCE3(rdev))
  217. atombios_enable_crtc_memreq(crtc, ATOM_ENABLE);
  218. atombios_blank_crtc(crtc, ATOM_DISABLE);
  219. drm_vblank_post_modeset(dev, radeon_crtc->crtc_id);
  220. radeon_crtc_load_lut(crtc);
  221. break;
  222. case DRM_MODE_DPMS_STANDBY:
  223. case DRM_MODE_DPMS_SUSPEND:
  224. case DRM_MODE_DPMS_OFF:
  225. drm_vblank_pre_modeset(dev, radeon_crtc->crtc_id);
  226. if (radeon_crtc->enabled)
  227. atombios_blank_crtc(crtc, ATOM_ENABLE);
  228. if (ASIC_IS_DCE3(rdev))
  229. atombios_enable_crtc_memreq(crtc, ATOM_DISABLE);
  230. atombios_enable_crtc(crtc, ATOM_DISABLE);
  231. radeon_crtc->enabled = false;
  232. /* adjust pm to dpms changes AFTER disabling crtcs */
  233. radeon_pm_compute_clocks(rdev);
  234. break;
  235. }
  236. }
  237. static void
  238. atombios_set_crtc_dtd_timing(struct drm_crtc *crtc,
  239. struct drm_display_mode *mode)
  240. {
  241. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  242. struct drm_device *dev = crtc->dev;
  243. struct radeon_device *rdev = dev->dev_private;
  244. SET_CRTC_USING_DTD_TIMING_PARAMETERS args;
  245. int index = GetIndexIntoMasterTable(COMMAND, SetCRTC_UsingDTDTiming);
  246. u16 misc = 0;
  247. memset(&args, 0, sizeof(args));
  248. args.usH_Size = cpu_to_le16(mode->crtc_hdisplay - (radeon_crtc->h_border * 2));
  249. args.usH_Blanking_Time =
  250. cpu_to_le16(mode->crtc_hblank_end - mode->crtc_hdisplay + (radeon_crtc->h_border * 2));
  251. args.usV_Size = cpu_to_le16(mode->crtc_vdisplay - (radeon_crtc->v_border * 2));
  252. args.usV_Blanking_Time =
  253. cpu_to_le16(mode->crtc_vblank_end - mode->crtc_vdisplay + (radeon_crtc->v_border * 2));
  254. args.usH_SyncOffset =
  255. cpu_to_le16(mode->crtc_hsync_start - mode->crtc_hdisplay + radeon_crtc->h_border);
  256. args.usH_SyncWidth =
  257. cpu_to_le16(mode->crtc_hsync_end - mode->crtc_hsync_start);
  258. args.usV_SyncOffset =
  259. cpu_to_le16(mode->crtc_vsync_start - mode->crtc_vdisplay + radeon_crtc->v_border);
  260. args.usV_SyncWidth =
  261. cpu_to_le16(mode->crtc_vsync_end - mode->crtc_vsync_start);
  262. args.ucH_Border = radeon_crtc->h_border;
  263. args.ucV_Border = radeon_crtc->v_border;
  264. if (mode->flags & DRM_MODE_FLAG_NVSYNC)
  265. misc |= ATOM_VSYNC_POLARITY;
  266. if (mode->flags & DRM_MODE_FLAG_NHSYNC)
  267. misc |= ATOM_HSYNC_POLARITY;
  268. if (mode->flags & DRM_MODE_FLAG_CSYNC)
  269. misc |= ATOM_COMPOSITESYNC;
  270. if (mode->flags & DRM_MODE_FLAG_INTERLACE)
  271. misc |= ATOM_INTERLACE;
  272. if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
  273. misc |= ATOM_DOUBLE_CLOCK_MODE;
  274. args.susModeMiscInfo.usAccess = cpu_to_le16(misc);
  275. args.ucCRTC = radeon_crtc->crtc_id;
  276. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  277. }
  278. static void atombios_crtc_set_timing(struct drm_crtc *crtc,
  279. struct drm_display_mode *mode)
  280. {
  281. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  282. struct drm_device *dev = crtc->dev;
  283. struct radeon_device *rdev = dev->dev_private;
  284. SET_CRTC_TIMING_PARAMETERS_PS_ALLOCATION args;
  285. int index = GetIndexIntoMasterTable(COMMAND, SetCRTC_Timing);
  286. u16 misc = 0;
  287. memset(&args, 0, sizeof(args));
  288. args.usH_Total = cpu_to_le16(mode->crtc_htotal);
  289. args.usH_Disp = cpu_to_le16(mode->crtc_hdisplay);
  290. args.usH_SyncStart = cpu_to_le16(mode->crtc_hsync_start);
  291. args.usH_SyncWidth =
  292. cpu_to_le16(mode->crtc_hsync_end - mode->crtc_hsync_start);
  293. args.usV_Total = cpu_to_le16(mode->crtc_vtotal);
  294. args.usV_Disp = cpu_to_le16(mode->crtc_vdisplay);
  295. args.usV_SyncStart = cpu_to_le16(mode->crtc_vsync_start);
  296. args.usV_SyncWidth =
  297. cpu_to_le16(mode->crtc_vsync_end - mode->crtc_vsync_start);
  298. args.ucOverscanRight = radeon_crtc->h_border;
  299. args.ucOverscanLeft = radeon_crtc->h_border;
  300. args.ucOverscanBottom = radeon_crtc->v_border;
  301. args.ucOverscanTop = radeon_crtc->v_border;
  302. if (mode->flags & DRM_MODE_FLAG_NVSYNC)
  303. misc |= ATOM_VSYNC_POLARITY;
  304. if (mode->flags & DRM_MODE_FLAG_NHSYNC)
  305. misc |= ATOM_HSYNC_POLARITY;
  306. if (mode->flags & DRM_MODE_FLAG_CSYNC)
  307. misc |= ATOM_COMPOSITESYNC;
  308. if (mode->flags & DRM_MODE_FLAG_INTERLACE)
  309. misc |= ATOM_INTERLACE;
  310. if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
  311. misc |= ATOM_DOUBLE_CLOCK_MODE;
  312. args.susModeMiscInfo.usAccess = cpu_to_le16(misc);
  313. args.ucCRTC = radeon_crtc->crtc_id;
  314. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  315. }
  316. static void atombios_disable_ss(struct drm_crtc *crtc)
  317. {
  318. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  319. struct drm_device *dev = crtc->dev;
  320. struct radeon_device *rdev = dev->dev_private;
  321. u32 ss_cntl;
  322. if (ASIC_IS_DCE4(rdev)) {
  323. switch (radeon_crtc->pll_id) {
  324. case ATOM_PPLL1:
  325. ss_cntl = RREG32(EVERGREEN_P1PLL_SS_CNTL);
  326. ss_cntl &= ~EVERGREEN_PxPLL_SS_EN;
  327. WREG32(EVERGREEN_P1PLL_SS_CNTL, ss_cntl);
  328. break;
  329. case ATOM_PPLL2:
  330. ss_cntl = RREG32(EVERGREEN_P2PLL_SS_CNTL);
  331. ss_cntl &= ~EVERGREEN_PxPLL_SS_EN;
  332. WREG32(EVERGREEN_P2PLL_SS_CNTL, ss_cntl);
  333. break;
  334. case ATOM_DCPLL:
  335. case ATOM_PPLL_INVALID:
  336. return;
  337. }
  338. } else if (ASIC_IS_AVIVO(rdev)) {
  339. switch (radeon_crtc->pll_id) {
  340. case ATOM_PPLL1:
  341. ss_cntl = RREG32(AVIVO_P1PLL_INT_SS_CNTL);
  342. ss_cntl &= ~1;
  343. WREG32(AVIVO_P1PLL_INT_SS_CNTL, ss_cntl);
  344. break;
  345. case ATOM_PPLL2:
  346. ss_cntl = RREG32(AVIVO_P2PLL_INT_SS_CNTL);
  347. ss_cntl &= ~1;
  348. WREG32(AVIVO_P2PLL_INT_SS_CNTL, ss_cntl);
  349. break;
  350. case ATOM_DCPLL:
  351. case ATOM_PPLL_INVALID:
  352. return;
  353. }
  354. }
  355. }
  356. union atom_enable_ss {
  357. ENABLE_LVDS_SS_PARAMETERS lvds_ss;
  358. ENABLE_LVDS_SS_PARAMETERS_V2 lvds_ss_2;
  359. ENABLE_SPREAD_SPECTRUM_ON_PPLL_PS_ALLOCATION v1;
  360. ENABLE_SPREAD_SPECTRUM_ON_PPLL_V2 v2;
  361. ENABLE_SPREAD_SPECTRUM_ON_PPLL_V3 v3;
  362. };
  363. static void atombios_crtc_program_ss(struct drm_crtc *crtc,
  364. int enable,
  365. int pll_id,
  366. struct radeon_atom_ss *ss)
  367. {
  368. struct drm_device *dev = crtc->dev;
  369. struct radeon_device *rdev = dev->dev_private;
  370. int index = GetIndexIntoMasterTable(COMMAND, EnableSpreadSpectrumOnPPLL);
  371. union atom_enable_ss args;
  372. memset(&args, 0, sizeof(args));
  373. if (ASIC_IS_DCE5(rdev)) {
  374. args.v3.usSpreadSpectrumAmountFrac = cpu_to_le16(0);
  375. args.v3.ucSpreadSpectrumType = ss->type;
  376. switch (pll_id) {
  377. case ATOM_PPLL1:
  378. args.v3.ucSpreadSpectrumType |= ATOM_PPLL_SS_TYPE_V3_P1PLL;
  379. args.v3.usSpreadSpectrumAmount = cpu_to_le16(ss->amount);
  380. args.v3.usSpreadSpectrumStep = cpu_to_le16(ss->step);
  381. break;
  382. case ATOM_PPLL2:
  383. args.v3.ucSpreadSpectrumType |= ATOM_PPLL_SS_TYPE_V3_P2PLL;
  384. args.v3.usSpreadSpectrumAmount = cpu_to_le16(ss->amount);
  385. args.v3.usSpreadSpectrumStep = cpu_to_le16(ss->step);
  386. break;
  387. case ATOM_DCPLL:
  388. args.v3.ucSpreadSpectrumType |= ATOM_PPLL_SS_TYPE_V3_DCPLL;
  389. args.v3.usSpreadSpectrumAmount = cpu_to_le16(0);
  390. args.v3.usSpreadSpectrumStep = cpu_to_le16(0);
  391. break;
  392. case ATOM_PPLL_INVALID:
  393. return;
  394. }
  395. args.v2.ucEnable = enable;
  396. } else if (ASIC_IS_DCE4(rdev)) {
  397. args.v2.usSpreadSpectrumPercentage = cpu_to_le16(ss->percentage);
  398. args.v2.ucSpreadSpectrumType = ss->type;
  399. switch (pll_id) {
  400. case ATOM_PPLL1:
  401. args.v2.ucSpreadSpectrumType |= ATOM_PPLL_SS_TYPE_V2_P1PLL;
  402. args.v2.usSpreadSpectrumAmount = cpu_to_le16(ss->amount);
  403. args.v2.usSpreadSpectrumStep = cpu_to_le16(ss->step);
  404. break;
  405. case ATOM_PPLL2:
  406. args.v2.ucSpreadSpectrumType |= ATOM_PPLL_SS_TYPE_V2_P2PLL;
  407. args.v2.usSpreadSpectrumAmount = cpu_to_le16(ss->amount);
  408. args.v2.usSpreadSpectrumStep = cpu_to_le16(ss->step);
  409. break;
  410. case ATOM_DCPLL:
  411. args.v2.ucSpreadSpectrumType |= ATOM_PPLL_SS_TYPE_V2_DCPLL;
  412. args.v2.usSpreadSpectrumAmount = cpu_to_le16(0);
  413. args.v2.usSpreadSpectrumStep = cpu_to_le16(0);
  414. break;
  415. case ATOM_PPLL_INVALID:
  416. return;
  417. }
  418. args.v2.ucEnable = enable;
  419. } else if (ASIC_IS_DCE3(rdev)) {
  420. args.v1.usSpreadSpectrumPercentage = cpu_to_le16(ss->percentage);
  421. args.v1.ucSpreadSpectrumType = ss->type;
  422. args.v1.ucSpreadSpectrumStep = ss->step;
  423. args.v1.ucSpreadSpectrumDelay = ss->delay;
  424. args.v1.ucSpreadSpectrumRange = ss->range;
  425. args.v1.ucPpll = pll_id;
  426. args.v1.ucEnable = enable;
  427. } else if (ASIC_IS_AVIVO(rdev)) {
  428. if (enable == ATOM_DISABLE) {
  429. atombios_disable_ss(crtc);
  430. return;
  431. }
  432. args.lvds_ss_2.usSpreadSpectrumPercentage = cpu_to_le16(ss->percentage);
  433. args.lvds_ss_2.ucSpreadSpectrumType = ss->type;
  434. args.lvds_ss_2.ucSpreadSpectrumStep = ss->step;
  435. args.lvds_ss_2.ucSpreadSpectrumDelay = ss->delay;
  436. args.lvds_ss_2.ucSpreadSpectrumRange = ss->range;
  437. args.lvds_ss_2.ucEnable = enable;
  438. } else {
  439. if (enable == ATOM_DISABLE) {
  440. atombios_disable_ss(crtc);
  441. return;
  442. }
  443. args.lvds_ss.usSpreadSpectrumPercentage = cpu_to_le16(ss->percentage);
  444. args.lvds_ss.ucSpreadSpectrumType = ss->type;
  445. args.lvds_ss.ucSpreadSpectrumStepSize_Delay = (ss->step & 3) << 2;
  446. args.lvds_ss.ucSpreadSpectrumStepSize_Delay |= (ss->delay & 7) << 4;
  447. args.lvds_ss.ucEnable = enable;
  448. }
  449. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  450. }
  451. union adjust_pixel_clock {
  452. ADJUST_DISPLAY_PLL_PS_ALLOCATION v1;
  453. ADJUST_DISPLAY_PLL_PS_ALLOCATION_V3 v3;
  454. };
  455. static u32 atombios_adjust_pll(struct drm_crtc *crtc,
  456. struct drm_display_mode *mode,
  457. struct radeon_pll *pll,
  458. bool ss_enabled,
  459. struct radeon_atom_ss *ss)
  460. {
  461. struct drm_device *dev = crtc->dev;
  462. struct radeon_device *rdev = dev->dev_private;
  463. struct drm_encoder *encoder = NULL;
  464. struct radeon_encoder *radeon_encoder = NULL;
  465. u32 adjusted_clock = mode->clock;
  466. int encoder_mode = 0;
  467. u32 dp_clock = mode->clock;
  468. int bpc = 8;
  469. /* reset the pll flags */
  470. pll->flags = 0;
  471. if (ASIC_IS_AVIVO(rdev)) {
  472. if ((rdev->family == CHIP_RS600) ||
  473. (rdev->family == CHIP_RS690) ||
  474. (rdev->family == CHIP_RS740))
  475. pll->flags |= (/*RADEON_PLL_USE_FRAC_FB_DIV |*/
  476. RADEON_PLL_PREFER_CLOSEST_LOWER);
  477. if (ASIC_IS_DCE32(rdev) && mode->clock > 200000) /* range limits??? */
  478. pll->flags |= RADEON_PLL_PREFER_HIGH_FB_DIV;
  479. else
  480. pll->flags |= RADEON_PLL_PREFER_LOW_REF_DIV;
  481. } else {
  482. pll->flags |= RADEON_PLL_LEGACY;
  483. if (mode->clock > 200000) /* range limits??? */
  484. pll->flags |= RADEON_PLL_PREFER_HIGH_FB_DIV;
  485. else
  486. pll->flags |= RADEON_PLL_PREFER_LOW_REF_DIV;
  487. }
  488. list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
  489. if (encoder->crtc == crtc) {
  490. radeon_encoder = to_radeon_encoder(encoder);
  491. encoder_mode = atombios_get_encoder_mode(encoder);
  492. if (radeon_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT | ATOM_DEVICE_DFP_SUPPORT)) {
  493. struct drm_connector *connector = radeon_get_connector_for_encoder(encoder);
  494. if (connector) {
  495. struct radeon_connector *radeon_connector = to_radeon_connector(connector);
  496. struct radeon_connector_atom_dig *dig_connector =
  497. radeon_connector->con_priv;
  498. dp_clock = dig_connector->dp_clock;
  499. }
  500. }
  501. /* use recommended ref_div for ss */
  502. if (radeon_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT)) {
  503. if (ss_enabled) {
  504. if (ss->refdiv) {
  505. pll->flags |= RADEON_PLL_PREFER_MINM_OVER_MAXP;
  506. pll->flags |= RADEON_PLL_USE_REF_DIV;
  507. pll->reference_div = ss->refdiv;
  508. if (ASIC_IS_AVIVO(rdev))
  509. pll->flags |= RADEON_PLL_USE_FRAC_FB_DIV;
  510. }
  511. }
  512. }
  513. if (ASIC_IS_AVIVO(rdev)) {
  514. /* DVO wants 2x pixel clock if the DVO chip is in 12 bit mode */
  515. if (radeon_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1)
  516. adjusted_clock = mode->clock * 2;
  517. if (radeon_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
  518. pll->flags |= RADEON_PLL_PREFER_CLOSEST_LOWER;
  519. if (radeon_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT))
  520. pll->flags |= RADEON_PLL_IS_LCD;
  521. } else {
  522. if (encoder->encoder_type != DRM_MODE_ENCODER_DAC)
  523. pll->flags |= RADEON_PLL_NO_ODD_POST_DIV;
  524. if (encoder->encoder_type == DRM_MODE_ENCODER_LVDS)
  525. pll->flags |= RADEON_PLL_USE_REF_DIV;
  526. }
  527. break;
  528. }
  529. }
  530. /* DCE3+ has an AdjustDisplayPll that will adjust the pixel clock
  531. * accordingly based on the encoder/transmitter to work around
  532. * special hw requirements.
  533. */
  534. if (ASIC_IS_DCE3(rdev)) {
  535. union adjust_pixel_clock args;
  536. u8 frev, crev;
  537. int index;
  538. index = GetIndexIntoMasterTable(COMMAND, AdjustDisplayPll);
  539. if (!atom_parse_cmd_header(rdev->mode_info.atom_context, index, &frev,
  540. &crev))
  541. return adjusted_clock;
  542. memset(&args, 0, sizeof(args));
  543. switch (frev) {
  544. case 1:
  545. switch (crev) {
  546. case 1:
  547. case 2:
  548. args.v1.usPixelClock = cpu_to_le16(mode->clock / 10);
  549. args.v1.ucTransmitterID = radeon_encoder->encoder_id;
  550. args.v1.ucEncodeMode = encoder_mode;
  551. if (ss_enabled)
  552. args.v1.ucConfig |=
  553. ADJUST_DISPLAY_CONFIG_SS_ENABLE;
  554. atom_execute_table(rdev->mode_info.atom_context,
  555. index, (uint32_t *)&args);
  556. adjusted_clock = le16_to_cpu(args.v1.usPixelClock) * 10;
  557. break;
  558. case 3:
  559. args.v3.sInput.usPixelClock = cpu_to_le16(mode->clock / 10);
  560. args.v3.sInput.ucTransmitterID = radeon_encoder->encoder_id;
  561. args.v3.sInput.ucEncodeMode = encoder_mode;
  562. args.v3.sInput.ucDispPllConfig = 0;
  563. if (ss_enabled)
  564. args.v3.sInput.ucDispPllConfig |=
  565. DISPPLL_CONFIG_SS_ENABLE;
  566. if (radeon_encoder->devices & (ATOM_DEVICE_DFP_SUPPORT)) {
  567. struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
  568. if (encoder_mode == ATOM_ENCODER_MODE_DP) {
  569. args.v3.sInput.ucDispPllConfig |=
  570. DISPPLL_CONFIG_COHERENT_MODE;
  571. /* 16200 or 27000 */
  572. args.v3.sInput.usPixelClock = cpu_to_le16(dp_clock / 10);
  573. } else {
  574. if (encoder_mode == ATOM_ENCODER_MODE_HDMI) {
  575. /* deep color support */
  576. args.v3.sInput.usPixelClock =
  577. cpu_to_le16((mode->clock * bpc / 8) / 10);
  578. }
  579. if (dig->coherent_mode)
  580. args.v3.sInput.ucDispPllConfig |=
  581. DISPPLL_CONFIG_COHERENT_MODE;
  582. if (mode->clock > 165000)
  583. args.v3.sInput.ucDispPllConfig |=
  584. DISPPLL_CONFIG_DUAL_LINK;
  585. }
  586. } else if (radeon_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT)) {
  587. if (encoder_mode == ATOM_ENCODER_MODE_DP) {
  588. args.v3.sInput.ucDispPllConfig |=
  589. DISPPLL_CONFIG_COHERENT_MODE;
  590. /* 16200 or 27000 */
  591. args.v3.sInput.usPixelClock = cpu_to_le16(dp_clock / 10);
  592. } else if (encoder_mode != ATOM_ENCODER_MODE_LVDS) {
  593. if (mode->clock > 165000)
  594. args.v3.sInput.ucDispPllConfig |=
  595. DISPPLL_CONFIG_DUAL_LINK;
  596. }
  597. }
  598. atom_execute_table(rdev->mode_info.atom_context,
  599. index, (uint32_t *)&args);
  600. adjusted_clock = le32_to_cpu(args.v3.sOutput.ulDispPllFreq) * 10;
  601. if (args.v3.sOutput.ucRefDiv) {
  602. pll->flags |= RADEON_PLL_USE_FRAC_FB_DIV;
  603. pll->flags |= RADEON_PLL_USE_REF_DIV;
  604. pll->reference_div = args.v3.sOutput.ucRefDiv;
  605. }
  606. if (args.v3.sOutput.ucPostDiv) {
  607. pll->flags |= RADEON_PLL_USE_FRAC_FB_DIV;
  608. pll->flags |= RADEON_PLL_USE_POST_DIV;
  609. pll->post_div = args.v3.sOutput.ucPostDiv;
  610. }
  611. break;
  612. default:
  613. DRM_ERROR("Unknown table version %d %d\n", frev, crev);
  614. return adjusted_clock;
  615. }
  616. break;
  617. default:
  618. DRM_ERROR("Unknown table version %d %d\n", frev, crev);
  619. return adjusted_clock;
  620. }
  621. }
  622. return adjusted_clock;
  623. }
  624. union set_pixel_clock {
  625. SET_PIXEL_CLOCK_PS_ALLOCATION base;
  626. PIXEL_CLOCK_PARAMETERS v1;
  627. PIXEL_CLOCK_PARAMETERS_V2 v2;
  628. PIXEL_CLOCK_PARAMETERS_V3 v3;
  629. PIXEL_CLOCK_PARAMETERS_V5 v5;
  630. PIXEL_CLOCK_PARAMETERS_V6 v6;
  631. };
  632. /* on DCE5, make sure the voltage is high enough to support the
  633. * required disp clk.
  634. */
  635. static void atombios_crtc_set_dcpll(struct drm_crtc *crtc,
  636. u32 dispclk)
  637. {
  638. struct drm_device *dev = crtc->dev;
  639. struct radeon_device *rdev = dev->dev_private;
  640. u8 frev, crev;
  641. int index;
  642. union set_pixel_clock args;
  643. memset(&args, 0, sizeof(args));
  644. index = GetIndexIntoMasterTable(COMMAND, SetPixelClock);
  645. if (!atom_parse_cmd_header(rdev->mode_info.atom_context, index, &frev,
  646. &crev))
  647. return;
  648. switch (frev) {
  649. case 1:
  650. switch (crev) {
  651. case 5:
  652. /* if the default dcpll clock is specified,
  653. * SetPixelClock provides the dividers
  654. */
  655. args.v5.ucCRTC = ATOM_CRTC_INVALID;
  656. args.v5.usPixelClock = cpu_to_le16(dispclk);
  657. args.v5.ucPpll = ATOM_DCPLL;
  658. break;
  659. case 6:
  660. /* if the default dcpll clock is specified,
  661. * SetPixelClock provides the dividers
  662. */
  663. args.v6.ulDispEngClkFreq = cpu_to_le32(dispclk);
  664. args.v6.ucPpll = ATOM_DCPLL;
  665. break;
  666. default:
  667. DRM_ERROR("Unknown table version %d %d\n", frev, crev);
  668. return;
  669. }
  670. break;
  671. default:
  672. DRM_ERROR("Unknown table version %d %d\n", frev, crev);
  673. return;
  674. }
  675. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  676. }
  677. static void atombios_crtc_program_pll(struct drm_crtc *crtc,
  678. int crtc_id,
  679. int pll_id,
  680. u32 encoder_mode,
  681. u32 encoder_id,
  682. u32 clock,
  683. u32 ref_div,
  684. u32 fb_div,
  685. u32 frac_fb_div,
  686. u32 post_div)
  687. {
  688. struct drm_device *dev = crtc->dev;
  689. struct radeon_device *rdev = dev->dev_private;
  690. u8 frev, crev;
  691. int index = GetIndexIntoMasterTable(COMMAND, SetPixelClock);
  692. union set_pixel_clock args;
  693. memset(&args, 0, sizeof(args));
  694. if (!atom_parse_cmd_header(rdev->mode_info.atom_context, index, &frev,
  695. &crev))
  696. return;
  697. switch (frev) {
  698. case 1:
  699. switch (crev) {
  700. case 1:
  701. if (clock == ATOM_DISABLE)
  702. return;
  703. args.v1.usPixelClock = cpu_to_le16(clock / 10);
  704. args.v1.usRefDiv = cpu_to_le16(ref_div);
  705. args.v1.usFbDiv = cpu_to_le16(fb_div);
  706. args.v1.ucFracFbDiv = frac_fb_div;
  707. args.v1.ucPostDiv = post_div;
  708. args.v1.ucPpll = pll_id;
  709. args.v1.ucCRTC = crtc_id;
  710. args.v1.ucRefDivSrc = 1;
  711. break;
  712. case 2:
  713. args.v2.usPixelClock = cpu_to_le16(clock / 10);
  714. args.v2.usRefDiv = cpu_to_le16(ref_div);
  715. args.v2.usFbDiv = cpu_to_le16(fb_div);
  716. args.v2.ucFracFbDiv = frac_fb_div;
  717. args.v2.ucPostDiv = post_div;
  718. args.v2.ucPpll = pll_id;
  719. args.v2.ucCRTC = crtc_id;
  720. args.v2.ucRefDivSrc = 1;
  721. break;
  722. case 3:
  723. args.v3.usPixelClock = cpu_to_le16(clock / 10);
  724. args.v3.usRefDiv = cpu_to_le16(ref_div);
  725. args.v3.usFbDiv = cpu_to_le16(fb_div);
  726. args.v3.ucFracFbDiv = frac_fb_div;
  727. args.v3.ucPostDiv = post_div;
  728. args.v3.ucPpll = pll_id;
  729. args.v3.ucMiscInfo = (pll_id << 2);
  730. args.v3.ucTransmitterId = encoder_id;
  731. args.v3.ucEncoderMode = encoder_mode;
  732. break;
  733. case 5:
  734. args.v5.ucCRTC = crtc_id;
  735. args.v5.usPixelClock = cpu_to_le16(clock / 10);
  736. args.v5.ucRefDiv = ref_div;
  737. args.v5.usFbDiv = cpu_to_le16(fb_div);
  738. args.v5.ulFbDivDecFrac = cpu_to_le32(frac_fb_div * 100000);
  739. args.v5.ucPostDiv = post_div;
  740. args.v5.ucMiscInfo = 0; /* HDMI depth, etc. */
  741. args.v5.ucTransmitterID = encoder_id;
  742. args.v5.ucEncoderMode = encoder_mode;
  743. args.v5.ucPpll = pll_id;
  744. break;
  745. case 6:
  746. args.v6.ulCrtcPclkFreq.ucCRTC = crtc_id;
  747. args.v6.ulCrtcPclkFreq.ulPixelClock = cpu_to_le32(clock / 10);
  748. args.v6.ucRefDiv = ref_div;
  749. args.v6.usFbDiv = cpu_to_le16(fb_div);
  750. args.v6.ulFbDivDecFrac = cpu_to_le32(frac_fb_div * 100000);
  751. args.v6.ucPostDiv = post_div;
  752. args.v6.ucMiscInfo = 0; /* HDMI depth, etc. */
  753. args.v6.ucTransmitterID = encoder_id;
  754. args.v6.ucEncoderMode = encoder_mode;
  755. args.v6.ucPpll = pll_id;
  756. break;
  757. default:
  758. DRM_ERROR("Unknown table version %d %d\n", frev, crev);
  759. return;
  760. }
  761. break;
  762. default:
  763. DRM_ERROR("Unknown table version %d %d\n", frev, crev);
  764. return;
  765. }
  766. atom_execute_table(rdev->mode_info.atom_context, index, (uint32_t *)&args);
  767. }
  768. static void atombios_crtc_set_pll(struct drm_crtc *crtc, struct drm_display_mode *mode)
  769. {
  770. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  771. struct drm_device *dev = crtc->dev;
  772. struct radeon_device *rdev = dev->dev_private;
  773. struct drm_encoder *encoder = NULL;
  774. struct radeon_encoder *radeon_encoder = NULL;
  775. u32 pll_clock = mode->clock;
  776. u32 ref_div = 0, fb_div = 0, frac_fb_div = 0, post_div = 0;
  777. struct radeon_pll *pll;
  778. u32 adjusted_clock;
  779. int encoder_mode = 0;
  780. struct radeon_atom_ss ss;
  781. bool ss_enabled = false;
  782. list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
  783. if (encoder->crtc == crtc) {
  784. radeon_encoder = to_radeon_encoder(encoder);
  785. encoder_mode = atombios_get_encoder_mode(encoder);
  786. break;
  787. }
  788. }
  789. if (!radeon_encoder)
  790. return;
  791. switch (radeon_crtc->pll_id) {
  792. case ATOM_PPLL1:
  793. pll = &rdev->clock.p1pll;
  794. break;
  795. case ATOM_PPLL2:
  796. pll = &rdev->clock.p2pll;
  797. break;
  798. case ATOM_DCPLL:
  799. case ATOM_PPLL_INVALID:
  800. default:
  801. pll = &rdev->clock.dcpll;
  802. break;
  803. }
  804. if (radeon_encoder->active_device &
  805. (ATOM_DEVICE_LCD_SUPPORT | ATOM_DEVICE_DFP_SUPPORT)) {
  806. struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
  807. struct drm_connector *connector =
  808. radeon_get_connector_for_encoder(encoder);
  809. struct radeon_connector *radeon_connector =
  810. to_radeon_connector(connector);
  811. struct radeon_connector_atom_dig *dig_connector =
  812. radeon_connector->con_priv;
  813. int dp_clock;
  814. switch (encoder_mode) {
  815. case ATOM_ENCODER_MODE_DP:
  816. /* DP/eDP */
  817. dp_clock = dig_connector->dp_clock / 10;
  818. if (radeon_encoder->active_device & (ATOM_DEVICE_LCD_SUPPORT)) {
  819. if (ASIC_IS_DCE4(rdev))
  820. ss_enabled =
  821. radeon_atombios_get_asic_ss_info(rdev, &ss,
  822. dig->lcd_ss_id,
  823. dp_clock);
  824. else
  825. ss_enabled =
  826. radeon_atombios_get_ppll_ss_info(rdev, &ss,
  827. dig->lcd_ss_id);
  828. } else {
  829. if (ASIC_IS_DCE4(rdev))
  830. ss_enabled =
  831. radeon_atombios_get_asic_ss_info(rdev, &ss,
  832. ASIC_INTERNAL_SS_ON_DP,
  833. dp_clock);
  834. else {
  835. if (dp_clock == 16200) {
  836. ss_enabled =
  837. radeon_atombios_get_ppll_ss_info(rdev, &ss,
  838. ATOM_DP_SS_ID2);
  839. if (!ss_enabled)
  840. ss_enabled =
  841. radeon_atombios_get_ppll_ss_info(rdev, &ss,
  842. ATOM_DP_SS_ID1);
  843. } else
  844. ss_enabled =
  845. radeon_atombios_get_ppll_ss_info(rdev, &ss,
  846. ATOM_DP_SS_ID1);
  847. }
  848. }
  849. break;
  850. case ATOM_ENCODER_MODE_LVDS:
  851. if (ASIC_IS_DCE4(rdev))
  852. ss_enabled = radeon_atombios_get_asic_ss_info(rdev, &ss,
  853. dig->lcd_ss_id,
  854. mode->clock / 10);
  855. else
  856. ss_enabled = radeon_atombios_get_ppll_ss_info(rdev, &ss,
  857. dig->lcd_ss_id);
  858. break;
  859. case ATOM_ENCODER_MODE_DVI:
  860. if (ASIC_IS_DCE4(rdev))
  861. ss_enabled =
  862. radeon_atombios_get_asic_ss_info(rdev, &ss,
  863. ASIC_INTERNAL_SS_ON_TMDS,
  864. mode->clock / 10);
  865. break;
  866. case ATOM_ENCODER_MODE_HDMI:
  867. if (ASIC_IS_DCE4(rdev))
  868. ss_enabled =
  869. radeon_atombios_get_asic_ss_info(rdev, &ss,
  870. ASIC_INTERNAL_SS_ON_HDMI,
  871. mode->clock / 10);
  872. break;
  873. default:
  874. break;
  875. }
  876. }
  877. /* adjust pixel clock as needed */
  878. adjusted_clock = atombios_adjust_pll(crtc, mode, pll, ss_enabled, &ss);
  879. if (radeon_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
  880. /* TV seems to prefer the legacy algo on some boards */
  881. radeon_compute_pll_legacy(pll, adjusted_clock, &pll_clock, &fb_div, &frac_fb_div,
  882. &ref_div, &post_div);
  883. else if (ASIC_IS_AVIVO(rdev))
  884. radeon_compute_pll_avivo(pll, adjusted_clock, &pll_clock, &fb_div, &frac_fb_div,
  885. &ref_div, &post_div);
  886. else
  887. radeon_compute_pll_legacy(pll, adjusted_clock, &pll_clock, &fb_div, &frac_fb_div,
  888. &ref_div, &post_div);
  889. atombios_crtc_program_ss(crtc, ATOM_DISABLE, radeon_crtc->pll_id, &ss);
  890. atombios_crtc_program_pll(crtc, radeon_crtc->crtc_id, radeon_crtc->pll_id,
  891. encoder_mode, radeon_encoder->encoder_id, mode->clock,
  892. ref_div, fb_div, frac_fb_div, post_div);
  893. if (ss_enabled) {
  894. /* calculate ss amount and step size */
  895. if (ASIC_IS_DCE4(rdev)) {
  896. u32 step_size;
  897. u32 amount = (((fb_div * 10) + frac_fb_div) * ss.percentage) / 10000;
  898. ss.amount = (amount / 10) & ATOM_PPLL_SS_AMOUNT_V2_FBDIV_MASK;
  899. ss.amount |= ((amount - (ss.amount * 10)) << ATOM_PPLL_SS_AMOUNT_V2_NFRAC_SHIFT) &
  900. ATOM_PPLL_SS_AMOUNT_V2_NFRAC_MASK;
  901. if (ss.type & ATOM_PPLL_SS_TYPE_V2_CENTRE_SPREAD)
  902. step_size = (4 * amount * ref_div * (ss.rate * 2048)) /
  903. (125 * 25 * pll->reference_freq / 100);
  904. else
  905. step_size = (2 * amount * ref_div * (ss.rate * 2048)) /
  906. (125 * 25 * pll->reference_freq / 100);
  907. ss.step = step_size;
  908. }
  909. atombios_crtc_program_ss(crtc, ATOM_ENABLE, radeon_crtc->pll_id, &ss);
  910. }
  911. }
  912. static int dce4_crtc_do_set_base(struct drm_crtc *crtc,
  913. struct drm_framebuffer *fb,
  914. int x, int y, int atomic)
  915. {
  916. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  917. struct drm_device *dev = crtc->dev;
  918. struct radeon_device *rdev = dev->dev_private;
  919. struct radeon_framebuffer *radeon_fb;
  920. struct drm_framebuffer *target_fb;
  921. struct drm_gem_object *obj;
  922. struct radeon_bo *rbo;
  923. uint64_t fb_location;
  924. uint32_t fb_format, fb_pitch_pixels, tiling_flags;
  925. u32 fb_swap = EVERGREEN_GRPH_ENDIAN_SWAP(EVERGREEN_GRPH_ENDIAN_NONE);
  926. u32 tmp;
  927. int r;
  928. /* no fb bound */
  929. if (!atomic && !crtc->fb) {
  930. DRM_DEBUG_KMS("No FB bound\n");
  931. return 0;
  932. }
  933. if (atomic) {
  934. radeon_fb = to_radeon_framebuffer(fb);
  935. target_fb = fb;
  936. }
  937. else {
  938. radeon_fb = to_radeon_framebuffer(crtc->fb);
  939. target_fb = crtc->fb;
  940. }
  941. /* If atomic, assume fb object is pinned & idle & fenced and
  942. * just update base pointers
  943. */
  944. obj = radeon_fb->obj;
  945. rbo = gem_to_radeon_bo(obj);
  946. r = radeon_bo_reserve(rbo, false);
  947. if (unlikely(r != 0))
  948. return r;
  949. if (atomic)
  950. fb_location = radeon_bo_gpu_offset(rbo);
  951. else {
  952. r = radeon_bo_pin(rbo, RADEON_GEM_DOMAIN_VRAM, &fb_location);
  953. if (unlikely(r != 0)) {
  954. radeon_bo_unreserve(rbo);
  955. return -EINVAL;
  956. }
  957. }
  958. radeon_bo_get_tiling_flags(rbo, &tiling_flags, NULL);
  959. radeon_bo_unreserve(rbo);
  960. switch (target_fb->bits_per_pixel) {
  961. case 8:
  962. fb_format = (EVERGREEN_GRPH_DEPTH(EVERGREEN_GRPH_DEPTH_8BPP) |
  963. EVERGREEN_GRPH_FORMAT(EVERGREEN_GRPH_FORMAT_INDEXED));
  964. break;
  965. case 15:
  966. fb_format = (EVERGREEN_GRPH_DEPTH(EVERGREEN_GRPH_DEPTH_16BPP) |
  967. EVERGREEN_GRPH_FORMAT(EVERGREEN_GRPH_FORMAT_ARGB1555));
  968. break;
  969. case 16:
  970. fb_format = (EVERGREEN_GRPH_DEPTH(EVERGREEN_GRPH_DEPTH_16BPP) |
  971. EVERGREEN_GRPH_FORMAT(EVERGREEN_GRPH_FORMAT_ARGB565));
  972. #ifdef __BIG_ENDIAN
  973. fb_swap = EVERGREEN_GRPH_ENDIAN_SWAP(EVERGREEN_GRPH_ENDIAN_8IN16);
  974. #endif
  975. break;
  976. case 24:
  977. case 32:
  978. fb_format = (EVERGREEN_GRPH_DEPTH(EVERGREEN_GRPH_DEPTH_32BPP) |
  979. EVERGREEN_GRPH_FORMAT(EVERGREEN_GRPH_FORMAT_ARGB8888));
  980. #ifdef __BIG_ENDIAN
  981. fb_swap = EVERGREEN_GRPH_ENDIAN_SWAP(EVERGREEN_GRPH_ENDIAN_8IN32);
  982. #endif
  983. break;
  984. default:
  985. DRM_ERROR("Unsupported screen depth %d\n",
  986. target_fb->bits_per_pixel);
  987. return -EINVAL;
  988. }
  989. if (tiling_flags & RADEON_TILING_MACRO)
  990. fb_format |= EVERGREEN_GRPH_ARRAY_MODE(EVERGREEN_GRPH_ARRAY_2D_TILED_THIN1);
  991. else if (tiling_flags & RADEON_TILING_MICRO)
  992. fb_format |= EVERGREEN_GRPH_ARRAY_MODE(EVERGREEN_GRPH_ARRAY_1D_TILED_THIN1);
  993. switch (radeon_crtc->crtc_id) {
  994. case 0:
  995. WREG32(AVIVO_D1VGA_CONTROL, 0);
  996. break;
  997. case 1:
  998. WREG32(AVIVO_D2VGA_CONTROL, 0);
  999. break;
  1000. case 2:
  1001. WREG32(EVERGREEN_D3VGA_CONTROL, 0);
  1002. break;
  1003. case 3:
  1004. WREG32(EVERGREEN_D4VGA_CONTROL, 0);
  1005. break;
  1006. case 4:
  1007. WREG32(EVERGREEN_D5VGA_CONTROL, 0);
  1008. break;
  1009. case 5:
  1010. WREG32(EVERGREEN_D6VGA_CONTROL, 0);
  1011. break;
  1012. default:
  1013. break;
  1014. }
  1015. WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + radeon_crtc->crtc_offset,
  1016. upper_32_bits(fb_location));
  1017. WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + radeon_crtc->crtc_offset,
  1018. upper_32_bits(fb_location));
  1019. WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + radeon_crtc->crtc_offset,
  1020. (u32)fb_location & EVERGREEN_GRPH_SURFACE_ADDRESS_MASK);
  1021. WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + radeon_crtc->crtc_offset,
  1022. (u32) fb_location & EVERGREEN_GRPH_SURFACE_ADDRESS_MASK);
  1023. WREG32(EVERGREEN_GRPH_CONTROL + radeon_crtc->crtc_offset, fb_format);
  1024. WREG32(EVERGREEN_GRPH_SWAP_CONTROL + radeon_crtc->crtc_offset, fb_swap);
  1025. WREG32(EVERGREEN_GRPH_SURFACE_OFFSET_X + radeon_crtc->crtc_offset, 0);
  1026. WREG32(EVERGREEN_GRPH_SURFACE_OFFSET_Y + radeon_crtc->crtc_offset, 0);
  1027. WREG32(EVERGREEN_GRPH_X_START + radeon_crtc->crtc_offset, 0);
  1028. WREG32(EVERGREEN_GRPH_Y_START + radeon_crtc->crtc_offset, 0);
  1029. WREG32(EVERGREEN_GRPH_X_END + radeon_crtc->crtc_offset, target_fb->width);
  1030. WREG32(EVERGREEN_GRPH_Y_END + radeon_crtc->crtc_offset, target_fb->height);
  1031. fb_pitch_pixels = target_fb->pitch / (target_fb->bits_per_pixel / 8);
  1032. WREG32(EVERGREEN_GRPH_PITCH + radeon_crtc->crtc_offset, fb_pitch_pixels);
  1033. WREG32(EVERGREEN_GRPH_ENABLE + radeon_crtc->crtc_offset, 1);
  1034. WREG32(EVERGREEN_DESKTOP_HEIGHT + radeon_crtc->crtc_offset,
  1035. crtc->mode.vdisplay);
  1036. x &= ~3;
  1037. y &= ~1;
  1038. WREG32(EVERGREEN_VIEWPORT_START + radeon_crtc->crtc_offset,
  1039. (x << 16) | y);
  1040. WREG32(EVERGREEN_VIEWPORT_SIZE + radeon_crtc->crtc_offset,
  1041. (crtc->mode.hdisplay << 16) | crtc->mode.vdisplay);
  1042. /* pageflip setup */
  1043. /* make sure flip is at vb rather than hb */
  1044. tmp = RREG32(EVERGREEN_GRPH_FLIP_CONTROL + radeon_crtc->crtc_offset);
  1045. tmp &= ~EVERGREEN_GRPH_SURFACE_UPDATE_H_RETRACE_EN;
  1046. WREG32(EVERGREEN_GRPH_FLIP_CONTROL + radeon_crtc->crtc_offset, tmp);
  1047. /* set pageflip to happen anywhere in vblank interval */
  1048. WREG32(EVERGREEN_MASTER_UPDATE_MODE + radeon_crtc->crtc_offset, 0);
  1049. if (!atomic && fb && fb != crtc->fb) {
  1050. radeon_fb = to_radeon_framebuffer(fb);
  1051. rbo = gem_to_radeon_bo(radeon_fb->obj);
  1052. r = radeon_bo_reserve(rbo, false);
  1053. if (unlikely(r != 0))
  1054. return r;
  1055. radeon_bo_unpin(rbo);
  1056. radeon_bo_unreserve(rbo);
  1057. }
  1058. /* Bytes per pixel may have changed */
  1059. radeon_bandwidth_update(rdev);
  1060. return 0;
  1061. }
  1062. static int avivo_crtc_do_set_base(struct drm_crtc *crtc,
  1063. struct drm_framebuffer *fb,
  1064. int x, int y, int atomic)
  1065. {
  1066. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1067. struct drm_device *dev = crtc->dev;
  1068. struct radeon_device *rdev = dev->dev_private;
  1069. struct radeon_framebuffer *radeon_fb;
  1070. struct drm_gem_object *obj;
  1071. struct radeon_bo *rbo;
  1072. struct drm_framebuffer *target_fb;
  1073. uint64_t fb_location;
  1074. uint32_t fb_format, fb_pitch_pixels, tiling_flags;
  1075. u32 fb_swap = R600_D1GRPH_SWAP_ENDIAN_NONE;
  1076. u32 tmp;
  1077. int r;
  1078. /* no fb bound */
  1079. if (!atomic && !crtc->fb) {
  1080. DRM_DEBUG_KMS("No FB bound\n");
  1081. return 0;
  1082. }
  1083. if (atomic) {
  1084. radeon_fb = to_radeon_framebuffer(fb);
  1085. target_fb = fb;
  1086. }
  1087. else {
  1088. radeon_fb = to_radeon_framebuffer(crtc->fb);
  1089. target_fb = crtc->fb;
  1090. }
  1091. obj = radeon_fb->obj;
  1092. rbo = gem_to_radeon_bo(obj);
  1093. r = radeon_bo_reserve(rbo, false);
  1094. if (unlikely(r != 0))
  1095. return r;
  1096. /* If atomic, assume fb object is pinned & idle & fenced and
  1097. * just update base pointers
  1098. */
  1099. if (atomic)
  1100. fb_location = radeon_bo_gpu_offset(rbo);
  1101. else {
  1102. r = radeon_bo_pin(rbo, RADEON_GEM_DOMAIN_VRAM, &fb_location);
  1103. if (unlikely(r != 0)) {
  1104. radeon_bo_unreserve(rbo);
  1105. return -EINVAL;
  1106. }
  1107. }
  1108. radeon_bo_get_tiling_flags(rbo, &tiling_flags, NULL);
  1109. radeon_bo_unreserve(rbo);
  1110. switch (target_fb->bits_per_pixel) {
  1111. case 8:
  1112. fb_format =
  1113. AVIVO_D1GRPH_CONTROL_DEPTH_8BPP |
  1114. AVIVO_D1GRPH_CONTROL_8BPP_INDEXED;
  1115. break;
  1116. case 15:
  1117. fb_format =
  1118. AVIVO_D1GRPH_CONTROL_DEPTH_16BPP |
  1119. AVIVO_D1GRPH_CONTROL_16BPP_ARGB1555;
  1120. break;
  1121. case 16:
  1122. fb_format =
  1123. AVIVO_D1GRPH_CONTROL_DEPTH_16BPP |
  1124. AVIVO_D1GRPH_CONTROL_16BPP_RGB565;
  1125. #ifdef __BIG_ENDIAN
  1126. fb_swap = R600_D1GRPH_SWAP_ENDIAN_16BIT;
  1127. #endif
  1128. break;
  1129. case 24:
  1130. case 32:
  1131. fb_format =
  1132. AVIVO_D1GRPH_CONTROL_DEPTH_32BPP |
  1133. AVIVO_D1GRPH_CONTROL_32BPP_ARGB8888;
  1134. #ifdef __BIG_ENDIAN
  1135. fb_swap = R600_D1GRPH_SWAP_ENDIAN_32BIT;
  1136. #endif
  1137. break;
  1138. default:
  1139. DRM_ERROR("Unsupported screen depth %d\n",
  1140. target_fb->bits_per_pixel);
  1141. return -EINVAL;
  1142. }
  1143. if (rdev->family >= CHIP_R600) {
  1144. if (tiling_flags & RADEON_TILING_MACRO)
  1145. fb_format |= R600_D1GRPH_ARRAY_MODE_2D_TILED_THIN1;
  1146. else if (tiling_flags & RADEON_TILING_MICRO)
  1147. fb_format |= R600_D1GRPH_ARRAY_MODE_1D_TILED_THIN1;
  1148. } else {
  1149. if (tiling_flags & RADEON_TILING_MACRO)
  1150. fb_format |= AVIVO_D1GRPH_MACRO_ADDRESS_MODE;
  1151. if (tiling_flags & RADEON_TILING_MICRO)
  1152. fb_format |= AVIVO_D1GRPH_TILED;
  1153. }
  1154. if (radeon_crtc->crtc_id == 0)
  1155. WREG32(AVIVO_D1VGA_CONTROL, 0);
  1156. else
  1157. WREG32(AVIVO_D2VGA_CONTROL, 0);
  1158. if (rdev->family >= CHIP_RV770) {
  1159. if (radeon_crtc->crtc_id) {
  1160. WREG32(R700_D2GRPH_PRIMARY_SURFACE_ADDRESS_HIGH, upper_32_bits(fb_location));
  1161. WREG32(R700_D2GRPH_SECONDARY_SURFACE_ADDRESS_HIGH, upper_32_bits(fb_location));
  1162. } else {
  1163. WREG32(R700_D1GRPH_PRIMARY_SURFACE_ADDRESS_HIGH, upper_32_bits(fb_location));
  1164. WREG32(R700_D1GRPH_SECONDARY_SURFACE_ADDRESS_HIGH, upper_32_bits(fb_location));
  1165. }
  1166. }
  1167. WREG32(AVIVO_D1GRPH_PRIMARY_SURFACE_ADDRESS + radeon_crtc->crtc_offset,
  1168. (u32) fb_location);
  1169. WREG32(AVIVO_D1GRPH_SECONDARY_SURFACE_ADDRESS +
  1170. radeon_crtc->crtc_offset, (u32) fb_location);
  1171. WREG32(AVIVO_D1GRPH_CONTROL + radeon_crtc->crtc_offset, fb_format);
  1172. if (rdev->family >= CHIP_R600)
  1173. WREG32(R600_D1GRPH_SWAP_CONTROL + radeon_crtc->crtc_offset, fb_swap);
  1174. WREG32(AVIVO_D1GRPH_SURFACE_OFFSET_X + radeon_crtc->crtc_offset, 0);
  1175. WREG32(AVIVO_D1GRPH_SURFACE_OFFSET_Y + radeon_crtc->crtc_offset, 0);
  1176. WREG32(AVIVO_D1GRPH_X_START + radeon_crtc->crtc_offset, 0);
  1177. WREG32(AVIVO_D1GRPH_Y_START + radeon_crtc->crtc_offset, 0);
  1178. WREG32(AVIVO_D1GRPH_X_END + radeon_crtc->crtc_offset, target_fb->width);
  1179. WREG32(AVIVO_D1GRPH_Y_END + radeon_crtc->crtc_offset, target_fb->height);
  1180. fb_pitch_pixels = target_fb->pitch / (target_fb->bits_per_pixel / 8);
  1181. WREG32(AVIVO_D1GRPH_PITCH + radeon_crtc->crtc_offset, fb_pitch_pixels);
  1182. WREG32(AVIVO_D1GRPH_ENABLE + radeon_crtc->crtc_offset, 1);
  1183. WREG32(AVIVO_D1MODE_DESKTOP_HEIGHT + radeon_crtc->crtc_offset,
  1184. crtc->mode.vdisplay);
  1185. x &= ~3;
  1186. y &= ~1;
  1187. WREG32(AVIVO_D1MODE_VIEWPORT_START + radeon_crtc->crtc_offset,
  1188. (x << 16) | y);
  1189. WREG32(AVIVO_D1MODE_VIEWPORT_SIZE + radeon_crtc->crtc_offset,
  1190. (crtc->mode.hdisplay << 16) | crtc->mode.vdisplay);
  1191. /* pageflip setup */
  1192. /* make sure flip is at vb rather than hb */
  1193. tmp = RREG32(AVIVO_D1GRPH_FLIP_CONTROL + radeon_crtc->crtc_offset);
  1194. tmp &= ~AVIVO_D1GRPH_SURFACE_UPDATE_H_RETRACE_EN;
  1195. WREG32(AVIVO_D1GRPH_FLIP_CONTROL + radeon_crtc->crtc_offset, tmp);
  1196. /* set pageflip to happen anywhere in vblank interval */
  1197. WREG32(AVIVO_D1MODE_MASTER_UPDATE_MODE + radeon_crtc->crtc_offset, 0);
  1198. if (!atomic && fb && fb != crtc->fb) {
  1199. radeon_fb = to_radeon_framebuffer(fb);
  1200. rbo = gem_to_radeon_bo(radeon_fb->obj);
  1201. r = radeon_bo_reserve(rbo, false);
  1202. if (unlikely(r != 0))
  1203. return r;
  1204. radeon_bo_unpin(rbo);
  1205. radeon_bo_unreserve(rbo);
  1206. }
  1207. /* Bytes per pixel may have changed */
  1208. radeon_bandwidth_update(rdev);
  1209. return 0;
  1210. }
  1211. int atombios_crtc_set_base(struct drm_crtc *crtc, int x, int y,
  1212. struct drm_framebuffer *old_fb)
  1213. {
  1214. struct drm_device *dev = crtc->dev;
  1215. struct radeon_device *rdev = dev->dev_private;
  1216. if (ASIC_IS_DCE4(rdev))
  1217. return dce4_crtc_do_set_base(crtc, old_fb, x, y, 0);
  1218. else if (ASIC_IS_AVIVO(rdev))
  1219. return avivo_crtc_do_set_base(crtc, old_fb, x, y, 0);
  1220. else
  1221. return radeon_crtc_do_set_base(crtc, old_fb, x, y, 0);
  1222. }
  1223. int atombios_crtc_set_base_atomic(struct drm_crtc *crtc,
  1224. struct drm_framebuffer *fb,
  1225. int x, int y, enum mode_set_atomic state)
  1226. {
  1227. struct drm_device *dev = crtc->dev;
  1228. struct radeon_device *rdev = dev->dev_private;
  1229. if (ASIC_IS_DCE4(rdev))
  1230. return dce4_crtc_do_set_base(crtc, fb, x, y, 1);
  1231. else if (ASIC_IS_AVIVO(rdev))
  1232. return avivo_crtc_do_set_base(crtc, fb, x, y, 1);
  1233. else
  1234. return radeon_crtc_do_set_base(crtc, fb, x, y, 1);
  1235. }
  1236. /* properly set additional regs when using atombios */
  1237. static void radeon_legacy_atom_fixup(struct drm_crtc *crtc)
  1238. {
  1239. struct drm_device *dev = crtc->dev;
  1240. struct radeon_device *rdev = dev->dev_private;
  1241. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1242. u32 disp_merge_cntl;
  1243. switch (radeon_crtc->crtc_id) {
  1244. case 0:
  1245. disp_merge_cntl = RREG32(RADEON_DISP_MERGE_CNTL);
  1246. disp_merge_cntl &= ~RADEON_DISP_RGB_OFFSET_EN;
  1247. WREG32(RADEON_DISP_MERGE_CNTL, disp_merge_cntl);
  1248. break;
  1249. case 1:
  1250. disp_merge_cntl = RREG32(RADEON_DISP2_MERGE_CNTL);
  1251. disp_merge_cntl &= ~RADEON_DISP2_RGB_OFFSET_EN;
  1252. WREG32(RADEON_DISP2_MERGE_CNTL, disp_merge_cntl);
  1253. WREG32(RADEON_FP_H2_SYNC_STRT_WID, RREG32(RADEON_CRTC2_H_SYNC_STRT_WID));
  1254. WREG32(RADEON_FP_V2_SYNC_STRT_WID, RREG32(RADEON_CRTC2_V_SYNC_STRT_WID));
  1255. break;
  1256. }
  1257. }
  1258. static int radeon_atom_pick_pll(struct drm_crtc *crtc)
  1259. {
  1260. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1261. struct drm_device *dev = crtc->dev;
  1262. struct radeon_device *rdev = dev->dev_private;
  1263. struct drm_encoder *test_encoder;
  1264. struct drm_crtc *test_crtc;
  1265. uint32_t pll_in_use = 0;
  1266. if (ASIC_IS_DCE4(rdev)) {
  1267. /* if crtc is driving DP and we have an ext clock, use that */
  1268. list_for_each_entry(test_encoder, &dev->mode_config.encoder_list, head) {
  1269. if (test_encoder->crtc && (test_encoder->crtc == crtc)) {
  1270. if (atombios_get_encoder_mode(test_encoder) == ATOM_ENCODER_MODE_DP) {
  1271. if (rdev->clock.dp_extclk)
  1272. return ATOM_PPLL_INVALID;
  1273. }
  1274. }
  1275. }
  1276. /* otherwise, pick one of the plls */
  1277. list_for_each_entry(test_crtc, &dev->mode_config.crtc_list, head) {
  1278. struct radeon_crtc *radeon_test_crtc;
  1279. if (crtc == test_crtc)
  1280. continue;
  1281. radeon_test_crtc = to_radeon_crtc(test_crtc);
  1282. if ((radeon_test_crtc->pll_id >= ATOM_PPLL1) &&
  1283. (radeon_test_crtc->pll_id <= ATOM_PPLL2))
  1284. pll_in_use |= (1 << radeon_test_crtc->pll_id);
  1285. }
  1286. if (!(pll_in_use & 1))
  1287. return ATOM_PPLL1;
  1288. return ATOM_PPLL2;
  1289. } else
  1290. return radeon_crtc->crtc_id;
  1291. }
  1292. int atombios_crtc_mode_set(struct drm_crtc *crtc,
  1293. struct drm_display_mode *mode,
  1294. struct drm_display_mode *adjusted_mode,
  1295. int x, int y, struct drm_framebuffer *old_fb)
  1296. {
  1297. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1298. struct drm_device *dev = crtc->dev;
  1299. struct radeon_device *rdev = dev->dev_private;
  1300. struct drm_encoder *encoder;
  1301. bool is_tvcv = false;
  1302. list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
  1303. /* find tv std */
  1304. if (encoder->crtc == crtc) {
  1305. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  1306. if (radeon_encoder->active_device &
  1307. (ATOM_DEVICE_TV_SUPPORT | ATOM_DEVICE_CV_SUPPORT))
  1308. is_tvcv = true;
  1309. }
  1310. }
  1311. /* always set DCPLL */
  1312. if (ASIC_IS_DCE4(rdev)) {
  1313. struct radeon_atom_ss ss;
  1314. bool ss_enabled = radeon_atombios_get_asic_ss_info(rdev, &ss,
  1315. ASIC_INTERNAL_SS_ON_DCPLL,
  1316. rdev->clock.default_dispclk);
  1317. if (ss_enabled)
  1318. atombios_crtc_program_ss(crtc, ATOM_DISABLE, ATOM_DCPLL, &ss);
  1319. /* XXX: DCE5, make sure voltage, dispclk is high enough */
  1320. atombios_crtc_set_dcpll(crtc, rdev->clock.default_dispclk);
  1321. if (ss_enabled)
  1322. atombios_crtc_program_ss(crtc, ATOM_ENABLE, ATOM_DCPLL, &ss);
  1323. }
  1324. atombios_crtc_set_pll(crtc, adjusted_mode);
  1325. if (ASIC_IS_DCE4(rdev))
  1326. atombios_set_crtc_dtd_timing(crtc, adjusted_mode);
  1327. else if (ASIC_IS_AVIVO(rdev)) {
  1328. if (is_tvcv)
  1329. atombios_crtc_set_timing(crtc, adjusted_mode);
  1330. else
  1331. atombios_set_crtc_dtd_timing(crtc, adjusted_mode);
  1332. } else {
  1333. atombios_crtc_set_timing(crtc, adjusted_mode);
  1334. if (radeon_crtc->crtc_id == 0)
  1335. atombios_set_crtc_dtd_timing(crtc, adjusted_mode);
  1336. radeon_legacy_atom_fixup(crtc);
  1337. }
  1338. atombios_crtc_set_base(crtc, x, y, old_fb);
  1339. atombios_overscan_setup(crtc, mode, adjusted_mode);
  1340. atombios_scaler_setup(crtc);
  1341. return 0;
  1342. }
  1343. static bool atombios_crtc_mode_fixup(struct drm_crtc *crtc,
  1344. struct drm_display_mode *mode,
  1345. struct drm_display_mode *adjusted_mode)
  1346. {
  1347. struct drm_device *dev = crtc->dev;
  1348. struct radeon_device *rdev = dev->dev_private;
  1349. /* adjust pm to upcoming mode change */
  1350. radeon_pm_compute_clocks(rdev);
  1351. if (!radeon_crtc_scaling_mode_fixup(crtc, mode, adjusted_mode))
  1352. return false;
  1353. return true;
  1354. }
  1355. static void atombios_crtc_prepare(struct drm_crtc *crtc)
  1356. {
  1357. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1358. /* pick pll */
  1359. radeon_crtc->pll_id = radeon_atom_pick_pll(crtc);
  1360. atombios_lock_crtc(crtc, ATOM_ENABLE);
  1361. atombios_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  1362. }
  1363. static void atombios_crtc_commit(struct drm_crtc *crtc)
  1364. {
  1365. atombios_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  1366. atombios_lock_crtc(crtc, ATOM_DISABLE);
  1367. }
  1368. static void atombios_crtc_disable(struct drm_crtc *crtc)
  1369. {
  1370. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1371. atombios_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  1372. switch (radeon_crtc->pll_id) {
  1373. case ATOM_PPLL1:
  1374. case ATOM_PPLL2:
  1375. /* disable the ppll */
  1376. atombios_crtc_program_pll(crtc, radeon_crtc->crtc_id, radeon_crtc->pll_id,
  1377. 0, 0, ATOM_DISABLE, 0, 0, 0, 0);
  1378. break;
  1379. default:
  1380. break;
  1381. }
  1382. radeon_crtc->pll_id = -1;
  1383. }
  1384. static const struct drm_crtc_helper_funcs atombios_helper_funcs = {
  1385. .dpms = atombios_crtc_dpms,
  1386. .mode_fixup = atombios_crtc_mode_fixup,
  1387. .mode_set = atombios_crtc_mode_set,
  1388. .mode_set_base = atombios_crtc_set_base,
  1389. .mode_set_base_atomic = atombios_crtc_set_base_atomic,
  1390. .prepare = atombios_crtc_prepare,
  1391. .commit = atombios_crtc_commit,
  1392. .load_lut = radeon_crtc_load_lut,
  1393. .disable = atombios_crtc_disable,
  1394. };
  1395. void radeon_atombios_init_crtc(struct drm_device *dev,
  1396. struct radeon_crtc *radeon_crtc)
  1397. {
  1398. struct radeon_device *rdev = dev->dev_private;
  1399. if (ASIC_IS_DCE4(rdev)) {
  1400. switch (radeon_crtc->crtc_id) {
  1401. case 0:
  1402. default:
  1403. radeon_crtc->crtc_offset = EVERGREEN_CRTC0_REGISTER_OFFSET;
  1404. break;
  1405. case 1:
  1406. radeon_crtc->crtc_offset = EVERGREEN_CRTC1_REGISTER_OFFSET;
  1407. break;
  1408. case 2:
  1409. radeon_crtc->crtc_offset = EVERGREEN_CRTC2_REGISTER_OFFSET;
  1410. break;
  1411. case 3:
  1412. radeon_crtc->crtc_offset = EVERGREEN_CRTC3_REGISTER_OFFSET;
  1413. break;
  1414. case 4:
  1415. radeon_crtc->crtc_offset = EVERGREEN_CRTC4_REGISTER_OFFSET;
  1416. break;
  1417. case 5:
  1418. radeon_crtc->crtc_offset = EVERGREEN_CRTC5_REGISTER_OFFSET;
  1419. break;
  1420. }
  1421. } else {
  1422. if (radeon_crtc->crtc_id == 1)
  1423. radeon_crtc->crtc_offset =
  1424. AVIVO_D2CRTC_H_TOTAL - AVIVO_D1CRTC_H_TOTAL;
  1425. else
  1426. radeon_crtc->crtc_offset = 0;
  1427. }
  1428. radeon_crtc->pll_id = -1;
  1429. drm_crtc_helper_add(&radeon_crtc->base, &atombios_helper_funcs);
  1430. }