radeon_legacy_encoders.c 51 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667
  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 "drmP.h"
  27. #include "drm_crtc_helper.h"
  28. #include "radeon_drm.h"
  29. #include "radeon.h"
  30. #include "atom.h"
  31. #include <linux/backlight.h>
  32. #ifdef CONFIG_PMAC_BACKLIGHT
  33. #include <asm/backlight.h>
  34. #endif
  35. static void radeon_legacy_encoder_disable(struct drm_encoder *encoder)
  36. {
  37. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  38. struct drm_encoder_helper_funcs *encoder_funcs;
  39. encoder_funcs = encoder->helper_private;
  40. encoder_funcs->dpms(encoder, DRM_MODE_DPMS_OFF);
  41. radeon_encoder->active_device = 0;
  42. }
  43. static void radeon_legacy_lvds_update(struct drm_encoder *encoder, int mode)
  44. {
  45. struct drm_device *dev = encoder->dev;
  46. struct radeon_device *rdev = dev->dev_private;
  47. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  48. uint32_t lvds_gen_cntl, lvds_pll_cntl, pixclks_cntl, disp_pwr_man;
  49. int panel_pwr_delay = 2000;
  50. bool is_mac = false;
  51. uint8_t backlight_level;
  52. DRM_DEBUG_KMS("\n");
  53. lvds_gen_cntl = RREG32(RADEON_LVDS_GEN_CNTL);
  54. backlight_level = (lvds_gen_cntl >> RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
  55. if (radeon_encoder->enc_priv) {
  56. if (rdev->is_atom_bios) {
  57. struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
  58. panel_pwr_delay = lvds->panel_pwr_delay;
  59. if (lvds->bl_dev)
  60. backlight_level = lvds->backlight_level;
  61. } else {
  62. struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
  63. panel_pwr_delay = lvds->panel_pwr_delay;
  64. if (lvds->bl_dev)
  65. backlight_level = lvds->backlight_level;
  66. }
  67. }
  68. /* macs (and possibly some x86 oem systems?) wire up LVDS strangely
  69. * Taken from radeonfb.
  70. */
  71. if ((rdev->mode_info.connector_table == CT_IBOOK) ||
  72. (rdev->mode_info.connector_table == CT_POWERBOOK_EXTERNAL) ||
  73. (rdev->mode_info.connector_table == CT_POWERBOOK_INTERNAL) ||
  74. (rdev->mode_info.connector_table == CT_POWERBOOK_VGA))
  75. is_mac = true;
  76. switch (mode) {
  77. case DRM_MODE_DPMS_ON:
  78. disp_pwr_man = RREG32(RADEON_DISP_PWR_MAN);
  79. disp_pwr_man |= RADEON_AUTO_PWRUP_EN;
  80. WREG32(RADEON_DISP_PWR_MAN, disp_pwr_man);
  81. lvds_pll_cntl = RREG32(RADEON_LVDS_PLL_CNTL);
  82. lvds_pll_cntl |= RADEON_LVDS_PLL_EN;
  83. WREG32(RADEON_LVDS_PLL_CNTL, lvds_pll_cntl);
  84. mdelay(1);
  85. lvds_pll_cntl = RREG32(RADEON_LVDS_PLL_CNTL);
  86. lvds_pll_cntl &= ~RADEON_LVDS_PLL_RESET;
  87. WREG32(RADEON_LVDS_PLL_CNTL, lvds_pll_cntl);
  88. lvds_gen_cntl &= ~(RADEON_LVDS_DISPLAY_DIS |
  89. RADEON_LVDS_BL_MOD_LEVEL_MASK);
  90. lvds_gen_cntl |= (RADEON_LVDS_ON | RADEON_LVDS_EN |
  91. RADEON_LVDS_DIGON | RADEON_LVDS_BLON |
  92. (backlight_level << RADEON_LVDS_BL_MOD_LEVEL_SHIFT));
  93. if (is_mac)
  94. lvds_gen_cntl |= RADEON_LVDS_BL_MOD_EN;
  95. mdelay(panel_pwr_delay);
  96. WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
  97. break;
  98. case DRM_MODE_DPMS_STANDBY:
  99. case DRM_MODE_DPMS_SUSPEND:
  100. case DRM_MODE_DPMS_OFF:
  101. pixclks_cntl = RREG32_PLL(RADEON_PIXCLKS_CNTL);
  102. WREG32_PLL_P(RADEON_PIXCLKS_CNTL, 0, ~RADEON_PIXCLK_LVDS_ALWAYS_ONb);
  103. lvds_gen_cntl |= RADEON_LVDS_DISPLAY_DIS;
  104. if (is_mac) {
  105. lvds_gen_cntl &= ~RADEON_LVDS_BL_MOD_EN;
  106. WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
  107. lvds_gen_cntl &= ~(RADEON_LVDS_ON | RADEON_LVDS_EN);
  108. } else {
  109. WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
  110. lvds_gen_cntl &= ~(RADEON_LVDS_ON | RADEON_LVDS_BLON | RADEON_LVDS_EN | RADEON_LVDS_DIGON);
  111. }
  112. mdelay(panel_pwr_delay);
  113. WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
  114. WREG32_PLL(RADEON_PIXCLKS_CNTL, pixclks_cntl);
  115. mdelay(panel_pwr_delay);
  116. break;
  117. }
  118. if (rdev->is_atom_bios)
  119. radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  120. else
  121. radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  122. }
  123. static void radeon_legacy_lvds_dpms(struct drm_encoder *encoder, int mode)
  124. {
  125. struct radeon_device *rdev = encoder->dev->dev_private;
  126. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  127. DRM_DEBUG("\n");
  128. if (radeon_encoder->enc_priv) {
  129. if (rdev->is_atom_bios) {
  130. struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
  131. lvds->dpms_mode = mode;
  132. } else {
  133. struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
  134. lvds->dpms_mode = mode;
  135. }
  136. }
  137. radeon_legacy_lvds_update(encoder, mode);
  138. }
  139. static void radeon_legacy_lvds_prepare(struct drm_encoder *encoder)
  140. {
  141. struct radeon_device *rdev = encoder->dev->dev_private;
  142. if (rdev->is_atom_bios)
  143. radeon_atom_output_lock(encoder, true);
  144. else
  145. radeon_combios_output_lock(encoder, true);
  146. radeon_legacy_lvds_dpms(encoder, DRM_MODE_DPMS_OFF);
  147. }
  148. static void radeon_legacy_lvds_commit(struct drm_encoder *encoder)
  149. {
  150. struct radeon_device *rdev = encoder->dev->dev_private;
  151. radeon_legacy_lvds_dpms(encoder, DRM_MODE_DPMS_ON);
  152. if (rdev->is_atom_bios)
  153. radeon_atom_output_lock(encoder, false);
  154. else
  155. radeon_combios_output_lock(encoder, false);
  156. }
  157. static void radeon_legacy_lvds_mode_set(struct drm_encoder *encoder,
  158. struct drm_display_mode *mode,
  159. struct drm_display_mode *adjusted_mode)
  160. {
  161. struct drm_device *dev = encoder->dev;
  162. struct radeon_device *rdev = dev->dev_private;
  163. struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
  164. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  165. uint32_t lvds_pll_cntl, lvds_gen_cntl, lvds_ss_gen_cntl;
  166. DRM_DEBUG_KMS("\n");
  167. lvds_pll_cntl = RREG32(RADEON_LVDS_PLL_CNTL);
  168. lvds_pll_cntl &= ~RADEON_LVDS_PLL_EN;
  169. lvds_ss_gen_cntl = RREG32(RADEON_LVDS_SS_GEN_CNTL);
  170. if (rdev->is_atom_bios) {
  171. /* LVDS_GEN_CNTL parameters are computed in LVDSEncoderControl
  172. * need to call that on resume to set up the reg properly.
  173. */
  174. radeon_encoder->pixel_clock = adjusted_mode->clock;
  175. atombios_digital_setup(encoder, PANEL_ENCODER_ACTION_ENABLE);
  176. lvds_gen_cntl = RREG32(RADEON_LVDS_GEN_CNTL);
  177. } else {
  178. struct radeon_encoder_lvds *lvds = (struct radeon_encoder_lvds *)radeon_encoder->enc_priv;
  179. if (lvds) {
  180. DRM_DEBUG_KMS("bios LVDS_GEN_CNTL: 0x%x\n", lvds->lvds_gen_cntl);
  181. lvds_gen_cntl = lvds->lvds_gen_cntl;
  182. lvds_ss_gen_cntl &= ~((0xf << RADEON_LVDS_PWRSEQ_DELAY1_SHIFT) |
  183. (0xf << RADEON_LVDS_PWRSEQ_DELAY2_SHIFT));
  184. lvds_ss_gen_cntl |= ((lvds->panel_digon_delay << RADEON_LVDS_PWRSEQ_DELAY1_SHIFT) |
  185. (lvds->panel_blon_delay << RADEON_LVDS_PWRSEQ_DELAY2_SHIFT));
  186. } else
  187. lvds_gen_cntl = RREG32(RADEON_LVDS_GEN_CNTL);
  188. }
  189. lvds_gen_cntl |= RADEON_LVDS_DISPLAY_DIS;
  190. lvds_gen_cntl &= ~(RADEON_LVDS_ON |
  191. RADEON_LVDS_BLON |
  192. RADEON_LVDS_EN |
  193. RADEON_LVDS_RST_FM);
  194. if (ASIC_IS_R300(rdev))
  195. lvds_pll_cntl &= ~(R300_LVDS_SRC_SEL_MASK);
  196. if (radeon_crtc->crtc_id == 0) {
  197. if (ASIC_IS_R300(rdev)) {
  198. if (radeon_encoder->rmx_type != RMX_OFF)
  199. lvds_pll_cntl |= R300_LVDS_SRC_SEL_RMX;
  200. } else
  201. lvds_gen_cntl &= ~RADEON_LVDS_SEL_CRTC2;
  202. } else {
  203. if (ASIC_IS_R300(rdev))
  204. lvds_pll_cntl |= R300_LVDS_SRC_SEL_CRTC2;
  205. else
  206. lvds_gen_cntl |= RADEON_LVDS_SEL_CRTC2;
  207. }
  208. WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
  209. WREG32(RADEON_LVDS_PLL_CNTL, lvds_pll_cntl);
  210. WREG32(RADEON_LVDS_SS_GEN_CNTL, lvds_ss_gen_cntl);
  211. if (rdev->family == CHIP_RV410)
  212. WREG32(RADEON_CLOCK_CNTL_INDEX, 0);
  213. if (rdev->is_atom_bios)
  214. radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  215. else
  216. radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  217. }
  218. static bool radeon_legacy_mode_fixup(struct drm_encoder *encoder,
  219. struct drm_display_mode *mode,
  220. struct drm_display_mode *adjusted_mode)
  221. {
  222. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  223. /* set the active encoder to connector routing */
  224. radeon_encoder_set_active_device(encoder);
  225. drm_mode_set_crtcinfo(adjusted_mode, 0);
  226. /* get the native mode for LVDS */
  227. if (radeon_encoder->active_device & (ATOM_DEVICE_LCD_SUPPORT))
  228. radeon_panel_mode_fixup(encoder, adjusted_mode);
  229. return true;
  230. }
  231. static const struct drm_encoder_helper_funcs radeon_legacy_lvds_helper_funcs = {
  232. .dpms = radeon_legacy_lvds_dpms,
  233. .mode_fixup = radeon_legacy_mode_fixup,
  234. .prepare = radeon_legacy_lvds_prepare,
  235. .mode_set = radeon_legacy_lvds_mode_set,
  236. .commit = radeon_legacy_lvds_commit,
  237. .disable = radeon_legacy_encoder_disable,
  238. };
  239. #if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) || defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)
  240. #define MAX_RADEON_LEVEL 0xFF
  241. struct radeon_backlight_privdata {
  242. struct radeon_encoder *encoder;
  243. uint8_t negative;
  244. };
  245. static uint8_t radeon_legacy_lvds_level(struct backlight_device *bd)
  246. {
  247. struct radeon_backlight_privdata *pdata = bl_get_data(bd);
  248. uint8_t level;
  249. /* Convert brightness to hardware level */
  250. if (bd->props.brightness < 0)
  251. level = 0;
  252. else if (bd->props.brightness > MAX_RADEON_LEVEL)
  253. level = MAX_RADEON_LEVEL;
  254. else
  255. level = bd->props.brightness;
  256. if (pdata->negative)
  257. level = MAX_RADEON_LEVEL - level;
  258. return level;
  259. }
  260. static int radeon_legacy_backlight_update_status(struct backlight_device *bd)
  261. {
  262. struct radeon_backlight_privdata *pdata = bl_get_data(bd);
  263. struct radeon_encoder *radeon_encoder = pdata->encoder;
  264. struct drm_device *dev = radeon_encoder->base.dev;
  265. struct radeon_device *rdev = dev->dev_private;
  266. int dpms_mode = DRM_MODE_DPMS_ON;
  267. if (radeon_encoder->enc_priv) {
  268. if (rdev->is_atom_bios) {
  269. struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
  270. dpms_mode = lvds->dpms_mode;
  271. lvds->backlight_level = radeon_legacy_lvds_level(bd);
  272. } else {
  273. struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
  274. dpms_mode = lvds->dpms_mode;
  275. lvds->backlight_level = radeon_legacy_lvds_level(bd);
  276. }
  277. }
  278. if (bd->props.brightness > 0)
  279. radeon_legacy_lvds_update(&radeon_encoder->base, dpms_mode);
  280. else
  281. radeon_legacy_lvds_update(&radeon_encoder->base, DRM_MODE_DPMS_OFF);
  282. return 0;
  283. }
  284. static int radeon_legacy_backlight_get_brightness(struct backlight_device *bd)
  285. {
  286. struct radeon_backlight_privdata *pdata = bl_get_data(bd);
  287. struct radeon_encoder *radeon_encoder = pdata->encoder;
  288. struct drm_device *dev = radeon_encoder->base.dev;
  289. struct radeon_device *rdev = dev->dev_private;
  290. uint8_t backlight_level;
  291. backlight_level = (RREG32(RADEON_LVDS_GEN_CNTL) >>
  292. RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
  293. return pdata->negative ? MAX_RADEON_LEVEL - backlight_level : backlight_level;
  294. }
  295. static const struct backlight_ops radeon_backlight_ops = {
  296. .get_brightness = radeon_legacy_backlight_get_brightness,
  297. .update_status = radeon_legacy_backlight_update_status,
  298. };
  299. void radeon_legacy_backlight_init(struct radeon_encoder *radeon_encoder,
  300. struct drm_connector *drm_connector)
  301. {
  302. struct drm_device *dev = radeon_encoder->base.dev;
  303. struct radeon_device *rdev = dev->dev_private;
  304. struct backlight_device *bd;
  305. struct backlight_properties props;
  306. struct radeon_backlight_privdata *pdata;
  307. uint8_t backlight_level;
  308. if (!radeon_encoder->enc_priv)
  309. return;
  310. #ifdef CONFIG_PMAC_BACKLIGHT
  311. if (!pmac_has_backlight_type("ati") &&
  312. !pmac_has_backlight_type("mnca"))
  313. return;
  314. #endif
  315. pdata = kmalloc(sizeof(struct radeon_backlight_privdata), GFP_KERNEL);
  316. if (!pdata) {
  317. DRM_ERROR("Memory allocation failed\n");
  318. goto error;
  319. }
  320. memset(&props, 0, sizeof(props));
  321. props.max_brightness = MAX_RADEON_LEVEL;
  322. props.type = BACKLIGHT_RAW;
  323. bd = backlight_device_register("radeon_bl", &drm_connector->kdev,
  324. pdata, &radeon_backlight_ops, &props);
  325. if (IS_ERR(bd)) {
  326. DRM_ERROR("Backlight registration failed\n");
  327. goto error;
  328. }
  329. pdata->encoder = radeon_encoder;
  330. backlight_level = (RREG32(RADEON_LVDS_GEN_CNTL) >>
  331. RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
  332. /* First, try to detect backlight level sense based on the assumption
  333. * that firmware set it up at full brightness
  334. */
  335. if (backlight_level == 0)
  336. pdata->negative = true;
  337. else if (backlight_level == 0xff)
  338. pdata->negative = false;
  339. else {
  340. /* XXX hack... maybe some day we can figure out in what direction
  341. * backlight should work on a given panel?
  342. */
  343. pdata->negative = (rdev->family != CHIP_RV200 &&
  344. rdev->family != CHIP_RV250 &&
  345. rdev->family != CHIP_RV280 &&
  346. rdev->family != CHIP_RV350);
  347. #ifdef CONFIG_PMAC_BACKLIGHT
  348. pdata->negative = (pdata->negative ||
  349. of_machine_is_compatible("PowerBook4,3") ||
  350. of_machine_is_compatible("PowerBook6,3") ||
  351. of_machine_is_compatible("PowerBook6,5"));
  352. #endif
  353. }
  354. if (rdev->is_atom_bios) {
  355. struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
  356. lvds->bl_dev = bd;
  357. } else {
  358. struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
  359. lvds->bl_dev = bd;
  360. }
  361. bd->props.brightness = radeon_legacy_backlight_get_brightness(bd);
  362. bd->props.power = FB_BLANK_UNBLANK;
  363. backlight_update_status(bd);
  364. DRM_INFO("radeon legacy LVDS backlight initialized\n");
  365. return;
  366. error:
  367. kfree(pdata);
  368. return;
  369. }
  370. static void radeon_legacy_backlight_exit(struct radeon_encoder *radeon_encoder)
  371. {
  372. struct drm_device *dev = radeon_encoder->base.dev;
  373. struct radeon_device *rdev = dev->dev_private;
  374. struct backlight_device *bd = NULL;
  375. if (!radeon_encoder->enc_priv)
  376. return;
  377. if (rdev->is_atom_bios) {
  378. struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
  379. bd = lvds->bl_dev;
  380. lvds->bl_dev = NULL;
  381. } else {
  382. struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
  383. bd = lvds->bl_dev;
  384. lvds->bl_dev = NULL;
  385. }
  386. if (bd) {
  387. struct radeon_legacy_backlight_privdata *pdata;
  388. pdata = bl_get_data(bd);
  389. backlight_device_unregister(bd);
  390. kfree(pdata);
  391. DRM_INFO("radeon legacy LVDS backlight unloaded\n");
  392. }
  393. }
  394. #else /* !CONFIG_BACKLIGHT_CLASS_DEVICE */
  395. void radeon_legacy_backlight_init(struct radeon_encoder *encoder)
  396. {
  397. }
  398. static void radeon_legacy_backlight_exit(struct radeon_encoder *encoder)
  399. {
  400. }
  401. #endif
  402. static void radeon_lvds_enc_destroy(struct drm_encoder *encoder)
  403. {
  404. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  405. if (radeon_encoder->enc_priv) {
  406. radeon_legacy_backlight_exit(radeon_encoder);
  407. kfree(radeon_encoder->enc_priv);
  408. }
  409. drm_encoder_cleanup(encoder);
  410. kfree(radeon_encoder);
  411. }
  412. static const struct drm_encoder_funcs radeon_legacy_lvds_enc_funcs = {
  413. .destroy = radeon_lvds_enc_destroy,
  414. };
  415. static void radeon_legacy_primary_dac_dpms(struct drm_encoder *encoder, int mode)
  416. {
  417. struct drm_device *dev = encoder->dev;
  418. struct radeon_device *rdev = dev->dev_private;
  419. uint32_t crtc_ext_cntl = RREG32(RADEON_CRTC_EXT_CNTL);
  420. uint32_t dac_cntl = RREG32(RADEON_DAC_CNTL);
  421. uint32_t dac_macro_cntl = RREG32(RADEON_DAC_MACRO_CNTL);
  422. DRM_DEBUG_KMS("\n");
  423. switch (mode) {
  424. case DRM_MODE_DPMS_ON:
  425. crtc_ext_cntl |= RADEON_CRTC_CRT_ON;
  426. dac_cntl &= ~RADEON_DAC_PDWN;
  427. dac_macro_cntl &= ~(RADEON_DAC_PDWN_R |
  428. RADEON_DAC_PDWN_G |
  429. RADEON_DAC_PDWN_B);
  430. break;
  431. case DRM_MODE_DPMS_STANDBY:
  432. case DRM_MODE_DPMS_SUSPEND:
  433. case DRM_MODE_DPMS_OFF:
  434. crtc_ext_cntl &= ~RADEON_CRTC_CRT_ON;
  435. dac_cntl |= RADEON_DAC_PDWN;
  436. dac_macro_cntl |= (RADEON_DAC_PDWN_R |
  437. RADEON_DAC_PDWN_G |
  438. RADEON_DAC_PDWN_B);
  439. break;
  440. }
  441. WREG32(RADEON_CRTC_EXT_CNTL, crtc_ext_cntl);
  442. WREG32(RADEON_DAC_CNTL, dac_cntl);
  443. WREG32(RADEON_DAC_MACRO_CNTL, dac_macro_cntl);
  444. if (rdev->is_atom_bios)
  445. radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  446. else
  447. radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  448. }
  449. static void radeon_legacy_primary_dac_prepare(struct drm_encoder *encoder)
  450. {
  451. struct radeon_device *rdev = encoder->dev->dev_private;
  452. if (rdev->is_atom_bios)
  453. radeon_atom_output_lock(encoder, true);
  454. else
  455. radeon_combios_output_lock(encoder, true);
  456. radeon_legacy_primary_dac_dpms(encoder, DRM_MODE_DPMS_OFF);
  457. }
  458. static void radeon_legacy_primary_dac_commit(struct drm_encoder *encoder)
  459. {
  460. struct radeon_device *rdev = encoder->dev->dev_private;
  461. radeon_legacy_primary_dac_dpms(encoder, DRM_MODE_DPMS_ON);
  462. if (rdev->is_atom_bios)
  463. radeon_atom_output_lock(encoder, false);
  464. else
  465. radeon_combios_output_lock(encoder, false);
  466. }
  467. static void radeon_legacy_primary_dac_mode_set(struct drm_encoder *encoder,
  468. struct drm_display_mode *mode,
  469. struct drm_display_mode *adjusted_mode)
  470. {
  471. struct drm_device *dev = encoder->dev;
  472. struct radeon_device *rdev = dev->dev_private;
  473. struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
  474. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  475. uint32_t disp_output_cntl, dac_cntl, dac2_cntl, dac_macro_cntl;
  476. DRM_DEBUG_KMS("\n");
  477. if (radeon_crtc->crtc_id == 0) {
  478. if (rdev->family == CHIP_R200 || ASIC_IS_R300(rdev)) {
  479. disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL) &
  480. ~(RADEON_DISP_DAC_SOURCE_MASK);
  481. WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
  482. } else {
  483. dac2_cntl = RREG32(RADEON_DAC_CNTL2) & ~(RADEON_DAC2_DAC_CLK_SEL);
  484. WREG32(RADEON_DAC_CNTL2, dac2_cntl);
  485. }
  486. } else {
  487. if (rdev->family == CHIP_R200 || ASIC_IS_R300(rdev)) {
  488. disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL) &
  489. ~(RADEON_DISP_DAC_SOURCE_MASK);
  490. disp_output_cntl |= RADEON_DISP_DAC_SOURCE_CRTC2;
  491. WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
  492. } else {
  493. dac2_cntl = RREG32(RADEON_DAC_CNTL2) | RADEON_DAC2_DAC_CLK_SEL;
  494. WREG32(RADEON_DAC_CNTL2, dac2_cntl);
  495. }
  496. }
  497. dac_cntl = (RADEON_DAC_MASK_ALL |
  498. RADEON_DAC_VGA_ADR_EN |
  499. /* TODO 6-bits */
  500. RADEON_DAC_8BIT_EN);
  501. WREG32_P(RADEON_DAC_CNTL,
  502. dac_cntl,
  503. RADEON_DAC_RANGE_CNTL |
  504. RADEON_DAC_BLANKING);
  505. if (radeon_encoder->enc_priv) {
  506. struct radeon_encoder_primary_dac *p_dac = (struct radeon_encoder_primary_dac *)radeon_encoder->enc_priv;
  507. dac_macro_cntl = p_dac->ps2_pdac_adj;
  508. } else
  509. dac_macro_cntl = RREG32(RADEON_DAC_MACRO_CNTL);
  510. dac_macro_cntl |= RADEON_DAC_PDWN_R | RADEON_DAC_PDWN_G | RADEON_DAC_PDWN_B;
  511. WREG32(RADEON_DAC_MACRO_CNTL, dac_macro_cntl);
  512. if (rdev->is_atom_bios)
  513. radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  514. else
  515. radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  516. }
  517. static enum drm_connector_status radeon_legacy_primary_dac_detect(struct drm_encoder *encoder,
  518. struct drm_connector *connector)
  519. {
  520. struct drm_device *dev = encoder->dev;
  521. struct radeon_device *rdev = dev->dev_private;
  522. uint32_t vclk_ecp_cntl, crtc_ext_cntl;
  523. uint32_t dac_ext_cntl, dac_cntl, dac_macro_cntl, tmp;
  524. enum drm_connector_status found = connector_status_disconnected;
  525. bool color = true;
  526. /* save the regs we need */
  527. vclk_ecp_cntl = RREG32_PLL(RADEON_VCLK_ECP_CNTL);
  528. crtc_ext_cntl = RREG32(RADEON_CRTC_EXT_CNTL);
  529. dac_ext_cntl = RREG32(RADEON_DAC_EXT_CNTL);
  530. dac_cntl = RREG32(RADEON_DAC_CNTL);
  531. dac_macro_cntl = RREG32(RADEON_DAC_MACRO_CNTL);
  532. tmp = vclk_ecp_cntl &
  533. ~(RADEON_PIXCLK_ALWAYS_ONb | RADEON_PIXCLK_DAC_ALWAYS_ONb);
  534. WREG32_PLL(RADEON_VCLK_ECP_CNTL, tmp);
  535. tmp = crtc_ext_cntl | RADEON_CRTC_CRT_ON;
  536. WREG32(RADEON_CRTC_EXT_CNTL, tmp);
  537. tmp = RADEON_DAC_FORCE_BLANK_OFF_EN |
  538. RADEON_DAC_FORCE_DATA_EN;
  539. if (color)
  540. tmp |= RADEON_DAC_FORCE_DATA_SEL_RGB;
  541. else
  542. tmp |= RADEON_DAC_FORCE_DATA_SEL_G;
  543. if (ASIC_IS_R300(rdev))
  544. tmp |= (0x1b6 << RADEON_DAC_FORCE_DATA_SHIFT);
  545. else
  546. tmp |= (0x180 << RADEON_DAC_FORCE_DATA_SHIFT);
  547. WREG32(RADEON_DAC_EXT_CNTL, tmp);
  548. tmp = dac_cntl & ~(RADEON_DAC_RANGE_CNTL_MASK | RADEON_DAC_PDWN);
  549. tmp |= RADEON_DAC_RANGE_CNTL_PS2 | RADEON_DAC_CMP_EN;
  550. WREG32(RADEON_DAC_CNTL, tmp);
  551. tmp &= ~(RADEON_DAC_PDWN_R |
  552. RADEON_DAC_PDWN_G |
  553. RADEON_DAC_PDWN_B);
  554. WREG32(RADEON_DAC_MACRO_CNTL, tmp);
  555. mdelay(2);
  556. if (RREG32(RADEON_DAC_CNTL) & RADEON_DAC_CMP_OUTPUT)
  557. found = connector_status_connected;
  558. /* restore the regs we used */
  559. WREG32(RADEON_DAC_CNTL, dac_cntl);
  560. WREG32(RADEON_DAC_MACRO_CNTL, dac_macro_cntl);
  561. WREG32(RADEON_DAC_EXT_CNTL, dac_ext_cntl);
  562. WREG32(RADEON_CRTC_EXT_CNTL, crtc_ext_cntl);
  563. WREG32_PLL(RADEON_VCLK_ECP_CNTL, vclk_ecp_cntl);
  564. return found;
  565. }
  566. static const struct drm_encoder_helper_funcs radeon_legacy_primary_dac_helper_funcs = {
  567. .dpms = radeon_legacy_primary_dac_dpms,
  568. .mode_fixup = radeon_legacy_mode_fixup,
  569. .prepare = radeon_legacy_primary_dac_prepare,
  570. .mode_set = radeon_legacy_primary_dac_mode_set,
  571. .commit = radeon_legacy_primary_dac_commit,
  572. .detect = radeon_legacy_primary_dac_detect,
  573. .disable = radeon_legacy_encoder_disable,
  574. };
  575. static const struct drm_encoder_funcs radeon_legacy_primary_dac_enc_funcs = {
  576. .destroy = radeon_enc_destroy,
  577. };
  578. static void radeon_legacy_tmds_int_dpms(struct drm_encoder *encoder, int mode)
  579. {
  580. struct drm_device *dev = encoder->dev;
  581. struct radeon_device *rdev = dev->dev_private;
  582. uint32_t fp_gen_cntl = RREG32(RADEON_FP_GEN_CNTL);
  583. DRM_DEBUG_KMS("\n");
  584. switch (mode) {
  585. case DRM_MODE_DPMS_ON:
  586. fp_gen_cntl |= (RADEON_FP_FPON | RADEON_FP_TMDS_EN);
  587. break;
  588. case DRM_MODE_DPMS_STANDBY:
  589. case DRM_MODE_DPMS_SUSPEND:
  590. case DRM_MODE_DPMS_OFF:
  591. fp_gen_cntl &= ~(RADEON_FP_FPON | RADEON_FP_TMDS_EN);
  592. break;
  593. }
  594. WREG32(RADEON_FP_GEN_CNTL, fp_gen_cntl);
  595. if (rdev->is_atom_bios)
  596. radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  597. else
  598. radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  599. }
  600. static void radeon_legacy_tmds_int_prepare(struct drm_encoder *encoder)
  601. {
  602. struct radeon_device *rdev = encoder->dev->dev_private;
  603. if (rdev->is_atom_bios)
  604. radeon_atom_output_lock(encoder, true);
  605. else
  606. radeon_combios_output_lock(encoder, true);
  607. radeon_legacy_tmds_int_dpms(encoder, DRM_MODE_DPMS_OFF);
  608. }
  609. static void radeon_legacy_tmds_int_commit(struct drm_encoder *encoder)
  610. {
  611. struct radeon_device *rdev = encoder->dev->dev_private;
  612. radeon_legacy_tmds_int_dpms(encoder, DRM_MODE_DPMS_ON);
  613. if (rdev->is_atom_bios)
  614. radeon_atom_output_lock(encoder, true);
  615. else
  616. radeon_combios_output_lock(encoder, true);
  617. }
  618. static void radeon_legacy_tmds_int_mode_set(struct drm_encoder *encoder,
  619. struct drm_display_mode *mode,
  620. struct drm_display_mode *adjusted_mode)
  621. {
  622. struct drm_device *dev = encoder->dev;
  623. struct radeon_device *rdev = dev->dev_private;
  624. struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
  625. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  626. uint32_t tmp, tmds_pll_cntl, tmds_transmitter_cntl, fp_gen_cntl;
  627. int i;
  628. DRM_DEBUG_KMS("\n");
  629. tmp = tmds_pll_cntl = RREG32(RADEON_TMDS_PLL_CNTL);
  630. tmp &= 0xfffff;
  631. if (rdev->family == CHIP_RV280) {
  632. /* bit 22 of TMDS_PLL_CNTL is read-back inverted */
  633. tmp ^= (1 << 22);
  634. tmds_pll_cntl ^= (1 << 22);
  635. }
  636. if (radeon_encoder->enc_priv) {
  637. struct radeon_encoder_int_tmds *tmds = (struct radeon_encoder_int_tmds *)radeon_encoder->enc_priv;
  638. for (i = 0; i < 4; i++) {
  639. if (tmds->tmds_pll[i].freq == 0)
  640. break;
  641. if ((uint32_t)(mode->clock / 10) < tmds->tmds_pll[i].freq) {
  642. tmp = tmds->tmds_pll[i].value ;
  643. break;
  644. }
  645. }
  646. }
  647. if (ASIC_IS_R300(rdev) || (rdev->family == CHIP_RV280)) {
  648. if (tmp & 0xfff00000)
  649. tmds_pll_cntl = tmp;
  650. else {
  651. tmds_pll_cntl &= 0xfff00000;
  652. tmds_pll_cntl |= tmp;
  653. }
  654. } else
  655. tmds_pll_cntl = tmp;
  656. tmds_transmitter_cntl = RREG32(RADEON_TMDS_TRANSMITTER_CNTL) &
  657. ~(RADEON_TMDS_TRANSMITTER_PLLRST);
  658. if (rdev->family == CHIP_R200 ||
  659. rdev->family == CHIP_R100 ||
  660. ASIC_IS_R300(rdev))
  661. tmds_transmitter_cntl &= ~(RADEON_TMDS_TRANSMITTER_PLLEN);
  662. else /* RV chips got this bit reversed */
  663. tmds_transmitter_cntl |= RADEON_TMDS_TRANSMITTER_PLLEN;
  664. fp_gen_cntl = (RREG32(RADEON_FP_GEN_CNTL) |
  665. (RADEON_FP_CRTC_DONT_SHADOW_VPAR |
  666. RADEON_FP_CRTC_DONT_SHADOW_HEND));
  667. fp_gen_cntl &= ~(RADEON_FP_FPON | RADEON_FP_TMDS_EN);
  668. fp_gen_cntl &= ~(RADEON_FP_RMX_HVSYNC_CONTROL_EN |
  669. RADEON_FP_DFP_SYNC_SEL |
  670. RADEON_FP_CRT_SYNC_SEL |
  671. RADEON_FP_CRTC_LOCK_8DOT |
  672. RADEON_FP_USE_SHADOW_EN |
  673. RADEON_FP_CRTC_USE_SHADOW_VEND |
  674. RADEON_FP_CRT_SYNC_ALT);
  675. if (1) /* FIXME rgbBits == 8 */
  676. fp_gen_cntl |= RADEON_FP_PANEL_FORMAT; /* 24 bit format */
  677. else
  678. fp_gen_cntl &= ~RADEON_FP_PANEL_FORMAT;/* 18 bit format */
  679. if (radeon_crtc->crtc_id == 0) {
  680. if (ASIC_IS_R300(rdev) || rdev->family == CHIP_R200) {
  681. fp_gen_cntl &= ~R200_FP_SOURCE_SEL_MASK;
  682. if (radeon_encoder->rmx_type != RMX_OFF)
  683. fp_gen_cntl |= R200_FP_SOURCE_SEL_RMX;
  684. else
  685. fp_gen_cntl |= R200_FP_SOURCE_SEL_CRTC1;
  686. } else
  687. fp_gen_cntl &= ~RADEON_FP_SEL_CRTC2;
  688. } else {
  689. if (ASIC_IS_R300(rdev) || rdev->family == CHIP_R200) {
  690. fp_gen_cntl &= ~R200_FP_SOURCE_SEL_MASK;
  691. fp_gen_cntl |= R200_FP_SOURCE_SEL_CRTC2;
  692. } else
  693. fp_gen_cntl |= RADEON_FP_SEL_CRTC2;
  694. }
  695. WREG32(RADEON_TMDS_PLL_CNTL, tmds_pll_cntl);
  696. WREG32(RADEON_TMDS_TRANSMITTER_CNTL, tmds_transmitter_cntl);
  697. WREG32(RADEON_FP_GEN_CNTL, fp_gen_cntl);
  698. if (rdev->is_atom_bios)
  699. radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  700. else
  701. radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  702. }
  703. static const struct drm_encoder_helper_funcs radeon_legacy_tmds_int_helper_funcs = {
  704. .dpms = radeon_legacy_tmds_int_dpms,
  705. .mode_fixup = radeon_legacy_mode_fixup,
  706. .prepare = radeon_legacy_tmds_int_prepare,
  707. .mode_set = radeon_legacy_tmds_int_mode_set,
  708. .commit = radeon_legacy_tmds_int_commit,
  709. .disable = radeon_legacy_encoder_disable,
  710. };
  711. static const struct drm_encoder_funcs radeon_legacy_tmds_int_enc_funcs = {
  712. .destroy = radeon_enc_destroy,
  713. };
  714. static void radeon_legacy_tmds_ext_dpms(struct drm_encoder *encoder, int mode)
  715. {
  716. struct drm_device *dev = encoder->dev;
  717. struct radeon_device *rdev = dev->dev_private;
  718. uint32_t fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
  719. DRM_DEBUG_KMS("\n");
  720. switch (mode) {
  721. case DRM_MODE_DPMS_ON:
  722. fp2_gen_cntl &= ~RADEON_FP2_BLANK_EN;
  723. fp2_gen_cntl |= (RADEON_FP2_ON | RADEON_FP2_DVO_EN);
  724. break;
  725. case DRM_MODE_DPMS_STANDBY:
  726. case DRM_MODE_DPMS_SUSPEND:
  727. case DRM_MODE_DPMS_OFF:
  728. fp2_gen_cntl |= RADEON_FP2_BLANK_EN;
  729. fp2_gen_cntl &= ~(RADEON_FP2_ON | RADEON_FP2_DVO_EN);
  730. break;
  731. }
  732. WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
  733. if (rdev->is_atom_bios)
  734. radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  735. else
  736. radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  737. }
  738. static void radeon_legacy_tmds_ext_prepare(struct drm_encoder *encoder)
  739. {
  740. struct radeon_device *rdev = encoder->dev->dev_private;
  741. if (rdev->is_atom_bios)
  742. radeon_atom_output_lock(encoder, true);
  743. else
  744. radeon_combios_output_lock(encoder, true);
  745. radeon_legacy_tmds_ext_dpms(encoder, DRM_MODE_DPMS_OFF);
  746. }
  747. static void radeon_legacy_tmds_ext_commit(struct drm_encoder *encoder)
  748. {
  749. struct radeon_device *rdev = encoder->dev->dev_private;
  750. radeon_legacy_tmds_ext_dpms(encoder, DRM_MODE_DPMS_ON);
  751. if (rdev->is_atom_bios)
  752. radeon_atom_output_lock(encoder, false);
  753. else
  754. radeon_combios_output_lock(encoder, false);
  755. }
  756. static void radeon_legacy_tmds_ext_mode_set(struct drm_encoder *encoder,
  757. struct drm_display_mode *mode,
  758. struct drm_display_mode *adjusted_mode)
  759. {
  760. struct drm_device *dev = encoder->dev;
  761. struct radeon_device *rdev = dev->dev_private;
  762. struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
  763. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  764. uint32_t fp2_gen_cntl;
  765. DRM_DEBUG_KMS("\n");
  766. if (rdev->is_atom_bios) {
  767. radeon_encoder->pixel_clock = adjusted_mode->clock;
  768. atombios_dvo_setup(encoder, ATOM_ENABLE);
  769. fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
  770. } else {
  771. fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
  772. if (1) /* FIXME rgbBits == 8 */
  773. fp2_gen_cntl |= RADEON_FP2_PANEL_FORMAT; /* 24 bit format, */
  774. else
  775. fp2_gen_cntl &= ~RADEON_FP2_PANEL_FORMAT;/* 18 bit format, */
  776. fp2_gen_cntl &= ~(RADEON_FP2_ON |
  777. RADEON_FP2_DVO_EN |
  778. RADEON_FP2_DVO_RATE_SEL_SDR);
  779. /* XXX: these are oem specific */
  780. if (ASIC_IS_R300(rdev)) {
  781. if ((dev->pdev->device == 0x4850) &&
  782. (dev->pdev->subsystem_vendor == 0x1028) &&
  783. (dev->pdev->subsystem_device == 0x2001)) /* Dell Inspiron 8600 */
  784. fp2_gen_cntl |= R300_FP2_DVO_CLOCK_MODE_SINGLE;
  785. else
  786. fp2_gen_cntl |= RADEON_FP2_PAD_FLOP_EN | R300_FP2_DVO_CLOCK_MODE_SINGLE;
  787. /*if (mode->clock > 165000)
  788. fp2_gen_cntl |= R300_FP2_DVO_DUAL_CHANNEL_EN;*/
  789. }
  790. if (!radeon_combios_external_tmds_setup(encoder))
  791. radeon_external_tmds_setup(encoder);
  792. }
  793. if (radeon_crtc->crtc_id == 0) {
  794. if ((rdev->family == CHIP_R200) || ASIC_IS_R300(rdev)) {
  795. fp2_gen_cntl &= ~R200_FP2_SOURCE_SEL_MASK;
  796. if (radeon_encoder->rmx_type != RMX_OFF)
  797. fp2_gen_cntl |= R200_FP2_SOURCE_SEL_RMX;
  798. else
  799. fp2_gen_cntl |= R200_FP2_SOURCE_SEL_CRTC1;
  800. } else
  801. fp2_gen_cntl &= ~RADEON_FP2_SRC_SEL_CRTC2;
  802. } else {
  803. if ((rdev->family == CHIP_R200) || ASIC_IS_R300(rdev)) {
  804. fp2_gen_cntl &= ~R200_FP2_SOURCE_SEL_MASK;
  805. fp2_gen_cntl |= R200_FP2_SOURCE_SEL_CRTC2;
  806. } else
  807. fp2_gen_cntl |= RADEON_FP2_SRC_SEL_CRTC2;
  808. }
  809. WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
  810. if (rdev->is_atom_bios)
  811. radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  812. else
  813. radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  814. }
  815. static void radeon_ext_tmds_enc_destroy(struct drm_encoder *encoder)
  816. {
  817. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  818. struct radeon_encoder_ext_tmds *tmds = radeon_encoder->enc_priv;
  819. if (tmds) {
  820. if (tmds->i2c_bus)
  821. radeon_i2c_destroy(tmds->i2c_bus);
  822. }
  823. kfree(radeon_encoder->enc_priv);
  824. drm_encoder_cleanup(encoder);
  825. kfree(radeon_encoder);
  826. }
  827. static const struct drm_encoder_helper_funcs radeon_legacy_tmds_ext_helper_funcs = {
  828. .dpms = radeon_legacy_tmds_ext_dpms,
  829. .mode_fixup = radeon_legacy_mode_fixup,
  830. .prepare = radeon_legacy_tmds_ext_prepare,
  831. .mode_set = radeon_legacy_tmds_ext_mode_set,
  832. .commit = radeon_legacy_tmds_ext_commit,
  833. .disable = radeon_legacy_encoder_disable,
  834. };
  835. static const struct drm_encoder_funcs radeon_legacy_tmds_ext_enc_funcs = {
  836. .destroy = radeon_ext_tmds_enc_destroy,
  837. };
  838. static void radeon_legacy_tv_dac_dpms(struct drm_encoder *encoder, int mode)
  839. {
  840. struct drm_device *dev = encoder->dev;
  841. struct radeon_device *rdev = dev->dev_private;
  842. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  843. uint32_t fp2_gen_cntl = 0, crtc2_gen_cntl = 0, tv_dac_cntl = 0;
  844. uint32_t tv_master_cntl = 0;
  845. bool is_tv;
  846. DRM_DEBUG_KMS("\n");
  847. is_tv = radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT ? true : false;
  848. if (rdev->family == CHIP_R200)
  849. fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
  850. else {
  851. if (is_tv)
  852. tv_master_cntl = RREG32(RADEON_TV_MASTER_CNTL);
  853. else
  854. crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
  855. tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
  856. }
  857. switch (mode) {
  858. case DRM_MODE_DPMS_ON:
  859. if (rdev->family == CHIP_R200) {
  860. fp2_gen_cntl |= (RADEON_FP2_ON | RADEON_FP2_DVO_EN);
  861. } else {
  862. if (is_tv)
  863. tv_master_cntl |= RADEON_TV_ON;
  864. else
  865. crtc2_gen_cntl |= RADEON_CRTC2_CRT2_ON;
  866. if (rdev->family == CHIP_R420 ||
  867. rdev->family == CHIP_R423 ||
  868. rdev->family == CHIP_RV410)
  869. tv_dac_cntl &= ~(R420_TV_DAC_RDACPD |
  870. R420_TV_DAC_GDACPD |
  871. R420_TV_DAC_BDACPD |
  872. RADEON_TV_DAC_BGSLEEP);
  873. else
  874. tv_dac_cntl &= ~(RADEON_TV_DAC_RDACPD |
  875. RADEON_TV_DAC_GDACPD |
  876. RADEON_TV_DAC_BDACPD |
  877. RADEON_TV_DAC_BGSLEEP);
  878. }
  879. break;
  880. case DRM_MODE_DPMS_STANDBY:
  881. case DRM_MODE_DPMS_SUSPEND:
  882. case DRM_MODE_DPMS_OFF:
  883. if (rdev->family == CHIP_R200)
  884. fp2_gen_cntl &= ~(RADEON_FP2_ON | RADEON_FP2_DVO_EN);
  885. else {
  886. if (is_tv)
  887. tv_master_cntl &= ~RADEON_TV_ON;
  888. else
  889. crtc2_gen_cntl &= ~RADEON_CRTC2_CRT2_ON;
  890. if (rdev->family == CHIP_R420 ||
  891. rdev->family == CHIP_R423 ||
  892. rdev->family == CHIP_RV410)
  893. tv_dac_cntl |= (R420_TV_DAC_RDACPD |
  894. R420_TV_DAC_GDACPD |
  895. R420_TV_DAC_BDACPD |
  896. RADEON_TV_DAC_BGSLEEP);
  897. else
  898. tv_dac_cntl |= (RADEON_TV_DAC_RDACPD |
  899. RADEON_TV_DAC_GDACPD |
  900. RADEON_TV_DAC_BDACPD |
  901. RADEON_TV_DAC_BGSLEEP);
  902. }
  903. break;
  904. }
  905. if (rdev->family == CHIP_R200) {
  906. WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
  907. } else {
  908. if (is_tv)
  909. WREG32(RADEON_TV_MASTER_CNTL, tv_master_cntl);
  910. else
  911. WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
  912. WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
  913. }
  914. if (rdev->is_atom_bios)
  915. radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  916. else
  917. radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
  918. }
  919. static void radeon_legacy_tv_dac_prepare(struct drm_encoder *encoder)
  920. {
  921. struct radeon_device *rdev = encoder->dev->dev_private;
  922. if (rdev->is_atom_bios)
  923. radeon_atom_output_lock(encoder, true);
  924. else
  925. radeon_combios_output_lock(encoder, true);
  926. radeon_legacy_tv_dac_dpms(encoder, DRM_MODE_DPMS_OFF);
  927. }
  928. static void radeon_legacy_tv_dac_commit(struct drm_encoder *encoder)
  929. {
  930. struct radeon_device *rdev = encoder->dev->dev_private;
  931. radeon_legacy_tv_dac_dpms(encoder, DRM_MODE_DPMS_ON);
  932. if (rdev->is_atom_bios)
  933. radeon_atom_output_lock(encoder, true);
  934. else
  935. radeon_combios_output_lock(encoder, true);
  936. }
  937. static void radeon_legacy_tv_dac_mode_set(struct drm_encoder *encoder,
  938. struct drm_display_mode *mode,
  939. struct drm_display_mode *adjusted_mode)
  940. {
  941. struct drm_device *dev = encoder->dev;
  942. struct radeon_device *rdev = dev->dev_private;
  943. struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
  944. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  945. struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
  946. uint32_t tv_dac_cntl, gpiopad_a = 0, dac2_cntl, disp_output_cntl = 0;
  947. uint32_t disp_hw_debug = 0, fp2_gen_cntl = 0, disp_tv_out_cntl = 0;
  948. bool is_tv = false;
  949. DRM_DEBUG_KMS("\n");
  950. is_tv = radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT ? true : false;
  951. if (rdev->family != CHIP_R200) {
  952. tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
  953. if (rdev->family == CHIP_R420 ||
  954. rdev->family == CHIP_R423 ||
  955. rdev->family == CHIP_RV410) {
  956. tv_dac_cntl &= ~(RADEON_TV_DAC_STD_MASK |
  957. RADEON_TV_DAC_BGADJ_MASK |
  958. R420_TV_DAC_DACADJ_MASK |
  959. R420_TV_DAC_RDACPD |
  960. R420_TV_DAC_GDACPD |
  961. R420_TV_DAC_BDACPD |
  962. R420_TV_DAC_TVENABLE);
  963. } else {
  964. tv_dac_cntl &= ~(RADEON_TV_DAC_STD_MASK |
  965. RADEON_TV_DAC_BGADJ_MASK |
  966. RADEON_TV_DAC_DACADJ_MASK |
  967. RADEON_TV_DAC_RDACPD |
  968. RADEON_TV_DAC_GDACPD |
  969. RADEON_TV_DAC_BDACPD);
  970. }
  971. tv_dac_cntl |= RADEON_TV_DAC_NBLANK | RADEON_TV_DAC_NHOLD;
  972. if (is_tv) {
  973. if (tv_dac->tv_std == TV_STD_NTSC ||
  974. tv_dac->tv_std == TV_STD_NTSC_J ||
  975. tv_dac->tv_std == TV_STD_PAL_M ||
  976. tv_dac->tv_std == TV_STD_PAL_60)
  977. tv_dac_cntl |= tv_dac->ntsc_tvdac_adj;
  978. else
  979. tv_dac_cntl |= tv_dac->pal_tvdac_adj;
  980. if (tv_dac->tv_std == TV_STD_NTSC ||
  981. tv_dac->tv_std == TV_STD_NTSC_J)
  982. tv_dac_cntl |= RADEON_TV_DAC_STD_NTSC;
  983. else
  984. tv_dac_cntl |= RADEON_TV_DAC_STD_PAL;
  985. } else
  986. tv_dac_cntl |= (RADEON_TV_DAC_STD_PS2 |
  987. tv_dac->ps2_tvdac_adj);
  988. WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
  989. }
  990. if (ASIC_IS_R300(rdev)) {
  991. gpiopad_a = RREG32(RADEON_GPIOPAD_A) | 1;
  992. disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL);
  993. } else if (rdev->family != CHIP_R200)
  994. disp_hw_debug = RREG32(RADEON_DISP_HW_DEBUG);
  995. else if (rdev->family == CHIP_R200)
  996. fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
  997. if (rdev->family >= CHIP_R200)
  998. disp_tv_out_cntl = RREG32(RADEON_DISP_TV_OUT_CNTL);
  999. if (is_tv) {
  1000. uint32_t dac_cntl;
  1001. dac_cntl = RREG32(RADEON_DAC_CNTL);
  1002. dac_cntl &= ~RADEON_DAC_TVO_EN;
  1003. WREG32(RADEON_DAC_CNTL, dac_cntl);
  1004. if (ASIC_IS_R300(rdev))
  1005. gpiopad_a = RREG32(RADEON_GPIOPAD_A) & ~1;
  1006. dac2_cntl = RREG32(RADEON_DAC_CNTL2) & ~RADEON_DAC2_DAC2_CLK_SEL;
  1007. if (radeon_crtc->crtc_id == 0) {
  1008. if (ASIC_IS_R300(rdev)) {
  1009. disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
  1010. disp_output_cntl |= (RADEON_DISP_TVDAC_SOURCE_CRTC |
  1011. RADEON_DISP_TV_SOURCE_CRTC);
  1012. }
  1013. if (rdev->family >= CHIP_R200) {
  1014. disp_tv_out_cntl &= ~RADEON_DISP_TV_PATH_SRC_CRTC2;
  1015. } else {
  1016. disp_hw_debug |= RADEON_CRT2_DISP1_SEL;
  1017. }
  1018. } else {
  1019. if (ASIC_IS_R300(rdev)) {
  1020. disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
  1021. disp_output_cntl |= RADEON_DISP_TV_SOURCE_CRTC;
  1022. }
  1023. if (rdev->family >= CHIP_R200) {
  1024. disp_tv_out_cntl |= RADEON_DISP_TV_PATH_SRC_CRTC2;
  1025. } else {
  1026. disp_hw_debug &= ~RADEON_CRT2_DISP1_SEL;
  1027. }
  1028. }
  1029. WREG32(RADEON_DAC_CNTL2, dac2_cntl);
  1030. } else {
  1031. dac2_cntl = RREG32(RADEON_DAC_CNTL2) | RADEON_DAC2_DAC2_CLK_SEL;
  1032. if (radeon_crtc->crtc_id == 0) {
  1033. if (ASIC_IS_R300(rdev)) {
  1034. disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
  1035. disp_output_cntl |= RADEON_DISP_TVDAC_SOURCE_CRTC;
  1036. } else if (rdev->family == CHIP_R200) {
  1037. fp2_gen_cntl &= ~(R200_FP2_SOURCE_SEL_MASK |
  1038. RADEON_FP2_DVO_RATE_SEL_SDR);
  1039. } else
  1040. disp_hw_debug |= RADEON_CRT2_DISP1_SEL;
  1041. } else {
  1042. if (ASIC_IS_R300(rdev)) {
  1043. disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
  1044. disp_output_cntl |= RADEON_DISP_TVDAC_SOURCE_CRTC2;
  1045. } else if (rdev->family == CHIP_R200) {
  1046. fp2_gen_cntl &= ~(R200_FP2_SOURCE_SEL_MASK |
  1047. RADEON_FP2_DVO_RATE_SEL_SDR);
  1048. fp2_gen_cntl |= R200_FP2_SOURCE_SEL_CRTC2;
  1049. } else
  1050. disp_hw_debug &= ~RADEON_CRT2_DISP1_SEL;
  1051. }
  1052. WREG32(RADEON_DAC_CNTL2, dac2_cntl);
  1053. }
  1054. if (ASIC_IS_R300(rdev)) {
  1055. WREG32_P(RADEON_GPIOPAD_A, gpiopad_a, ~1);
  1056. WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
  1057. } else if (rdev->family != CHIP_R200)
  1058. WREG32(RADEON_DISP_HW_DEBUG, disp_hw_debug);
  1059. else if (rdev->family == CHIP_R200)
  1060. WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
  1061. if (rdev->family >= CHIP_R200)
  1062. WREG32(RADEON_DISP_TV_OUT_CNTL, disp_tv_out_cntl);
  1063. if (is_tv)
  1064. radeon_legacy_tv_mode_set(encoder, mode, adjusted_mode);
  1065. if (rdev->is_atom_bios)
  1066. radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  1067. else
  1068. radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
  1069. }
  1070. static bool r300_legacy_tv_detect(struct drm_encoder *encoder,
  1071. struct drm_connector *connector)
  1072. {
  1073. struct drm_device *dev = encoder->dev;
  1074. struct radeon_device *rdev = dev->dev_private;
  1075. uint32_t crtc2_gen_cntl, tv_dac_cntl, dac_cntl2, dac_ext_cntl;
  1076. uint32_t disp_output_cntl, gpiopad_a, tmp;
  1077. bool found = false;
  1078. /* save regs needed */
  1079. gpiopad_a = RREG32(RADEON_GPIOPAD_A);
  1080. dac_cntl2 = RREG32(RADEON_DAC_CNTL2);
  1081. crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
  1082. dac_ext_cntl = RREG32(RADEON_DAC_EXT_CNTL);
  1083. tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
  1084. disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL);
  1085. WREG32_P(RADEON_GPIOPAD_A, 0, ~1);
  1086. WREG32(RADEON_DAC_CNTL2, RADEON_DAC2_DAC2_CLK_SEL);
  1087. WREG32(RADEON_CRTC2_GEN_CNTL,
  1088. RADEON_CRTC2_CRT2_ON | RADEON_CRTC2_VSYNC_TRISTAT);
  1089. tmp = disp_output_cntl & ~RADEON_DISP_TVDAC_SOURCE_MASK;
  1090. tmp |= RADEON_DISP_TVDAC_SOURCE_CRTC2;
  1091. WREG32(RADEON_DISP_OUTPUT_CNTL, tmp);
  1092. WREG32(RADEON_DAC_EXT_CNTL,
  1093. RADEON_DAC2_FORCE_BLANK_OFF_EN |
  1094. RADEON_DAC2_FORCE_DATA_EN |
  1095. RADEON_DAC_FORCE_DATA_SEL_RGB |
  1096. (0xec << RADEON_DAC_FORCE_DATA_SHIFT));
  1097. WREG32(RADEON_TV_DAC_CNTL,
  1098. RADEON_TV_DAC_STD_NTSC |
  1099. (8 << RADEON_TV_DAC_BGADJ_SHIFT) |
  1100. (6 << RADEON_TV_DAC_DACADJ_SHIFT));
  1101. RREG32(RADEON_TV_DAC_CNTL);
  1102. mdelay(4);
  1103. WREG32(RADEON_TV_DAC_CNTL,
  1104. RADEON_TV_DAC_NBLANK |
  1105. RADEON_TV_DAC_NHOLD |
  1106. RADEON_TV_MONITOR_DETECT_EN |
  1107. RADEON_TV_DAC_STD_NTSC |
  1108. (8 << RADEON_TV_DAC_BGADJ_SHIFT) |
  1109. (6 << RADEON_TV_DAC_DACADJ_SHIFT));
  1110. RREG32(RADEON_TV_DAC_CNTL);
  1111. mdelay(6);
  1112. tmp = RREG32(RADEON_TV_DAC_CNTL);
  1113. if ((tmp & RADEON_TV_DAC_GDACDET) != 0) {
  1114. found = true;
  1115. DRM_DEBUG_KMS("S-video TV connection detected\n");
  1116. } else if ((tmp & RADEON_TV_DAC_BDACDET) != 0) {
  1117. found = true;
  1118. DRM_DEBUG_KMS("Composite TV connection detected\n");
  1119. }
  1120. WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
  1121. WREG32(RADEON_DAC_EXT_CNTL, dac_ext_cntl);
  1122. WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
  1123. WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
  1124. WREG32(RADEON_DAC_CNTL2, dac_cntl2);
  1125. WREG32_P(RADEON_GPIOPAD_A, gpiopad_a, ~1);
  1126. return found;
  1127. }
  1128. static bool radeon_legacy_tv_detect(struct drm_encoder *encoder,
  1129. struct drm_connector *connector)
  1130. {
  1131. struct drm_device *dev = encoder->dev;
  1132. struct radeon_device *rdev = dev->dev_private;
  1133. uint32_t tv_dac_cntl, dac_cntl2;
  1134. uint32_t config_cntl, tv_pre_dac_mux_cntl, tv_master_cntl, tmp;
  1135. bool found = false;
  1136. if (ASIC_IS_R300(rdev))
  1137. return r300_legacy_tv_detect(encoder, connector);
  1138. dac_cntl2 = RREG32(RADEON_DAC_CNTL2);
  1139. tv_master_cntl = RREG32(RADEON_TV_MASTER_CNTL);
  1140. tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
  1141. config_cntl = RREG32(RADEON_CONFIG_CNTL);
  1142. tv_pre_dac_mux_cntl = RREG32(RADEON_TV_PRE_DAC_MUX_CNTL);
  1143. tmp = dac_cntl2 & ~RADEON_DAC2_DAC2_CLK_SEL;
  1144. WREG32(RADEON_DAC_CNTL2, tmp);
  1145. tmp = tv_master_cntl | RADEON_TV_ON;
  1146. tmp &= ~(RADEON_TV_ASYNC_RST |
  1147. RADEON_RESTART_PHASE_FIX |
  1148. RADEON_CRT_FIFO_CE_EN |
  1149. RADEON_TV_FIFO_CE_EN |
  1150. RADEON_RE_SYNC_NOW_SEL_MASK);
  1151. tmp |= RADEON_TV_FIFO_ASYNC_RST | RADEON_CRT_ASYNC_RST;
  1152. WREG32(RADEON_TV_MASTER_CNTL, tmp);
  1153. tmp = RADEON_TV_DAC_NBLANK | RADEON_TV_DAC_NHOLD |
  1154. RADEON_TV_MONITOR_DETECT_EN | RADEON_TV_DAC_STD_NTSC |
  1155. (8 << RADEON_TV_DAC_BGADJ_SHIFT);
  1156. if (config_cntl & RADEON_CFG_ATI_REV_ID_MASK)
  1157. tmp |= (4 << RADEON_TV_DAC_DACADJ_SHIFT);
  1158. else
  1159. tmp |= (8 << RADEON_TV_DAC_DACADJ_SHIFT);
  1160. WREG32(RADEON_TV_DAC_CNTL, tmp);
  1161. tmp = RADEON_C_GRN_EN | RADEON_CMP_BLU_EN |
  1162. RADEON_RED_MX_FORCE_DAC_DATA |
  1163. RADEON_GRN_MX_FORCE_DAC_DATA |
  1164. RADEON_BLU_MX_FORCE_DAC_DATA |
  1165. (0x109 << RADEON_TV_FORCE_DAC_DATA_SHIFT);
  1166. WREG32(RADEON_TV_PRE_DAC_MUX_CNTL, tmp);
  1167. mdelay(3);
  1168. tmp = RREG32(RADEON_TV_DAC_CNTL);
  1169. if (tmp & RADEON_TV_DAC_GDACDET) {
  1170. found = true;
  1171. DRM_DEBUG_KMS("S-video TV connection detected\n");
  1172. } else if ((tmp & RADEON_TV_DAC_BDACDET) != 0) {
  1173. found = true;
  1174. DRM_DEBUG_KMS("Composite TV connection detected\n");
  1175. }
  1176. WREG32(RADEON_TV_PRE_DAC_MUX_CNTL, tv_pre_dac_mux_cntl);
  1177. WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
  1178. WREG32(RADEON_TV_MASTER_CNTL, tv_master_cntl);
  1179. WREG32(RADEON_DAC_CNTL2, dac_cntl2);
  1180. return found;
  1181. }
  1182. static enum drm_connector_status radeon_legacy_tv_dac_detect(struct drm_encoder *encoder,
  1183. struct drm_connector *connector)
  1184. {
  1185. struct drm_device *dev = encoder->dev;
  1186. struct radeon_device *rdev = dev->dev_private;
  1187. uint32_t crtc2_gen_cntl, tv_dac_cntl, dac_cntl2, dac_ext_cntl;
  1188. uint32_t disp_hw_debug, disp_output_cntl, gpiopad_a, pixclks_cntl, tmp;
  1189. enum drm_connector_status found = connector_status_disconnected;
  1190. struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
  1191. struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
  1192. bool color = true;
  1193. struct drm_crtc *crtc;
  1194. /* find out if crtc2 is in use or if this encoder is using it */
  1195. list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
  1196. struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
  1197. if ((radeon_crtc->crtc_id == 1) && crtc->enabled) {
  1198. if (encoder->crtc != crtc) {
  1199. return connector_status_disconnected;
  1200. }
  1201. }
  1202. }
  1203. if (connector->connector_type == DRM_MODE_CONNECTOR_SVIDEO ||
  1204. connector->connector_type == DRM_MODE_CONNECTOR_Composite ||
  1205. connector->connector_type == DRM_MODE_CONNECTOR_9PinDIN) {
  1206. bool tv_detect;
  1207. if (radeon_encoder->active_device && !(radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT))
  1208. return connector_status_disconnected;
  1209. tv_detect = radeon_legacy_tv_detect(encoder, connector);
  1210. if (tv_detect && tv_dac)
  1211. found = connector_status_connected;
  1212. return found;
  1213. }
  1214. /* don't probe if the encoder is being used for something else not CRT related */
  1215. if (radeon_encoder->active_device && !(radeon_encoder->active_device & ATOM_DEVICE_CRT_SUPPORT)) {
  1216. DRM_INFO("not detecting due to %08x\n", radeon_encoder->active_device);
  1217. return connector_status_disconnected;
  1218. }
  1219. /* save the regs we need */
  1220. pixclks_cntl = RREG32_PLL(RADEON_PIXCLKS_CNTL);
  1221. gpiopad_a = ASIC_IS_R300(rdev) ? RREG32(RADEON_GPIOPAD_A) : 0;
  1222. disp_output_cntl = ASIC_IS_R300(rdev) ? RREG32(RADEON_DISP_OUTPUT_CNTL) : 0;
  1223. disp_hw_debug = ASIC_IS_R300(rdev) ? 0 : RREG32(RADEON_DISP_HW_DEBUG);
  1224. crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
  1225. tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
  1226. dac_ext_cntl = RREG32(RADEON_DAC_EXT_CNTL);
  1227. dac_cntl2 = RREG32(RADEON_DAC_CNTL2);
  1228. tmp = pixclks_cntl & ~(RADEON_PIX2CLK_ALWAYS_ONb
  1229. | RADEON_PIX2CLK_DAC_ALWAYS_ONb);
  1230. WREG32_PLL(RADEON_PIXCLKS_CNTL, tmp);
  1231. if (ASIC_IS_R300(rdev))
  1232. WREG32_P(RADEON_GPIOPAD_A, 1, ~1);
  1233. tmp = crtc2_gen_cntl & ~RADEON_CRTC2_PIX_WIDTH_MASK;
  1234. tmp |= RADEON_CRTC2_CRT2_ON |
  1235. (2 << RADEON_CRTC2_PIX_WIDTH_SHIFT);
  1236. WREG32(RADEON_CRTC2_GEN_CNTL, tmp);
  1237. if (ASIC_IS_R300(rdev)) {
  1238. tmp = disp_output_cntl & ~RADEON_DISP_TVDAC_SOURCE_MASK;
  1239. tmp |= RADEON_DISP_TVDAC_SOURCE_CRTC2;
  1240. WREG32(RADEON_DISP_OUTPUT_CNTL, tmp);
  1241. } else {
  1242. tmp = disp_hw_debug & ~RADEON_CRT2_DISP1_SEL;
  1243. WREG32(RADEON_DISP_HW_DEBUG, tmp);
  1244. }
  1245. tmp = RADEON_TV_DAC_NBLANK |
  1246. RADEON_TV_DAC_NHOLD |
  1247. RADEON_TV_MONITOR_DETECT_EN |
  1248. RADEON_TV_DAC_STD_PS2;
  1249. WREG32(RADEON_TV_DAC_CNTL, tmp);
  1250. tmp = RADEON_DAC2_FORCE_BLANK_OFF_EN |
  1251. RADEON_DAC2_FORCE_DATA_EN;
  1252. if (color)
  1253. tmp |= RADEON_DAC_FORCE_DATA_SEL_RGB;
  1254. else
  1255. tmp |= RADEON_DAC_FORCE_DATA_SEL_G;
  1256. if (ASIC_IS_R300(rdev))
  1257. tmp |= (0x1b6 << RADEON_DAC_FORCE_DATA_SHIFT);
  1258. else
  1259. tmp |= (0x180 << RADEON_DAC_FORCE_DATA_SHIFT);
  1260. WREG32(RADEON_DAC_EXT_CNTL, tmp);
  1261. tmp = dac_cntl2 | RADEON_DAC2_DAC2_CLK_SEL | RADEON_DAC2_CMP_EN;
  1262. WREG32(RADEON_DAC_CNTL2, tmp);
  1263. mdelay(10);
  1264. if (ASIC_IS_R300(rdev)) {
  1265. if (RREG32(RADEON_DAC_CNTL2) & RADEON_DAC2_CMP_OUT_B)
  1266. found = connector_status_connected;
  1267. } else {
  1268. if (RREG32(RADEON_DAC_CNTL2) & RADEON_DAC2_CMP_OUTPUT)
  1269. found = connector_status_connected;
  1270. }
  1271. /* restore regs we used */
  1272. WREG32(RADEON_DAC_CNTL2, dac_cntl2);
  1273. WREG32(RADEON_DAC_EXT_CNTL, dac_ext_cntl);
  1274. WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
  1275. WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
  1276. if (ASIC_IS_R300(rdev)) {
  1277. WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
  1278. WREG32_P(RADEON_GPIOPAD_A, gpiopad_a, ~1);
  1279. } else {
  1280. WREG32(RADEON_DISP_HW_DEBUG, disp_hw_debug);
  1281. }
  1282. WREG32_PLL(RADEON_PIXCLKS_CNTL, pixclks_cntl);
  1283. return found;
  1284. }
  1285. static const struct drm_encoder_helper_funcs radeon_legacy_tv_dac_helper_funcs = {
  1286. .dpms = radeon_legacy_tv_dac_dpms,
  1287. .mode_fixup = radeon_legacy_mode_fixup,
  1288. .prepare = radeon_legacy_tv_dac_prepare,
  1289. .mode_set = radeon_legacy_tv_dac_mode_set,
  1290. .commit = radeon_legacy_tv_dac_commit,
  1291. .detect = radeon_legacy_tv_dac_detect,
  1292. .disable = radeon_legacy_encoder_disable,
  1293. };
  1294. static const struct drm_encoder_funcs radeon_legacy_tv_dac_enc_funcs = {
  1295. .destroy = radeon_enc_destroy,
  1296. };
  1297. static struct radeon_encoder_int_tmds *radeon_legacy_get_tmds_info(struct radeon_encoder *encoder)
  1298. {
  1299. struct drm_device *dev = encoder->base.dev;
  1300. struct radeon_device *rdev = dev->dev_private;
  1301. struct radeon_encoder_int_tmds *tmds = NULL;
  1302. bool ret;
  1303. tmds = kzalloc(sizeof(struct radeon_encoder_int_tmds), GFP_KERNEL);
  1304. if (!tmds)
  1305. return NULL;
  1306. if (rdev->is_atom_bios)
  1307. ret = radeon_atombios_get_tmds_info(encoder, tmds);
  1308. else
  1309. ret = radeon_legacy_get_tmds_info_from_combios(encoder, tmds);
  1310. if (ret == false)
  1311. radeon_legacy_get_tmds_info_from_table(encoder, tmds);
  1312. return tmds;
  1313. }
  1314. static struct radeon_encoder_ext_tmds *radeon_legacy_get_ext_tmds_info(struct radeon_encoder *encoder)
  1315. {
  1316. struct drm_device *dev = encoder->base.dev;
  1317. struct radeon_device *rdev = dev->dev_private;
  1318. struct radeon_encoder_ext_tmds *tmds = NULL;
  1319. bool ret;
  1320. if (rdev->is_atom_bios)
  1321. return NULL;
  1322. tmds = kzalloc(sizeof(struct radeon_encoder_ext_tmds), GFP_KERNEL);
  1323. if (!tmds)
  1324. return NULL;
  1325. ret = radeon_legacy_get_ext_tmds_info_from_combios(encoder, tmds);
  1326. if (ret == false)
  1327. radeon_legacy_get_ext_tmds_info_from_table(encoder, tmds);
  1328. return tmds;
  1329. }
  1330. void
  1331. radeon_add_legacy_encoder(struct drm_device *dev, uint32_t encoder_enum, uint32_t supported_device)
  1332. {
  1333. struct radeon_device *rdev = dev->dev_private;
  1334. struct drm_encoder *encoder;
  1335. struct radeon_encoder *radeon_encoder;
  1336. /* see if we already added it */
  1337. list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
  1338. radeon_encoder = to_radeon_encoder(encoder);
  1339. if (radeon_encoder->encoder_enum == encoder_enum) {
  1340. radeon_encoder->devices |= supported_device;
  1341. return;
  1342. }
  1343. }
  1344. /* add a new one */
  1345. radeon_encoder = kzalloc(sizeof(struct radeon_encoder), GFP_KERNEL);
  1346. if (!radeon_encoder)
  1347. return;
  1348. encoder = &radeon_encoder->base;
  1349. if (rdev->flags & RADEON_SINGLE_CRTC)
  1350. encoder->possible_crtcs = 0x1;
  1351. else
  1352. encoder->possible_crtcs = 0x3;
  1353. radeon_encoder->enc_priv = NULL;
  1354. radeon_encoder->encoder_enum = encoder_enum;
  1355. radeon_encoder->encoder_id = (encoder_enum & OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
  1356. radeon_encoder->devices = supported_device;
  1357. radeon_encoder->rmx_type = RMX_OFF;
  1358. switch (radeon_encoder->encoder_id) {
  1359. case ENCODER_OBJECT_ID_INTERNAL_LVDS:
  1360. encoder->possible_crtcs = 0x1;
  1361. drm_encoder_init(dev, encoder, &radeon_legacy_lvds_enc_funcs, DRM_MODE_ENCODER_LVDS);
  1362. drm_encoder_helper_add(encoder, &radeon_legacy_lvds_helper_funcs);
  1363. if (rdev->is_atom_bios)
  1364. radeon_encoder->enc_priv = radeon_atombios_get_lvds_info(radeon_encoder);
  1365. else
  1366. radeon_encoder->enc_priv = radeon_combios_get_lvds_info(radeon_encoder);
  1367. radeon_encoder->rmx_type = RMX_FULL;
  1368. break;
  1369. case ENCODER_OBJECT_ID_INTERNAL_TMDS1:
  1370. drm_encoder_init(dev, encoder, &radeon_legacy_tmds_int_enc_funcs, DRM_MODE_ENCODER_TMDS);
  1371. drm_encoder_helper_add(encoder, &radeon_legacy_tmds_int_helper_funcs);
  1372. radeon_encoder->enc_priv = radeon_legacy_get_tmds_info(radeon_encoder);
  1373. break;
  1374. case ENCODER_OBJECT_ID_INTERNAL_DAC1:
  1375. drm_encoder_init(dev, encoder, &radeon_legacy_primary_dac_enc_funcs, DRM_MODE_ENCODER_DAC);
  1376. drm_encoder_helper_add(encoder, &radeon_legacy_primary_dac_helper_funcs);
  1377. if (rdev->is_atom_bios)
  1378. radeon_encoder->enc_priv = radeon_atombios_get_primary_dac_info(radeon_encoder);
  1379. else
  1380. radeon_encoder->enc_priv = radeon_combios_get_primary_dac_info(radeon_encoder);
  1381. break;
  1382. case ENCODER_OBJECT_ID_INTERNAL_DAC2:
  1383. drm_encoder_init(dev, encoder, &radeon_legacy_tv_dac_enc_funcs, DRM_MODE_ENCODER_TVDAC);
  1384. drm_encoder_helper_add(encoder, &radeon_legacy_tv_dac_helper_funcs);
  1385. if (rdev->is_atom_bios)
  1386. radeon_encoder->enc_priv = radeon_atombios_get_tv_dac_info(radeon_encoder);
  1387. else
  1388. radeon_encoder->enc_priv = radeon_combios_get_tv_dac_info(radeon_encoder);
  1389. break;
  1390. case ENCODER_OBJECT_ID_INTERNAL_DVO1:
  1391. drm_encoder_init(dev, encoder, &radeon_legacy_tmds_ext_enc_funcs, DRM_MODE_ENCODER_TMDS);
  1392. drm_encoder_helper_add(encoder, &radeon_legacy_tmds_ext_helper_funcs);
  1393. if (!rdev->is_atom_bios)
  1394. radeon_encoder->enc_priv = radeon_legacy_get_ext_tmds_info(radeon_encoder);
  1395. break;
  1396. }
  1397. }