Merge branch 'locking-urgent-for-linus' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6-block.git] / drivers / gpu / drm / radeon / radeon_legacy_encoders.c
CommitLineData
771fe6b9
JG
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 */
760285e7
DH
26#include <drm/drmP.h>
27#include <drm/drm_crtc_helper.h>
28#include <drm/radeon_drm.h>
771fe6b9
JG
29#include "radeon.h"
30#include "atom.h"
63ec0119
MD
31#include <linux/backlight.h>
32#ifdef CONFIG_PMAC_BACKLIGHT
33#include <asm/backlight.h>
34#endif
771fe6b9 35
4ce001ab
DA
36static void radeon_legacy_encoder_disable(struct drm_encoder *encoder)
37{
38 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
319d1e14 39 const struct drm_encoder_helper_funcs *encoder_funcs;
4ce001ab
DA
40
41 encoder_funcs = encoder->helper_private;
42 encoder_funcs->dpms(encoder, DRM_MODE_DPMS_OFF);
43 radeon_encoder->active_device = 0;
44}
771fe6b9 45
63ec0119 46static void radeon_legacy_lvds_update(struct drm_encoder *encoder, int mode)
771fe6b9
JG
47{
48 struct drm_device *dev = encoder->dev;
49 struct radeon_device *rdev = dev->dev_private;
50 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
51 uint32_t lvds_gen_cntl, lvds_pll_cntl, pixclks_cntl, disp_pwr_man;
52 int panel_pwr_delay = 2000;
3890ddf5 53 bool is_mac = false;
63ec0119 54 uint8_t backlight_level;
d9fdaafb 55 DRM_DEBUG_KMS("\n");
771fe6b9 56
63ec0119
MD
57 lvds_gen_cntl = RREG32(RADEON_LVDS_GEN_CNTL);
58 backlight_level = (lvds_gen_cntl >> RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
59
771fe6b9
JG
60 if (radeon_encoder->enc_priv) {
61 if (rdev->is_atom_bios) {
62 struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
63 panel_pwr_delay = lvds->panel_pwr_delay;
63ec0119
MD
64 if (lvds->bl_dev)
65 backlight_level = lvds->backlight_level;
771fe6b9
JG
66 } else {
67 struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
68 panel_pwr_delay = lvds->panel_pwr_delay;
63ec0119
MD
69 if (lvds->bl_dev)
70 backlight_level = lvds->backlight_level;
771fe6b9
JG
71 }
72 }
73
3890ddf5
AD
74 /* macs (and possibly some x86 oem systems?) wire up LVDS strangely
75 * Taken from radeonfb.
76 */
77 if ((rdev->mode_info.connector_table == CT_IBOOK) ||
78 (rdev->mode_info.connector_table == CT_POWERBOOK_EXTERNAL) ||
79 (rdev->mode_info.connector_table == CT_POWERBOOK_INTERNAL) ||
80 (rdev->mode_info.connector_table == CT_POWERBOOK_VGA))
81 is_mac = true;
82
771fe6b9
JG
83 switch (mode) {
84 case DRM_MODE_DPMS_ON:
85 disp_pwr_man = RREG32(RADEON_DISP_PWR_MAN);
86 disp_pwr_man |= RADEON_AUTO_PWRUP_EN;
87 WREG32(RADEON_DISP_PWR_MAN, disp_pwr_man);
88 lvds_pll_cntl = RREG32(RADEON_LVDS_PLL_CNTL);
89 lvds_pll_cntl |= RADEON_LVDS_PLL_EN;
90 WREG32(RADEON_LVDS_PLL_CNTL, lvds_pll_cntl);
4de833c3 91 mdelay(1);
771fe6b9
JG
92
93 lvds_pll_cntl = RREG32(RADEON_LVDS_PLL_CNTL);
94 lvds_pll_cntl &= ~RADEON_LVDS_PLL_RESET;
95 WREG32(RADEON_LVDS_PLL_CNTL, lvds_pll_cntl);
96
63ec0119
MD
97 lvds_gen_cntl &= ~(RADEON_LVDS_DISPLAY_DIS |
98 RADEON_LVDS_BL_MOD_LEVEL_MASK);
99 lvds_gen_cntl |= (RADEON_LVDS_ON | RADEON_LVDS_EN |
100 RADEON_LVDS_DIGON | RADEON_LVDS_BLON |
101 (backlight_level << RADEON_LVDS_BL_MOD_LEVEL_SHIFT));
3890ddf5
AD
102 if (is_mac)
103 lvds_gen_cntl |= RADEON_LVDS_BL_MOD_EN;
4de833c3 104 mdelay(panel_pwr_delay);
771fe6b9
JG
105 WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
106 break;
107 case DRM_MODE_DPMS_STANDBY:
108 case DRM_MODE_DPMS_SUSPEND:
109 case DRM_MODE_DPMS_OFF:
110 pixclks_cntl = RREG32_PLL(RADEON_PIXCLKS_CNTL);
111 WREG32_PLL_P(RADEON_PIXCLKS_CNTL, 0, ~RADEON_PIXCLK_LVDS_ALWAYS_ONb);
771fe6b9 112 lvds_gen_cntl |= RADEON_LVDS_DISPLAY_DIS;
3890ddf5
AD
113 if (is_mac) {
114 lvds_gen_cntl &= ~RADEON_LVDS_BL_MOD_EN;
115 WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
116 lvds_gen_cntl &= ~(RADEON_LVDS_ON | RADEON_LVDS_EN);
117 } else {
118 WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
119 lvds_gen_cntl &= ~(RADEON_LVDS_ON | RADEON_LVDS_BLON | RADEON_LVDS_EN | RADEON_LVDS_DIGON);
120 }
4de833c3 121 mdelay(panel_pwr_delay);
771fe6b9
JG
122 WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
123 WREG32_PLL(RADEON_PIXCLKS_CNTL, pixclks_cntl);
4de833c3 124 mdelay(panel_pwr_delay);
771fe6b9
JG
125 break;
126 }
127
128 if (rdev->is_atom_bios)
129 radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
130 else
131 radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
c913e23a 132
771fe6b9
JG
133}
134
63ec0119
MD
135static void radeon_legacy_lvds_dpms(struct drm_encoder *encoder, int mode)
136{
137 struct radeon_device *rdev = encoder->dev->dev_private;
138 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
139 DRM_DEBUG("\n");
140
141 if (radeon_encoder->enc_priv) {
142 if (rdev->is_atom_bios) {
143 struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
144 lvds->dpms_mode = mode;
145 } else {
146 struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
147 lvds->dpms_mode = mode;
148 }
149 }
150
151 radeon_legacy_lvds_update(encoder, mode);
152}
153
771fe6b9
JG
154static void radeon_legacy_lvds_prepare(struct drm_encoder *encoder)
155{
156 struct radeon_device *rdev = encoder->dev->dev_private;
157
158 if (rdev->is_atom_bios)
159 radeon_atom_output_lock(encoder, true);
160 else
161 radeon_combios_output_lock(encoder, true);
162 radeon_legacy_lvds_dpms(encoder, DRM_MODE_DPMS_OFF);
163}
164
165static void radeon_legacy_lvds_commit(struct drm_encoder *encoder)
166{
167 struct radeon_device *rdev = encoder->dev->dev_private;
168
169 radeon_legacy_lvds_dpms(encoder, DRM_MODE_DPMS_ON);
170 if (rdev->is_atom_bios)
171 radeon_atom_output_lock(encoder, false);
172 else
173 radeon_combios_output_lock(encoder, false);
174}
175
176static void radeon_legacy_lvds_mode_set(struct drm_encoder *encoder,
177 struct drm_display_mode *mode,
178 struct drm_display_mode *adjusted_mode)
179{
180 struct drm_device *dev = encoder->dev;
181 struct radeon_device *rdev = dev->dev_private;
182 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
183 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
184 uint32_t lvds_pll_cntl, lvds_gen_cntl, lvds_ss_gen_cntl;
185
d9fdaafb 186 DRM_DEBUG_KMS("\n");
771fe6b9 187
771fe6b9
JG
188 lvds_pll_cntl = RREG32(RADEON_LVDS_PLL_CNTL);
189 lvds_pll_cntl &= ~RADEON_LVDS_PLL_EN;
190
191 lvds_ss_gen_cntl = RREG32(RADEON_LVDS_SS_GEN_CNTL);
32f48ffe
AD
192 if (rdev->is_atom_bios) {
193 /* LVDS_GEN_CNTL parameters are computed in LVDSEncoderControl
194 * need to call that on resume to set up the reg properly.
195 */
196 radeon_encoder->pixel_clock = adjusted_mode->clock;
197 atombios_digital_setup(encoder, PANEL_ENCODER_ACTION_ENABLE);
198 lvds_gen_cntl = RREG32(RADEON_LVDS_GEN_CNTL);
199 } else {
771fe6b9
JG
200 struct radeon_encoder_lvds *lvds = (struct radeon_encoder_lvds *)radeon_encoder->enc_priv;
201 if (lvds) {
d9fdaafb 202 DRM_DEBUG_KMS("bios LVDS_GEN_CNTL: 0x%x\n", lvds->lvds_gen_cntl);
771fe6b9
JG
203 lvds_gen_cntl = lvds->lvds_gen_cntl;
204 lvds_ss_gen_cntl &= ~((0xf << RADEON_LVDS_PWRSEQ_DELAY1_SHIFT) |
205 (0xf << RADEON_LVDS_PWRSEQ_DELAY2_SHIFT));
206 lvds_ss_gen_cntl |= ((lvds->panel_digon_delay << RADEON_LVDS_PWRSEQ_DELAY1_SHIFT) |
207 (lvds->panel_blon_delay << RADEON_LVDS_PWRSEQ_DELAY2_SHIFT));
208 } else
209 lvds_gen_cntl = RREG32(RADEON_LVDS_GEN_CNTL);
32f48ffe 210 }
771fe6b9
JG
211 lvds_gen_cntl |= RADEON_LVDS_DISPLAY_DIS;
212 lvds_gen_cntl &= ~(RADEON_LVDS_ON |
213 RADEON_LVDS_BLON |
214 RADEON_LVDS_EN |
215 RADEON_LVDS_RST_FM);
216
217 if (ASIC_IS_R300(rdev))
218 lvds_pll_cntl &= ~(R300_LVDS_SRC_SEL_MASK);
219
220 if (radeon_crtc->crtc_id == 0) {
221 if (ASIC_IS_R300(rdev)) {
c93bb85b 222 if (radeon_encoder->rmx_type != RMX_OFF)
771fe6b9
JG
223 lvds_pll_cntl |= R300_LVDS_SRC_SEL_RMX;
224 } else
225 lvds_gen_cntl &= ~RADEON_LVDS_SEL_CRTC2;
226 } else {
227 if (ASIC_IS_R300(rdev))
228 lvds_pll_cntl |= R300_LVDS_SRC_SEL_CRTC2;
229 else
230 lvds_gen_cntl |= RADEON_LVDS_SEL_CRTC2;
231 }
232
233 WREG32(RADEON_LVDS_GEN_CNTL, lvds_gen_cntl);
234 WREG32(RADEON_LVDS_PLL_CNTL, lvds_pll_cntl);
235 WREG32(RADEON_LVDS_SS_GEN_CNTL, lvds_ss_gen_cntl);
236
237 if (rdev->family == CHIP_RV410)
238 WREG32(RADEON_CLOCK_CNTL_INDEX, 0);
239
240 if (rdev->is_atom_bios)
241 radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
242 else
243 radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
244}
245
80297e87 246static bool radeon_legacy_mode_fixup(struct drm_encoder *encoder,
e811f5ae 247 const struct drm_display_mode *mode,
80297e87 248 struct drm_display_mode *adjusted_mode)
771fe6b9
JG
249{
250 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
251
8c2a6d73
AD
252 /* set the active encoder to connector routing */
253 radeon_encoder_set_active_device(encoder);
771fe6b9
JG
254 drm_mode_set_crtcinfo(adjusted_mode, 0);
255
80297e87 256 /* get the native mode for LVDS */
3515387b
AD
257 if (radeon_encoder->active_device & (ATOM_DEVICE_LCD_SUPPORT))
258 radeon_panel_mode_fixup(encoder, adjusted_mode);
771fe6b9
JG
259
260 return true;
261}
262
263static const struct drm_encoder_helper_funcs radeon_legacy_lvds_helper_funcs = {
264 .dpms = radeon_legacy_lvds_dpms,
80297e87 265 .mode_fixup = radeon_legacy_mode_fixup,
771fe6b9
JG
266 .prepare = radeon_legacy_lvds_prepare,
267 .mode_set = radeon_legacy_lvds_mode_set,
268 .commit = radeon_legacy_lvds_commit,
4ce001ab 269 .disable = radeon_legacy_encoder_disable,
771fe6b9
JG
270};
271
6d92f81d
AD
272u8
273radeon_legacy_get_backlight_level(struct radeon_encoder *radeon_encoder)
274{
275 struct drm_device *dev = radeon_encoder->base.dev;
276 struct radeon_device *rdev = dev->dev_private;
277 u8 backlight_level;
278
279 backlight_level = (RREG32(RADEON_LVDS_GEN_CNTL) >>
280 RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
281
282 return backlight_level;
283}
284
37e9b6a6
AD
285void
286radeon_legacy_set_backlight_level(struct radeon_encoder *radeon_encoder, u8 level)
63ec0119 287{
63ec0119
MD
288 struct drm_device *dev = radeon_encoder->base.dev;
289 struct radeon_device *rdev = dev->dev_private;
290 int dpms_mode = DRM_MODE_DPMS_ON;
291
292 if (radeon_encoder->enc_priv) {
293 if (rdev->is_atom_bios) {
294 struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
37e9b6a6
AD
295 if (lvds->backlight_level > 0)
296 dpms_mode = lvds->dpms_mode;
297 else
298 dpms_mode = DRM_MODE_DPMS_OFF;
299 lvds->backlight_level = level;
63ec0119
MD
300 } else {
301 struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
37e9b6a6
AD
302 if (lvds->backlight_level > 0)
303 dpms_mode = lvds->dpms_mode;
304 else
305 dpms_mode = DRM_MODE_DPMS_OFF;
306 lvds->backlight_level = level;
63ec0119
MD
307 }
308 }
309
37e9b6a6
AD
310 radeon_legacy_lvds_update(&radeon_encoder->base, dpms_mode);
311}
312
cd23492a
AD
313#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) || defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)
314
315static uint8_t radeon_legacy_lvds_level(struct backlight_device *bd)
316{
317 struct radeon_backlight_privdata *pdata = bl_get_data(bd);
318 uint8_t level;
319
320 /* Convert brightness to hardware level */
321 if (bd->props.brightness < 0)
322 level = 0;
323 else if (bd->props.brightness > RADEON_MAX_BL_LEVEL)
324 level = RADEON_MAX_BL_LEVEL;
325 else
326 level = bd->props.brightness;
327
328 if (pdata->negative)
329 level = RADEON_MAX_BL_LEVEL - level;
330
331 return level;
332}
333
37e9b6a6
AD
334static int radeon_legacy_backlight_update_status(struct backlight_device *bd)
335{
336 struct radeon_backlight_privdata *pdata = bl_get_data(bd);
337 struct radeon_encoder *radeon_encoder = pdata->encoder;
338
339 radeon_legacy_set_backlight_level(radeon_encoder,
340 radeon_legacy_lvds_level(bd));
63ec0119
MD
341
342 return 0;
343}
344
345static int radeon_legacy_backlight_get_brightness(struct backlight_device *bd)
346{
347 struct radeon_backlight_privdata *pdata = bl_get_data(bd);
348 struct radeon_encoder *radeon_encoder = pdata->encoder;
349 struct drm_device *dev = radeon_encoder->base.dev;
350 struct radeon_device *rdev = dev->dev_private;
351 uint8_t backlight_level;
352
353 backlight_level = (RREG32(RADEON_LVDS_GEN_CNTL) >>
354 RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
355
91030880 356 return pdata->negative ? RADEON_MAX_BL_LEVEL - backlight_level : backlight_level;
63ec0119
MD
357}
358
359static const struct backlight_ops radeon_backlight_ops = {
360 .get_brightness = radeon_legacy_backlight_get_brightness,
361 .update_status = radeon_legacy_backlight_update_status,
362};
363
364void radeon_legacy_backlight_init(struct radeon_encoder *radeon_encoder,
365 struct drm_connector *drm_connector)
366{
367 struct drm_device *dev = radeon_encoder->base.dev;
368 struct radeon_device *rdev = dev->dev_private;
369 struct backlight_device *bd;
370 struct backlight_properties props;
371 struct radeon_backlight_privdata *pdata;
372 uint8_t backlight_level;
614499b4 373 char bl_name[16];
63ec0119
MD
374
375 if (!radeon_encoder->enc_priv)
376 return;
377
378#ifdef CONFIG_PMAC_BACKLIGHT
379 if (!pmac_has_backlight_type("ati") &&
380 !pmac_has_backlight_type("mnca"))
381 return;
382#endif
383
384 pdata = kmalloc(sizeof(struct radeon_backlight_privdata), GFP_KERNEL);
385 if (!pdata) {
386 DRM_ERROR("Memory allocation failed\n");
387 goto error;
388 }
389
af437cfd 390 memset(&props, 0, sizeof(props));
91030880 391 props.max_brightness = RADEON_MAX_BL_LEVEL;
63ec0119 392 props.type = BACKLIGHT_RAW;
614499b4
AD
393 snprintf(bl_name, sizeof(bl_name),
394 "radeon_bl%d", dev->primary->index);
5bdebb18 395 bd = backlight_device_register(bl_name, drm_connector->kdev,
63ec0119
MD
396 pdata, &radeon_backlight_ops, &props);
397 if (IS_ERR(bd)) {
398 DRM_ERROR("Backlight registration failed\n");
399 goto error;
400 }
401
402 pdata->encoder = radeon_encoder;
403
404 backlight_level = (RREG32(RADEON_LVDS_GEN_CNTL) >>
405 RADEON_LVDS_BL_MOD_LEVEL_SHIFT) & 0xff;
406
407 /* First, try to detect backlight level sense based on the assumption
408 * that firmware set it up at full brightness
409 */
410 if (backlight_level == 0)
411 pdata->negative = true;
412 else if (backlight_level == 0xff)
413 pdata->negative = false;
414 else {
415 /* XXX hack... maybe some day we can figure out in what direction
416 * backlight should work on a given panel?
417 */
418 pdata->negative = (rdev->family != CHIP_RV200 &&
419 rdev->family != CHIP_RV250 &&
420 rdev->family != CHIP_RV280 &&
421 rdev->family != CHIP_RV350);
422
423#ifdef CONFIG_PMAC_BACKLIGHT
424 pdata->negative = (pdata->negative ||
425 of_machine_is_compatible("PowerBook4,3") ||
426 of_machine_is_compatible("PowerBook6,3") ||
427 of_machine_is_compatible("PowerBook6,5"));
428#endif
429 }
430
431 if (rdev->is_atom_bios) {
432 struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
433 lvds->bl_dev = bd;
434 } else {
435 struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
436 lvds->bl_dev = bd;
437 }
438
439 bd->props.brightness = radeon_legacy_backlight_get_brightness(bd);
440 bd->props.power = FB_BLANK_UNBLANK;
441 backlight_update_status(bd);
442
443 DRM_INFO("radeon legacy LVDS backlight initialized\n");
4cee6a90 444 rdev->mode_info.bl_encoder = radeon_encoder;
63ec0119
MD
445
446 return;
447
448error:
449 kfree(pdata);
450 return;
451}
452
453static void radeon_legacy_backlight_exit(struct radeon_encoder *radeon_encoder)
454{
455 struct drm_device *dev = radeon_encoder->base.dev;
456 struct radeon_device *rdev = dev->dev_private;
457 struct backlight_device *bd = NULL;
458
459 if (!radeon_encoder->enc_priv)
460 return;
461
462 if (rdev->is_atom_bios) {
463 struct radeon_encoder_atom_dig *lvds = radeon_encoder->enc_priv;
464 bd = lvds->bl_dev;
465 lvds->bl_dev = NULL;
466 } else {
467 struct radeon_encoder_lvds *lvds = radeon_encoder->enc_priv;
468 bd = lvds->bl_dev;
469 lvds->bl_dev = NULL;
470 }
471
472 if (bd) {
91030880 473 struct radeon_backlight_privdata *pdata;
63ec0119
MD
474
475 pdata = bl_get_data(bd);
476 backlight_device_unregister(bd);
477 kfree(pdata);
478
479 DRM_INFO("radeon legacy LVDS backlight unloaded\n");
480 }
481}
482
483#else /* !CONFIG_BACKLIGHT_CLASS_DEVICE */
484
485void radeon_legacy_backlight_init(struct radeon_encoder *encoder)
486{
487}
488
489static void radeon_legacy_backlight_exit(struct radeon_encoder *encoder)
490{
491}
492
493#endif
494
495
496static void radeon_lvds_enc_destroy(struct drm_encoder *encoder)
497{
498 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
499
500 if (radeon_encoder->enc_priv) {
501 radeon_legacy_backlight_exit(radeon_encoder);
502 kfree(radeon_encoder->enc_priv);
503 }
504 drm_encoder_cleanup(encoder);
505 kfree(radeon_encoder);
506}
771fe6b9
JG
507
508static const struct drm_encoder_funcs radeon_legacy_lvds_enc_funcs = {
63ec0119 509 .destroy = radeon_lvds_enc_destroy,
771fe6b9
JG
510};
511
771fe6b9
JG
512static void radeon_legacy_primary_dac_dpms(struct drm_encoder *encoder, int mode)
513{
514 struct drm_device *dev = encoder->dev;
515 struct radeon_device *rdev = dev->dev_private;
516 uint32_t crtc_ext_cntl = RREG32(RADEON_CRTC_EXT_CNTL);
517 uint32_t dac_cntl = RREG32(RADEON_DAC_CNTL);
518 uint32_t dac_macro_cntl = RREG32(RADEON_DAC_MACRO_CNTL);
519
d9fdaafb 520 DRM_DEBUG_KMS("\n");
771fe6b9
JG
521
522 switch (mode) {
523 case DRM_MODE_DPMS_ON:
524 crtc_ext_cntl |= RADEON_CRTC_CRT_ON;
525 dac_cntl &= ~RADEON_DAC_PDWN;
526 dac_macro_cntl &= ~(RADEON_DAC_PDWN_R |
527 RADEON_DAC_PDWN_G |
528 RADEON_DAC_PDWN_B);
529 break;
530 case DRM_MODE_DPMS_STANDBY:
531 case DRM_MODE_DPMS_SUSPEND:
532 case DRM_MODE_DPMS_OFF:
533 crtc_ext_cntl &= ~RADEON_CRTC_CRT_ON;
534 dac_cntl |= RADEON_DAC_PDWN;
535 dac_macro_cntl |= (RADEON_DAC_PDWN_R |
536 RADEON_DAC_PDWN_G |
537 RADEON_DAC_PDWN_B);
538 break;
539 }
540
f8c4d701
EE
541 /* handled in radeon_crtc_dpms() */
542 if (!(rdev->flags & RADEON_SINGLE_CRTC))
543 WREG32(RADEON_CRTC_EXT_CNTL, crtc_ext_cntl);
771fe6b9
JG
544 WREG32(RADEON_DAC_CNTL, dac_cntl);
545 WREG32(RADEON_DAC_MACRO_CNTL, dac_macro_cntl);
546
547 if (rdev->is_atom_bios)
548 radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
549 else
550 radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
c913e23a 551
771fe6b9
JG
552}
553
554static void radeon_legacy_primary_dac_prepare(struct drm_encoder *encoder)
555{
556 struct radeon_device *rdev = encoder->dev->dev_private;
557
558 if (rdev->is_atom_bios)
559 radeon_atom_output_lock(encoder, true);
560 else
561 radeon_combios_output_lock(encoder, true);
562 radeon_legacy_primary_dac_dpms(encoder, DRM_MODE_DPMS_OFF);
563}
564
565static void radeon_legacy_primary_dac_commit(struct drm_encoder *encoder)
566{
567 struct radeon_device *rdev = encoder->dev->dev_private;
568
569 radeon_legacy_primary_dac_dpms(encoder, DRM_MODE_DPMS_ON);
570
571 if (rdev->is_atom_bios)
572 radeon_atom_output_lock(encoder, false);
573 else
574 radeon_combios_output_lock(encoder, false);
575}
576
577static void radeon_legacy_primary_dac_mode_set(struct drm_encoder *encoder,
578 struct drm_display_mode *mode,
579 struct drm_display_mode *adjusted_mode)
580{
581 struct drm_device *dev = encoder->dev;
582 struct radeon_device *rdev = dev->dev_private;
583 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
584 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
585 uint32_t disp_output_cntl, dac_cntl, dac2_cntl, dac_macro_cntl;
586
d9fdaafb 587 DRM_DEBUG_KMS("\n");
771fe6b9 588
771fe6b9
JG
589 if (radeon_crtc->crtc_id == 0) {
590 if (rdev->family == CHIP_R200 || ASIC_IS_R300(rdev)) {
591 disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL) &
592 ~(RADEON_DISP_DAC_SOURCE_MASK);
593 WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
594 } else {
595 dac2_cntl = RREG32(RADEON_DAC_CNTL2) & ~(RADEON_DAC2_DAC_CLK_SEL);
596 WREG32(RADEON_DAC_CNTL2, dac2_cntl);
597 }
598 } else {
599 if (rdev->family == CHIP_R200 || ASIC_IS_R300(rdev)) {
600 disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL) &
601 ~(RADEON_DISP_DAC_SOURCE_MASK);
602 disp_output_cntl |= RADEON_DISP_DAC_SOURCE_CRTC2;
603 WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
604 } else {
605 dac2_cntl = RREG32(RADEON_DAC_CNTL2) | RADEON_DAC2_DAC_CLK_SEL;
606 WREG32(RADEON_DAC_CNTL2, dac2_cntl);
607 }
608 }
609
610 dac_cntl = (RADEON_DAC_MASK_ALL |
611 RADEON_DAC_VGA_ADR_EN |
612 /* TODO 6-bits */
613 RADEON_DAC_8BIT_EN);
614
615 WREG32_P(RADEON_DAC_CNTL,
616 dac_cntl,
617 RADEON_DAC_RANGE_CNTL |
618 RADEON_DAC_BLANKING);
619
620 if (radeon_encoder->enc_priv) {
621 struct radeon_encoder_primary_dac *p_dac = (struct radeon_encoder_primary_dac *)radeon_encoder->enc_priv;
622 dac_macro_cntl = p_dac->ps2_pdac_adj;
623 } else
624 dac_macro_cntl = RREG32(RADEON_DAC_MACRO_CNTL);
625 dac_macro_cntl |= RADEON_DAC_PDWN_R | RADEON_DAC_PDWN_G | RADEON_DAC_PDWN_B;
626 WREG32(RADEON_DAC_MACRO_CNTL, dac_macro_cntl);
627
628 if (rdev->is_atom_bios)
629 radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
630 else
631 radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
632}
633
634static enum drm_connector_status radeon_legacy_primary_dac_detect(struct drm_encoder *encoder,
635 struct drm_connector *connector)
636{
637 struct drm_device *dev = encoder->dev;
638 struct radeon_device *rdev = dev->dev_private;
639 uint32_t vclk_ecp_cntl, crtc_ext_cntl;
640 uint32_t dac_ext_cntl, dac_cntl, dac_macro_cntl, tmp;
641 enum drm_connector_status found = connector_status_disconnected;
642 bool color = true;
643
51861d4e
JG
644 /* just don't bother on RN50 those chip are often connected to remoting
645 * console hw and often we get failure to load detect those. So to make
646 * everyone happy report the encoder as always connected.
647 */
648 if (ASIC_IS_RN50(rdev)) {
649 return connector_status_connected;
650 }
651
771fe6b9
JG
652 /* save the regs we need */
653 vclk_ecp_cntl = RREG32_PLL(RADEON_VCLK_ECP_CNTL);
654 crtc_ext_cntl = RREG32(RADEON_CRTC_EXT_CNTL);
655 dac_ext_cntl = RREG32(RADEON_DAC_EXT_CNTL);
656 dac_cntl = RREG32(RADEON_DAC_CNTL);
657 dac_macro_cntl = RREG32(RADEON_DAC_MACRO_CNTL);
658
659 tmp = vclk_ecp_cntl &
660 ~(RADEON_PIXCLK_ALWAYS_ONb | RADEON_PIXCLK_DAC_ALWAYS_ONb);
661 WREG32_PLL(RADEON_VCLK_ECP_CNTL, tmp);
662
663 tmp = crtc_ext_cntl | RADEON_CRTC_CRT_ON;
664 WREG32(RADEON_CRTC_EXT_CNTL, tmp);
665
666 tmp = RADEON_DAC_FORCE_BLANK_OFF_EN |
667 RADEON_DAC_FORCE_DATA_EN;
668
669 if (color)
670 tmp |= RADEON_DAC_FORCE_DATA_SEL_RGB;
671 else
672 tmp |= RADEON_DAC_FORCE_DATA_SEL_G;
673
674 if (ASIC_IS_R300(rdev))
675 tmp |= (0x1b6 << RADEON_DAC_FORCE_DATA_SHIFT);
9c50b1d9
EE
676 else if (ASIC_IS_RV100(rdev))
677 tmp |= (0x1ac << RADEON_DAC_FORCE_DATA_SHIFT);
771fe6b9
JG
678 else
679 tmp |= (0x180 << RADEON_DAC_FORCE_DATA_SHIFT);
680
681 WREG32(RADEON_DAC_EXT_CNTL, tmp);
682
683 tmp = dac_cntl & ~(RADEON_DAC_RANGE_CNTL_MASK | RADEON_DAC_PDWN);
684 tmp |= RADEON_DAC_RANGE_CNTL_PS2 | RADEON_DAC_CMP_EN;
685 WREG32(RADEON_DAC_CNTL, tmp);
686
83325d07 687 tmp = dac_macro_cntl;
771fe6b9
JG
688 tmp &= ~(RADEON_DAC_PDWN_R |
689 RADEON_DAC_PDWN_G |
690 RADEON_DAC_PDWN_B);
691
692 WREG32(RADEON_DAC_MACRO_CNTL, tmp);
693
4de833c3 694 mdelay(2);
771fe6b9
JG
695
696 if (RREG32(RADEON_DAC_CNTL) & RADEON_DAC_CMP_OUTPUT)
697 found = connector_status_connected;
698
699 /* restore the regs we used */
700 WREG32(RADEON_DAC_CNTL, dac_cntl);
701 WREG32(RADEON_DAC_MACRO_CNTL, dac_macro_cntl);
702 WREG32(RADEON_DAC_EXT_CNTL, dac_ext_cntl);
703 WREG32(RADEON_CRTC_EXT_CNTL, crtc_ext_cntl);
704 WREG32_PLL(RADEON_VCLK_ECP_CNTL, vclk_ecp_cntl);
705
706 return found;
707}
708
709static const struct drm_encoder_helper_funcs radeon_legacy_primary_dac_helper_funcs = {
710 .dpms = radeon_legacy_primary_dac_dpms,
80297e87 711 .mode_fixup = radeon_legacy_mode_fixup,
771fe6b9
JG
712 .prepare = radeon_legacy_primary_dac_prepare,
713 .mode_set = radeon_legacy_primary_dac_mode_set,
714 .commit = radeon_legacy_primary_dac_commit,
715 .detect = radeon_legacy_primary_dac_detect,
4ce001ab 716 .disable = radeon_legacy_encoder_disable,
771fe6b9
JG
717};
718
719
720static const struct drm_encoder_funcs radeon_legacy_primary_dac_enc_funcs = {
721 .destroy = radeon_enc_destroy,
722};
723
771fe6b9
JG
724static void radeon_legacy_tmds_int_dpms(struct drm_encoder *encoder, int mode)
725{
726 struct drm_device *dev = encoder->dev;
727 struct radeon_device *rdev = dev->dev_private;
728 uint32_t fp_gen_cntl = RREG32(RADEON_FP_GEN_CNTL);
d9fdaafb 729 DRM_DEBUG_KMS("\n");
771fe6b9
JG
730
731 switch (mode) {
732 case DRM_MODE_DPMS_ON:
733 fp_gen_cntl |= (RADEON_FP_FPON | RADEON_FP_TMDS_EN);
734 break;
735 case DRM_MODE_DPMS_STANDBY:
736 case DRM_MODE_DPMS_SUSPEND:
737 case DRM_MODE_DPMS_OFF:
738 fp_gen_cntl &= ~(RADEON_FP_FPON | RADEON_FP_TMDS_EN);
739 break;
740 }
741
742 WREG32(RADEON_FP_GEN_CNTL, fp_gen_cntl);
743
744 if (rdev->is_atom_bios)
745 radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
746 else
747 radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
c913e23a 748
771fe6b9
JG
749}
750
751static void radeon_legacy_tmds_int_prepare(struct drm_encoder *encoder)
752{
753 struct radeon_device *rdev = encoder->dev->dev_private;
754
755 if (rdev->is_atom_bios)
756 radeon_atom_output_lock(encoder, true);
757 else
758 radeon_combios_output_lock(encoder, true);
759 radeon_legacy_tmds_int_dpms(encoder, DRM_MODE_DPMS_OFF);
760}
761
762static void radeon_legacy_tmds_int_commit(struct drm_encoder *encoder)
763{
764 struct radeon_device *rdev = encoder->dev->dev_private;
765
766 radeon_legacy_tmds_int_dpms(encoder, DRM_MODE_DPMS_ON);
767
768 if (rdev->is_atom_bios)
769 radeon_atom_output_lock(encoder, true);
770 else
771 radeon_combios_output_lock(encoder, true);
772}
773
774static void radeon_legacy_tmds_int_mode_set(struct drm_encoder *encoder,
775 struct drm_display_mode *mode,
776 struct drm_display_mode *adjusted_mode)
777{
778 struct drm_device *dev = encoder->dev;
779 struct radeon_device *rdev = dev->dev_private;
780 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
781 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
782 uint32_t tmp, tmds_pll_cntl, tmds_transmitter_cntl, fp_gen_cntl;
783 int i;
784
d9fdaafb 785 DRM_DEBUG_KMS("\n");
771fe6b9 786
771fe6b9
JG
787 tmp = tmds_pll_cntl = RREG32(RADEON_TMDS_PLL_CNTL);
788 tmp &= 0xfffff;
789 if (rdev->family == CHIP_RV280) {
790 /* bit 22 of TMDS_PLL_CNTL is read-back inverted */
791 tmp ^= (1 << 22);
792 tmds_pll_cntl ^= (1 << 22);
793 }
794
795 if (radeon_encoder->enc_priv) {
796 struct radeon_encoder_int_tmds *tmds = (struct radeon_encoder_int_tmds *)radeon_encoder->enc_priv;
797
798 for (i = 0; i < 4; i++) {
799 if (tmds->tmds_pll[i].freq == 0)
800 break;
801 if ((uint32_t)(mode->clock / 10) < tmds->tmds_pll[i].freq) {
802 tmp = tmds->tmds_pll[i].value ;
803 break;
804 }
805 }
806 }
807
808 if (ASIC_IS_R300(rdev) || (rdev->family == CHIP_RV280)) {
809 if (tmp & 0xfff00000)
810 tmds_pll_cntl = tmp;
811 else {
812 tmds_pll_cntl &= 0xfff00000;
813 tmds_pll_cntl |= tmp;
814 }
815 } else
816 tmds_pll_cntl = tmp;
817
818 tmds_transmitter_cntl = RREG32(RADEON_TMDS_TRANSMITTER_CNTL) &
819 ~(RADEON_TMDS_TRANSMITTER_PLLRST);
820
3cf8bb1a
JG
821 if (rdev->family == CHIP_R200 ||
822 rdev->family == CHIP_R100 ||
823 ASIC_IS_R300(rdev))
824 tmds_transmitter_cntl &= ~(RADEON_TMDS_TRANSMITTER_PLLEN);
825 else /* RV chips got this bit reversed */
826 tmds_transmitter_cntl |= RADEON_TMDS_TRANSMITTER_PLLEN;
827
828 fp_gen_cntl = (RREG32(RADEON_FP_GEN_CNTL) |
829 (RADEON_FP_CRTC_DONT_SHADOW_VPAR |
830 RADEON_FP_CRTC_DONT_SHADOW_HEND));
831
832 fp_gen_cntl &= ~(RADEON_FP_FPON | RADEON_FP_TMDS_EN);
833
834 fp_gen_cntl &= ~(RADEON_FP_RMX_HVSYNC_CONTROL_EN |
835 RADEON_FP_DFP_SYNC_SEL |
836 RADEON_FP_CRT_SYNC_SEL |
837 RADEON_FP_CRTC_LOCK_8DOT |
838 RADEON_FP_USE_SHADOW_EN |
839 RADEON_FP_CRTC_USE_SHADOW_VEND |
840 RADEON_FP_CRT_SYNC_ALT);
841
842 if (1) /* FIXME rgbBits == 8 */
843 fp_gen_cntl |= RADEON_FP_PANEL_FORMAT; /* 24 bit format */
844 else
845 fp_gen_cntl &= ~RADEON_FP_PANEL_FORMAT;/* 18 bit format */
846
847 if (radeon_crtc->crtc_id == 0) {
848 if (ASIC_IS_R300(rdev) || rdev->family == CHIP_R200) {
849 fp_gen_cntl &= ~R200_FP_SOURCE_SEL_MASK;
850 if (radeon_encoder->rmx_type != RMX_OFF)
851 fp_gen_cntl |= R200_FP_SOURCE_SEL_RMX;
852 else
853 fp_gen_cntl |= R200_FP_SOURCE_SEL_CRTC1;
854 } else
855 fp_gen_cntl &= ~RADEON_FP_SEL_CRTC2;
856 } else {
857 if (ASIC_IS_R300(rdev) || rdev->family == CHIP_R200) {
858 fp_gen_cntl &= ~R200_FP_SOURCE_SEL_MASK;
859 fp_gen_cntl |= R200_FP_SOURCE_SEL_CRTC2;
860 } else
861 fp_gen_cntl |= RADEON_FP_SEL_CRTC2;
862 }
863
864 WREG32(RADEON_TMDS_PLL_CNTL, tmds_pll_cntl);
865 WREG32(RADEON_TMDS_TRANSMITTER_CNTL, tmds_transmitter_cntl);
866 WREG32(RADEON_FP_GEN_CNTL, fp_gen_cntl);
771fe6b9
JG
867
868 if (rdev->is_atom_bios)
869 radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
870 else
871 radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
872}
873
874static const struct drm_encoder_helper_funcs radeon_legacy_tmds_int_helper_funcs = {
875 .dpms = radeon_legacy_tmds_int_dpms,
80297e87 876 .mode_fixup = radeon_legacy_mode_fixup,
771fe6b9
JG
877 .prepare = radeon_legacy_tmds_int_prepare,
878 .mode_set = radeon_legacy_tmds_int_mode_set,
879 .commit = radeon_legacy_tmds_int_commit,
4ce001ab 880 .disable = radeon_legacy_encoder_disable,
771fe6b9
JG
881};
882
883
884static const struct drm_encoder_funcs radeon_legacy_tmds_int_enc_funcs = {
885 .destroy = radeon_enc_destroy,
886};
887
771fe6b9
JG
888static void radeon_legacy_tmds_ext_dpms(struct drm_encoder *encoder, int mode)
889{
890 struct drm_device *dev = encoder->dev;
891 struct radeon_device *rdev = dev->dev_private;
892 uint32_t fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
d9fdaafb 893 DRM_DEBUG_KMS("\n");
771fe6b9
JG
894
895 switch (mode) {
896 case DRM_MODE_DPMS_ON:
897 fp2_gen_cntl &= ~RADEON_FP2_BLANK_EN;
898 fp2_gen_cntl |= (RADEON_FP2_ON | RADEON_FP2_DVO_EN);
899 break;
900 case DRM_MODE_DPMS_STANDBY:
901 case DRM_MODE_DPMS_SUSPEND:
902 case DRM_MODE_DPMS_OFF:
903 fp2_gen_cntl |= RADEON_FP2_BLANK_EN;
904 fp2_gen_cntl &= ~(RADEON_FP2_ON | RADEON_FP2_DVO_EN);
905 break;
906 }
907
908 WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
909
910 if (rdev->is_atom_bios)
911 radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
912 else
913 radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
c913e23a 914
771fe6b9
JG
915}
916
917static void radeon_legacy_tmds_ext_prepare(struct drm_encoder *encoder)
918{
919 struct radeon_device *rdev = encoder->dev->dev_private;
920
921 if (rdev->is_atom_bios)
922 radeon_atom_output_lock(encoder, true);
923 else
924 radeon_combios_output_lock(encoder, true);
925 radeon_legacy_tmds_ext_dpms(encoder, DRM_MODE_DPMS_OFF);
926}
927
928static void radeon_legacy_tmds_ext_commit(struct drm_encoder *encoder)
929{
930 struct radeon_device *rdev = encoder->dev->dev_private;
931 radeon_legacy_tmds_ext_dpms(encoder, DRM_MODE_DPMS_ON);
932
933 if (rdev->is_atom_bios)
934 radeon_atom_output_lock(encoder, false);
935 else
936 radeon_combios_output_lock(encoder, false);
937}
938
939static void radeon_legacy_tmds_ext_mode_set(struct drm_encoder *encoder,
940 struct drm_display_mode *mode,
941 struct drm_display_mode *adjusted_mode)
942{
943 struct drm_device *dev = encoder->dev;
944 struct radeon_device *rdev = dev->dev_private;
945 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
946 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
947 uint32_t fp2_gen_cntl;
948
d9fdaafb 949 DRM_DEBUG_KMS("\n");
771fe6b9 950
771fe6b9
JG
951 if (rdev->is_atom_bios) {
952 radeon_encoder->pixel_clock = adjusted_mode->clock;
99999aaa 953 atombios_dvo_setup(encoder, ATOM_ENABLE);
771fe6b9
JG
954 fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
955 } else {
956 fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
957
958 if (1) /* FIXME rgbBits == 8 */
959 fp2_gen_cntl |= RADEON_FP2_PANEL_FORMAT; /* 24 bit format, */
960 else
961 fp2_gen_cntl &= ~RADEON_FP2_PANEL_FORMAT;/* 18 bit format, */
962
963 fp2_gen_cntl &= ~(RADEON_FP2_ON |
964 RADEON_FP2_DVO_EN |
965 RADEON_FP2_DVO_RATE_SEL_SDR);
966
967 /* XXX: these are oem specific */
968 if (ASIC_IS_R300(rdev)) {
969 if ((dev->pdev->device == 0x4850) &&
970 (dev->pdev->subsystem_vendor == 0x1028) &&
971 (dev->pdev->subsystem_device == 0x2001)) /* Dell Inspiron 8600 */
972 fp2_gen_cntl |= R300_FP2_DVO_CLOCK_MODE_SINGLE;
973 else
974 fp2_gen_cntl |= RADEON_FP2_PAD_FLOP_EN | R300_FP2_DVO_CLOCK_MODE_SINGLE;
975
976 /*if (mode->clock > 165000)
977 fp2_gen_cntl |= R300_FP2_DVO_DUAL_CHANNEL_EN;*/
978 }
fcec570b
AD
979 if (!radeon_combios_external_tmds_setup(encoder))
980 radeon_external_tmds_setup(encoder);
771fe6b9
JG
981 }
982
983 if (radeon_crtc->crtc_id == 0) {
984 if ((rdev->family == CHIP_R200) || ASIC_IS_R300(rdev)) {
985 fp2_gen_cntl &= ~R200_FP2_SOURCE_SEL_MASK;
c93bb85b 986 if (radeon_encoder->rmx_type != RMX_OFF)
771fe6b9
JG
987 fp2_gen_cntl |= R200_FP2_SOURCE_SEL_RMX;
988 else
989 fp2_gen_cntl |= R200_FP2_SOURCE_SEL_CRTC1;
990 } else
991 fp2_gen_cntl &= ~RADEON_FP2_SRC_SEL_CRTC2;
992 } else {
993 if ((rdev->family == CHIP_R200) || ASIC_IS_R300(rdev)) {
994 fp2_gen_cntl &= ~R200_FP2_SOURCE_SEL_MASK;
995 fp2_gen_cntl |= R200_FP2_SOURCE_SEL_CRTC2;
996 } else
997 fp2_gen_cntl |= RADEON_FP2_SRC_SEL_CRTC2;
998 }
999
1000 WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
1001
1002 if (rdev->is_atom_bios)
1003 radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
1004 else
1005 radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
1006}
1007
fcec570b
AD
1008static void radeon_ext_tmds_enc_destroy(struct drm_encoder *encoder)
1009{
1010 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
08291847 1011 /* don't destroy the i2c bus record here, this will be done in radeon_i2c_fini */
fcec570b
AD
1012 kfree(radeon_encoder->enc_priv);
1013 drm_encoder_cleanup(encoder);
1014 kfree(radeon_encoder);
1015}
1016
771fe6b9
JG
1017static const struct drm_encoder_helper_funcs radeon_legacy_tmds_ext_helper_funcs = {
1018 .dpms = radeon_legacy_tmds_ext_dpms,
80297e87 1019 .mode_fixup = radeon_legacy_mode_fixup,
771fe6b9
JG
1020 .prepare = radeon_legacy_tmds_ext_prepare,
1021 .mode_set = radeon_legacy_tmds_ext_mode_set,
1022 .commit = radeon_legacy_tmds_ext_commit,
4ce001ab 1023 .disable = radeon_legacy_encoder_disable,
771fe6b9
JG
1024};
1025
1026
1027static const struct drm_encoder_funcs radeon_legacy_tmds_ext_enc_funcs = {
fcec570b 1028 .destroy = radeon_ext_tmds_enc_destroy,
771fe6b9
JG
1029};
1030
771fe6b9
JG
1031static void radeon_legacy_tv_dac_dpms(struct drm_encoder *encoder, int mode)
1032{
1033 struct drm_device *dev = encoder->dev;
1034 struct radeon_device *rdev = dev->dev_private;
4ce001ab 1035 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
771fe6b9 1036 uint32_t fp2_gen_cntl = 0, crtc2_gen_cntl = 0, tv_dac_cntl = 0;
4ce001ab
DA
1037 uint32_t tv_master_cntl = 0;
1038 bool is_tv;
d9fdaafb 1039 DRM_DEBUG_KMS("\n");
771fe6b9 1040
4ce001ab
DA
1041 is_tv = radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT ? true : false;
1042
771fe6b9
JG
1043 if (rdev->family == CHIP_R200)
1044 fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
1045 else {
4ce001ab
DA
1046 if (is_tv)
1047 tv_master_cntl = RREG32(RADEON_TV_MASTER_CNTL);
1048 else
1049 crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
771fe6b9
JG
1050 tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
1051 }
1052
1053 switch (mode) {
1054 case DRM_MODE_DPMS_ON:
1055 if (rdev->family == CHIP_R200) {
1056 fp2_gen_cntl |= (RADEON_FP2_ON | RADEON_FP2_DVO_EN);
1057 } else {
4ce001ab
DA
1058 if (is_tv)
1059 tv_master_cntl |= RADEON_TV_ON;
1060 else
1061 crtc2_gen_cntl |= RADEON_CRTC2_CRT2_ON;
1062
771fe6b9 1063 if (rdev->family == CHIP_R420 ||
4ce001ab
DA
1064 rdev->family == CHIP_R423 ||
1065 rdev->family == CHIP_RV410)
771fe6b9 1066 tv_dac_cntl &= ~(R420_TV_DAC_RDACPD |
4ce001ab
DA
1067 R420_TV_DAC_GDACPD |
1068 R420_TV_DAC_BDACPD |
1069 RADEON_TV_DAC_BGSLEEP);
771fe6b9
JG
1070 else
1071 tv_dac_cntl &= ~(RADEON_TV_DAC_RDACPD |
4ce001ab
DA
1072 RADEON_TV_DAC_GDACPD |
1073 RADEON_TV_DAC_BDACPD |
1074 RADEON_TV_DAC_BGSLEEP);
771fe6b9
JG
1075 }
1076 break;
1077 case DRM_MODE_DPMS_STANDBY:
1078 case DRM_MODE_DPMS_SUSPEND:
1079 case DRM_MODE_DPMS_OFF:
1080 if (rdev->family == CHIP_R200)
1081 fp2_gen_cntl &= ~(RADEON_FP2_ON | RADEON_FP2_DVO_EN);
1082 else {
4ce001ab
DA
1083 if (is_tv)
1084 tv_master_cntl &= ~RADEON_TV_ON;
1085 else
1086 crtc2_gen_cntl &= ~RADEON_CRTC2_CRT2_ON;
1087
771fe6b9 1088 if (rdev->family == CHIP_R420 ||
77416187
AD
1089 rdev->family == CHIP_R423 ||
1090 rdev->family == CHIP_RV410)
771fe6b9
JG
1091 tv_dac_cntl |= (R420_TV_DAC_RDACPD |
1092 R420_TV_DAC_GDACPD |
1093 R420_TV_DAC_BDACPD |
1094 RADEON_TV_DAC_BGSLEEP);
1095 else
1096 tv_dac_cntl |= (RADEON_TV_DAC_RDACPD |
1097 RADEON_TV_DAC_GDACPD |
1098 RADEON_TV_DAC_BDACPD |
1099 RADEON_TV_DAC_BGSLEEP);
1100 }
1101 break;
1102 }
1103
1104 if (rdev->family == CHIP_R200) {
1105 WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
1106 } else {
4ce001ab
DA
1107 if (is_tv)
1108 WREG32(RADEON_TV_MASTER_CNTL, tv_master_cntl);
f8c4d701
EE
1109 /* handled in radeon_crtc_dpms() */
1110 else if (!(rdev->flags & RADEON_SINGLE_CRTC))
4ce001ab 1111 WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
771fe6b9
JG
1112 WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
1113 }
1114
1115 if (rdev->is_atom_bios)
1116 radeon_atombios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
1117 else
1118 radeon_combios_encoder_dpms_scratch_regs(encoder, (mode == DRM_MODE_DPMS_ON) ? true : false);
c913e23a 1119
771fe6b9
JG
1120}
1121
1122static void radeon_legacy_tv_dac_prepare(struct drm_encoder *encoder)
1123{
1124 struct radeon_device *rdev = encoder->dev->dev_private;
1125
1126 if (rdev->is_atom_bios)
1127 radeon_atom_output_lock(encoder, true);
1128 else
1129 radeon_combios_output_lock(encoder, true);
1130 radeon_legacy_tv_dac_dpms(encoder, DRM_MODE_DPMS_OFF);
1131}
1132
1133static void radeon_legacy_tv_dac_commit(struct drm_encoder *encoder)
1134{
1135 struct radeon_device *rdev = encoder->dev->dev_private;
1136
1137 radeon_legacy_tv_dac_dpms(encoder, DRM_MODE_DPMS_ON);
1138
1139 if (rdev->is_atom_bios)
1140 radeon_atom_output_lock(encoder, true);
1141 else
1142 radeon_combios_output_lock(encoder, true);
1143}
1144
1145static void radeon_legacy_tv_dac_mode_set(struct drm_encoder *encoder,
1146 struct drm_display_mode *mode,
1147 struct drm_display_mode *adjusted_mode)
1148{
1149 struct drm_device *dev = encoder->dev;
1150 struct radeon_device *rdev = dev->dev_private;
1151 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
1152 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
4ce001ab 1153 struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
771fe6b9 1154 uint32_t tv_dac_cntl, gpiopad_a = 0, dac2_cntl, disp_output_cntl = 0;
4ce001ab
DA
1155 uint32_t disp_hw_debug = 0, fp2_gen_cntl = 0, disp_tv_out_cntl = 0;
1156 bool is_tv = false;
771fe6b9 1157
d9fdaafb 1158 DRM_DEBUG_KMS("\n");
771fe6b9 1159
4ce001ab
DA
1160 is_tv = radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT ? true : false;
1161
771fe6b9
JG
1162 if (rdev->family != CHIP_R200) {
1163 tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
1164 if (rdev->family == CHIP_R420 ||
77416187
AD
1165 rdev->family == CHIP_R423 ||
1166 rdev->family == CHIP_RV410) {
771fe6b9 1167 tv_dac_cntl &= ~(RADEON_TV_DAC_STD_MASK |
77416187
AD
1168 RADEON_TV_DAC_BGADJ_MASK |
1169 R420_TV_DAC_DACADJ_MASK |
1170 R420_TV_DAC_RDACPD |
1171 R420_TV_DAC_GDACPD |
1172 R420_TV_DAC_BDACPD |
1173 R420_TV_DAC_TVENABLE);
771fe6b9
JG
1174 } else {
1175 tv_dac_cntl &= ~(RADEON_TV_DAC_STD_MASK |
77416187
AD
1176 RADEON_TV_DAC_BGADJ_MASK |
1177 RADEON_TV_DAC_DACADJ_MASK |
1178 RADEON_TV_DAC_RDACPD |
1179 RADEON_TV_DAC_GDACPD |
1180 RADEON_TV_DAC_BDACPD);
771fe6b9
JG
1181 }
1182
77416187
AD
1183 tv_dac_cntl |= RADEON_TV_DAC_NBLANK | RADEON_TV_DAC_NHOLD;
1184
1185 if (is_tv) {
1186 if (tv_dac->tv_std == TV_STD_NTSC ||
1187 tv_dac->tv_std == TV_STD_NTSC_J ||
1188 tv_dac->tv_std == TV_STD_PAL_M ||
1189 tv_dac->tv_std == TV_STD_PAL_60)
1190 tv_dac_cntl |= tv_dac->ntsc_tvdac_adj;
1191 else
1192 tv_dac_cntl |= tv_dac->pal_tvdac_adj;
1193
1194 if (tv_dac->tv_std == TV_STD_NTSC ||
1195 tv_dac->tv_std == TV_STD_NTSC_J)
1196 tv_dac_cntl |= RADEON_TV_DAC_STD_NTSC;
1197 else
1198 tv_dac_cntl |= RADEON_TV_DAC_STD_PAL;
771fe6b9 1199 } else
77416187
AD
1200 tv_dac_cntl |= (RADEON_TV_DAC_STD_PS2 |
1201 tv_dac->ps2_tvdac_adj);
771fe6b9
JG
1202
1203 WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
1204 }
1205
1206 if (ASIC_IS_R300(rdev)) {
1207 gpiopad_a = RREG32(RADEON_GPIOPAD_A) | 1;
1208 disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL);
1ab064de 1209 } else if (rdev->family != CHIP_R200)
771fe6b9 1210 disp_hw_debug = RREG32(RADEON_DISP_HW_DEBUG);
1ab064de 1211 else if (rdev->family == CHIP_R200)
4ce001ab 1212 fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
771fe6b9 1213
1ab064de
DA
1214 if (rdev->family >= CHIP_R200)
1215 disp_tv_out_cntl = RREG32(RADEON_DISP_TV_OUT_CNTL);
1216
4ce001ab
DA
1217 if (is_tv) {
1218 uint32_t dac_cntl;
1219
1220 dac_cntl = RREG32(RADEON_DAC_CNTL);
1221 dac_cntl &= ~RADEON_DAC_TVO_EN;
1222 WREG32(RADEON_DAC_CNTL, dac_cntl);
1223
1224 if (ASIC_IS_R300(rdev))
1225 gpiopad_a = RREG32(RADEON_GPIOPAD_A) & ~1;
1226
1227 dac2_cntl = RREG32(RADEON_DAC_CNTL2) & ~RADEON_DAC2_DAC2_CLK_SEL;
1228 if (radeon_crtc->crtc_id == 0) {
1229 if (ASIC_IS_R300(rdev)) {
1230 disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
1231 disp_output_cntl |= (RADEON_DISP_TVDAC_SOURCE_CRTC |
1232 RADEON_DISP_TV_SOURCE_CRTC);
1233 }
1234 if (rdev->family >= CHIP_R200) {
1235 disp_tv_out_cntl &= ~RADEON_DISP_TV_PATH_SRC_CRTC2;
1236 } else {
1237 disp_hw_debug |= RADEON_CRT2_DISP1_SEL;
1238 }
1239 } else {
1240 if (ASIC_IS_R300(rdev)) {
1241 disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
1242 disp_output_cntl |= RADEON_DISP_TV_SOURCE_CRTC;
1243 }
1244 if (rdev->family >= CHIP_R200) {
1245 disp_tv_out_cntl |= RADEON_DISP_TV_PATH_SRC_CRTC2;
1246 } else {
1247 disp_hw_debug &= ~RADEON_CRT2_DISP1_SEL;
1248 }
1249 }
1250 WREG32(RADEON_DAC_CNTL2, dac2_cntl);
771fe6b9 1251 } else {
771fe6b9 1252
4ce001ab
DA
1253 dac2_cntl = RREG32(RADEON_DAC_CNTL2) | RADEON_DAC2_DAC2_CLK_SEL;
1254
1255 if (radeon_crtc->crtc_id == 0) {
1256 if (ASIC_IS_R300(rdev)) {
1257 disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
1258 disp_output_cntl |= RADEON_DISP_TVDAC_SOURCE_CRTC;
1259 } else if (rdev->family == CHIP_R200) {
1260 fp2_gen_cntl &= ~(R200_FP2_SOURCE_SEL_MASK |
1261 RADEON_FP2_DVO_RATE_SEL_SDR);
1262 } else
1263 disp_hw_debug |= RADEON_CRT2_DISP1_SEL;
1264 } else {
1265 if (ASIC_IS_R300(rdev)) {
1266 disp_output_cntl &= ~RADEON_DISP_TVDAC_SOURCE_MASK;
1267 disp_output_cntl |= RADEON_DISP_TVDAC_SOURCE_CRTC2;
1268 } else if (rdev->family == CHIP_R200) {
1269 fp2_gen_cntl &= ~(R200_FP2_SOURCE_SEL_MASK |
1270 RADEON_FP2_DVO_RATE_SEL_SDR);
1271 fp2_gen_cntl |= R200_FP2_SOURCE_SEL_CRTC2;
1272 } else
1273 disp_hw_debug &= ~RADEON_CRT2_DISP1_SEL;
1274 }
1275 WREG32(RADEON_DAC_CNTL2, dac2_cntl);
1276 }
771fe6b9
JG
1277
1278 if (ASIC_IS_R300(rdev)) {
1279 WREG32_P(RADEON_GPIOPAD_A, gpiopad_a, ~1);
4ce001ab 1280 WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
1ab064de
DA
1281 } else if (rdev->family != CHIP_R200)
1282 WREG32(RADEON_DISP_HW_DEBUG, disp_hw_debug);
1283 else if (rdev->family == CHIP_R200)
1284 WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
4ce001ab
DA
1285
1286 if (rdev->family >= CHIP_R200)
1287 WREG32(RADEON_DISP_TV_OUT_CNTL, disp_tv_out_cntl);
4ce001ab
DA
1288
1289 if (is_tv)
1290 radeon_legacy_tv_mode_set(encoder, mode, adjusted_mode);
1291
771fe6b9
JG
1292 if (rdev->is_atom_bios)
1293 radeon_atombios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
1294 else
1295 radeon_combios_encoder_crtc_scratch_regs(encoder, radeon_crtc->crtc_id);
1296
1297}
1298
4ce001ab
DA
1299static bool r300_legacy_tv_detect(struct drm_encoder *encoder,
1300 struct drm_connector *connector)
1301{
1302 struct drm_device *dev = encoder->dev;
1303 struct radeon_device *rdev = dev->dev_private;
1304 uint32_t crtc2_gen_cntl, tv_dac_cntl, dac_cntl2, dac_ext_cntl;
1305 uint32_t disp_output_cntl, gpiopad_a, tmp;
1306 bool found = false;
1307
1308 /* save regs needed */
1309 gpiopad_a = RREG32(RADEON_GPIOPAD_A);
1310 dac_cntl2 = RREG32(RADEON_DAC_CNTL2);
1311 crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
1312 dac_ext_cntl = RREG32(RADEON_DAC_EXT_CNTL);
1313 tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
1314 disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL);
1315
1316 WREG32_P(RADEON_GPIOPAD_A, 0, ~1);
1317
1318 WREG32(RADEON_DAC_CNTL2, RADEON_DAC2_DAC2_CLK_SEL);
1319
1320 WREG32(RADEON_CRTC2_GEN_CNTL,
1321 RADEON_CRTC2_CRT2_ON | RADEON_CRTC2_VSYNC_TRISTAT);
1322
1323 tmp = disp_output_cntl & ~RADEON_DISP_TVDAC_SOURCE_MASK;
1324 tmp |= RADEON_DISP_TVDAC_SOURCE_CRTC2;
1325 WREG32(RADEON_DISP_OUTPUT_CNTL, tmp);
1326
1327 WREG32(RADEON_DAC_EXT_CNTL,
1328 RADEON_DAC2_FORCE_BLANK_OFF_EN |
1329 RADEON_DAC2_FORCE_DATA_EN |
1330 RADEON_DAC_FORCE_DATA_SEL_RGB |
1331 (0xec << RADEON_DAC_FORCE_DATA_SHIFT));
1332
1333 WREG32(RADEON_TV_DAC_CNTL,
1334 RADEON_TV_DAC_STD_NTSC |
1335 (8 << RADEON_TV_DAC_BGADJ_SHIFT) |
1336 (6 << RADEON_TV_DAC_DACADJ_SHIFT));
1337
1338 RREG32(RADEON_TV_DAC_CNTL);
1339 mdelay(4);
1340
1341 WREG32(RADEON_TV_DAC_CNTL,
1342 RADEON_TV_DAC_NBLANK |
1343 RADEON_TV_DAC_NHOLD |
1344 RADEON_TV_MONITOR_DETECT_EN |
1345 RADEON_TV_DAC_STD_NTSC |
1346 (8 << RADEON_TV_DAC_BGADJ_SHIFT) |
1347 (6 << RADEON_TV_DAC_DACADJ_SHIFT));
1348
1349 RREG32(RADEON_TV_DAC_CNTL);
1350 mdelay(6);
1351
1352 tmp = RREG32(RADEON_TV_DAC_CNTL);
1353 if ((tmp & RADEON_TV_DAC_GDACDET) != 0) {
1354 found = true;
d9fdaafb 1355 DRM_DEBUG_KMS("S-video TV connection detected\n");
4ce001ab
DA
1356 } else if ((tmp & RADEON_TV_DAC_BDACDET) != 0) {
1357 found = true;
d9fdaafb 1358 DRM_DEBUG_KMS("Composite TV connection detected\n");
4ce001ab
DA
1359 }
1360
1361 WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
1362 WREG32(RADEON_DAC_EXT_CNTL, dac_ext_cntl);
1363 WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
1364 WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
1365 WREG32(RADEON_DAC_CNTL2, dac_cntl2);
1366 WREG32_P(RADEON_GPIOPAD_A, gpiopad_a, ~1);
1367 return found;
1368}
1369
1370static bool radeon_legacy_tv_detect(struct drm_encoder *encoder,
1371 struct drm_connector *connector)
1372{
1373 struct drm_device *dev = encoder->dev;
1374 struct radeon_device *rdev = dev->dev_private;
1375 uint32_t tv_dac_cntl, dac_cntl2;
1376 uint32_t config_cntl, tv_pre_dac_mux_cntl, tv_master_cntl, tmp;
1377 bool found = false;
1378
1379 if (ASIC_IS_R300(rdev))
1380 return r300_legacy_tv_detect(encoder, connector);
1381
1382 dac_cntl2 = RREG32(RADEON_DAC_CNTL2);
1383 tv_master_cntl = RREG32(RADEON_TV_MASTER_CNTL);
1384 tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
1385 config_cntl = RREG32(RADEON_CONFIG_CNTL);
1386 tv_pre_dac_mux_cntl = RREG32(RADEON_TV_PRE_DAC_MUX_CNTL);
1387
1388 tmp = dac_cntl2 & ~RADEON_DAC2_DAC2_CLK_SEL;
1389 WREG32(RADEON_DAC_CNTL2, tmp);
1390
1391 tmp = tv_master_cntl | RADEON_TV_ON;
1392 tmp &= ~(RADEON_TV_ASYNC_RST |
1393 RADEON_RESTART_PHASE_FIX |
1394 RADEON_CRT_FIFO_CE_EN |
1395 RADEON_TV_FIFO_CE_EN |
1396 RADEON_RE_SYNC_NOW_SEL_MASK);
1397 tmp |= RADEON_TV_FIFO_ASYNC_RST | RADEON_CRT_ASYNC_RST;
1398 WREG32(RADEON_TV_MASTER_CNTL, tmp);
1399
1400 tmp = RADEON_TV_DAC_NBLANK | RADEON_TV_DAC_NHOLD |
1401 RADEON_TV_MONITOR_DETECT_EN | RADEON_TV_DAC_STD_NTSC |
1402 (8 << RADEON_TV_DAC_BGADJ_SHIFT);
1403
1404 if (config_cntl & RADEON_CFG_ATI_REV_ID_MASK)
1405 tmp |= (4 << RADEON_TV_DAC_DACADJ_SHIFT);
1406 else
1407 tmp |= (8 << RADEON_TV_DAC_DACADJ_SHIFT);
1408 WREG32(RADEON_TV_DAC_CNTL, tmp);
1409
1410 tmp = RADEON_C_GRN_EN | RADEON_CMP_BLU_EN |
1411 RADEON_RED_MX_FORCE_DAC_DATA |
1412 RADEON_GRN_MX_FORCE_DAC_DATA |
1413 RADEON_BLU_MX_FORCE_DAC_DATA |
1414 (0x109 << RADEON_TV_FORCE_DAC_DATA_SHIFT);
1415 WREG32(RADEON_TV_PRE_DAC_MUX_CNTL, tmp);
1416
1417 mdelay(3);
1418 tmp = RREG32(RADEON_TV_DAC_CNTL);
1419 if (tmp & RADEON_TV_DAC_GDACDET) {
1420 found = true;
d9fdaafb 1421 DRM_DEBUG_KMS("S-video TV connection detected\n");
4ce001ab
DA
1422 } else if ((tmp & RADEON_TV_DAC_BDACDET) != 0) {
1423 found = true;
d9fdaafb 1424 DRM_DEBUG_KMS("Composite TV connection detected\n");
4ce001ab
DA
1425 }
1426
1427 WREG32(RADEON_TV_PRE_DAC_MUX_CNTL, tv_pre_dac_mux_cntl);
1428 WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
1429 WREG32(RADEON_TV_MASTER_CNTL, tv_master_cntl);
1430 WREG32(RADEON_DAC_CNTL2, dac_cntl2);
1431 return found;
1432}
1433
6d9cdfc2
AD
1434static bool radeon_legacy_ext_dac_detect(struct drm_encoder *encoder,
1435 struct drm_connector *connector)
1436{
1437 struct drm_device *dev = encoder->dev;
1438 struct radeon_device *rdev = dev->dev_private;
1439 uint32_t gpio_monid, fp2_gen_cntl, disp_output_cntl, crtc2_gen_cntl;
1440 uint32_t disp_lin_trans_grph_a, disp_lin_trans_grph_b, disp_lin_trans_grph_c;
1441 uint32_t disp_lin_trans_grph_d, disp_lin_trans_grph_e, disp_lin_trans_grph_f;
1442 uint32_t tmp, crtc2_h_total_disp, crtc2_v_total_disp;
1443 uint32_t crtc2_h_sync_strt_wid, crtc2_v_sync_strt_wid;
1444 bool found = false;
1445 int i;
1446
1447 /* save the regs we need */
1448 gpio_monid = RREG32(RADEON_GPIO_MONID);
1449 fp2_gen_cntl = RREG32(RADEON_FP2_GEN_CNTL);
1450 disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL);
1451 crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
1452 disp_lin_trans_grph_a = RREG32(RADEON_DISP_LIN_TRANS_GRPH_A);
1453 disp_lin_trans_grph_b = RREG32(RADEON_DISP_LIN_TRANS_GRPH_B);
1454 disp_lin_trans_grph_c = RREG32(RADEON_DISP_LIN_TRANS_GRPH_C);
1455 disp_lin_trans_grph_d = RREG32(RADEON_DISP_LIN_TRANS_GRPH_D);
1456 disp_lin_trans_grph_e = RREG32(RADEON_DISP_LIN_TRANS_GRPH_E);
1457 disp_lin_trans_grph_f = RREG32(RADEON_DISP_LIN_TRANS_GRPH_F);
1458 crtc2_h_total_disp = RREG32(RADEON_CRTC2_H_TOTAL_DISP);
1459 crtc2_v_total_disp = RREG32(RADEON_CRTC2_V_TOTAL_DISP);
1460 crtc2_h_sync_strt_wid = RREG32(RADEON_CRTC2_H_SYNC_STRT_WID);
1461 crtc2_v_sync_strt_wid = RREG32(RADEON_CRTC2_V_SYNC_STRT_WID);
1462
1463 tmp = RREG32(RADEON_GPIO_MONID);
1464 tmp &= ~RADEON_GPIO_A_0;
1465 WREG32(RADEON_GPIO_MONID, tmp);
1466
1467 WREG32(RADEON_FP2_GEN_CNTL, (RADEON_FP2_ON |
1468 RADEON_FP2_PANEL_FORMAT |
1469 R200_FP2_SOURCE_SEL_TRANS_UNIT |
1470 RADEON_FP2_DVO_EN |
1471 R200_FP2_DVO_RATE_SEL_SDR));
1472
1473 WREG32(RADEON_DISP_OUTPUT_CNTL, (RADEON_DISP_DAC_SOURCE_RMX |
1474 RADEON_DISP_TRANS_MATRIX_GRAPHICS));
1475
1476 WREG32(RADEON_CRTC2_GEN_CNTL, (RADEON_CRTC2_EN |
1477 RADEON_CRTC2_DISP_REQ_EN_B));
1478
1479 WREG32(RADEON_DISP_LIN_TRANS_GRPH_A, 0x00000000);
1480 WREG32(RADEON_DISP_LIN_TRANS_GRPH_B, 0x000003f0);
1481 WREG32(RADEON_DISP_LIN_TRANS_GRPH_C, 0x00000000);
1482 WREG32(RADEON_DISP_LIN_TRANS_GRPH_D, 0x000003f0);
1483 WREG32(RADEON_DISP_LIN_TRANS_GRPH_E, 0x00000000);
1484 WREG32(RADEON_DISP_LIN_TRANS_GRPH_F, 0x000003f0);
1485
1486 WREG32(RADEON_CRTC2_H_TOTAL_DISP, 0x01000008);
1487 WREG32(RADEON_CRTC2_H_SYNC_STRT_WID, 0x00000800);
1488 WREG32(RADEON_CRTC2_V_TOTAL_DISP, 0x00080001);
1489 WREG32(RADEON_CRTC2_V_SYNC_STRT_WID, 0x00000080);
1490
1491 for (i = 0; i < 200; i++) {
1492 tmp = RREG32(RADEON_GPIO_MONID);
1493 if (tmp & RADEON_GPIO_Y_0)
1494 found = true;
1495
1496 if (found)
1497 break;
1498
1499 if (!drm_can_sleep())
1500 mdelay(1);
1501 else
1502 msleep(1);
1503 }
1504
1505 /* restore the regs we used */
1506 WREG32(RADEON_DISP_LIN_TRANS_GRPH_A, disp_lin_trans_grph_a);
1507 WREG32(RADEON_DISP_LIN_TRANS_GRPH_B, disp_lin_trans_grph_b);
1508 WREG32(RADEON_DISP_LIN_TRANS_GRPH_C, disp_lin_trans_grph_c);
1509 WREG32(RADEON_DISP_LIN_TRANS_GRPH_D, disp_lin_trans_grph_d);
1510 WREG32(RADEON_DISP_LIN_TRANS_GRPH_E, disp_lin_trans_grph_e);
1511 WREG32(RADEON_DISP_LIN_TRANS_GRPH_F, disp_lin_trans_grph_f);
1512 WREG32(RADEON_CRTC2_H_TOTAL_DISP, crtc2_h_total_disp);
1513 WREG32(RADEON_CRTC2_V_TOTAL_DISP, crtc2_v_total_disp);
1514 WREG32(RADEON_CRTC2_H_SYNC_STRT_WID, crtc2_h_sync_strt_wid);
1515 WREG32(RADEON_CRTC2_V_SYNC_STRT_WID, crtc2_v_sync_strt_wid);
1516 WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
1517 WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
1518 WREG32(RADEON_FP2_GEN_CNTL, fp2_gen_cntl);
1519 WREG32(RADEON_GPIO_MONID, gpio_monid);
1520
1521 return found;
1522}
1523
771fe6b9
JG
1524static enum drm_connector_status radeon_legacy_tv_dac_detect(struct drm_encoder *encoder,
1525 struct drm_connector *connector)
1526{
1527 struct drm_device *dev = encoder->dev;
1528 struct radeon_device *rdev = dev->dev_private;
701337dc 1529 uint32_t crtc2_gen_cntl = 0, tv_dac_cntl, dac_cntl2, dac_ext_cntl;
d038db86 1530 uint32_t gpiopad_a = 0, pixclks_cntl, tmp;
701337dc 1531 uint32_t disp_output_cntl = 0, disp_hw_debug = 0, crtc_ext_cntl = 0;
771fe6b9 1532 enum drm_connector_status found = connector_status_disconnected;
4ce001ab
DA
1533 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
1534 struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
771fe6b9 1535 bool color = true;
b62e948f
DA
1536 struct drm_crtc *crtc;
1537
1538 /* find out if crtc2 is in use or if this encoder is using it */
1539 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
1540 struct radeon_crtc *radeon_crtc = to_radeon_crtc(crtc);
1541 if ((radeon_crtc->crtc_id == 1) && crtc->enabled) {
1542 if (encoder->crtc != crtc) {
1543 return connector_status_disconnected;
1544 }
1545 }
1546 }
771fe6b9 1547
4ce001ab
DA
1548 if (connector->connector_type == DRM_MODE_CONNECTOR_SVIDEO ||
1549 connector->connector_type == DRM_MODE_CONNECTOR_Composite ||
1550 connector->connector_type == DRM_MODE_CONNECTOR_9PinDIN) {
1551 bool tv_detect;
1552
1553 if (radeon_encoder->active_device && !(radeon_encoder->active_device & ATOM_DEVICE_TV_SUPPORT))
1554 return connector_status_disconnected;
1555
1556 tv_detect = radeon_legacy_tv_detect(encoder, connector);
1557 if (tv_detect && tv_dac)
1558 found = connector_status_connected;
1559 return found;
1560 }
1561
1562 /* don't probe if the encoder is being used for something else not CRT related */
1563 if (radeon_encoder->active_device && !(radeon_encoder->active_device & ATOM_DEVICE_CRT_SUPPORT)) {
1564 DRM_INFO("not detecting due to %08x\n", radeon_encoder->active_device);
1565 return connector_status_disconnected;
1566 }
771fe6b9 1567
6d9cdfc2
AD
1568 /* R200 uses an external DAC for secondary DAC */
1569 if (rdev->family == CHIP_R200) {
1570 if (radeon_legacy_ext_dac_detect(encoder, connector))
1571 found = connector_status_connected;
1572 return found;
1573 }
1574
771fe6b9
JG
1575 /* save the regs we need */
1576 pixclks_cntl = RREG32_PLL(RADEON_PIXCLKS_CNTL);
701337dc
EE
1577
1578 if (rdev->flags & RADEON_SINGLE_CRTC) {
1579 crtc_ext_cntl = RREG32(RADEON_CRTC_EXT_CNTL);
d038db86 1580 } else {
701337dc
EE
1581 if (ASIC_IS_R300(rdev)) {
1582 gpiopad_a = RREG32(RADEON_GPIOPAD_A);
1583 disp_output_cntl = RREG32(RADEON_DISP_OUTPUT_CNTL);
1584 } else {
1585 disp_hw_debug = RREG32(RADEON_DISP_HW_DEBUG);
1586 }
1587 crtc2_gen_cntl = RREG32(RADEON_CRTC2_GEN_CNTL);
d038db86 1588 }
771fe6b9
JG
1589 tv_dac_cntl = RREG32(RADEON_TV_DAC_CNTL);
1590 dac_ext_cntl = RREG32(RADEON_DAC_EXT_CNTL);
1591 dac_cntl2 = RREG32(RADEON_DAC_CNTL2);
1592
1593 tmp = pixclks_cntl & ~(RADEON_PIX2CLK_ALWAYS_ONb
1594 | RADEON_PIX2CLK_DAC_ALWAYS_ONb);
1595 WREG32_PLL(RADEON_PIXCLKS_CNTL, tmp);
1596
701337dc
EE
1597 if (rdev->flags & RADEON_SINGLE_CRTC) {
1598 tmp = crtc_ext_cntl | RADEON_CRTC_CRT_ON;
1599 WREG32(RADEON_CRTC_EXT_CNTL, tmp);
771fe6b9 1600 } else {
701337dc
EE
1601 tmp = crtc2_gen_cntl & ~RADEON_CRTC2_PIX_WIDTH_MASK;
1602 tmp |= RADEON_CRTC2_CRT2_ON |
1603 (2 << RADEON_CRTC2_PIX_WIDTH_SHIFT);
1604 WREG32(RADEON_CRTC2_GEN_CNTL, tmp);
1605
1606 if (ASIC_IS_R300(rdev)) {
1607 WREG32_P(RADEON_GPIOPAD_A, 1, ~1);
1608 tmp = disp_output_cntl & ~RADEON_DISP_TVDAC_SOURCE_MASK;
1609 tmp |= RADEON_DISP_TVDAC_SOURCE_CRTC2;
1610 WREG32(RADEON_DISP_OUTPUT_CNTL, tmp);
1611 } else {
1612 tmp = disp_hw_debug & ~RADEON_CRT2_DISP1_SEL;
1613 WREG32(RADEON_DISP_HW_DEBUG, tmp);
1614 }
771fe6b9
JG
1615 }
1616
1617 tmp = RADEON_TV_DAC_NBLANK |
1618 RADEON_TV_DAC_NHOLD |
1619 RADEON_TV_MONITOR_DETECT_EN |
1620 RADEON_TV_DAC_STD_PS2;
1621
1622 WREG32(RADEON_TV_DAC_CNTL, tmp);
1623
1624 tmp = RADEON_DAC2_FORCE_BLANK_OFF_EN |
1625 RADEON_DAC2_FORCE_DATA_EN;
1626
1627 if (color)
1628 tmp |= RADEON_DAC_FORCE_DATA_SEL_RGB;
1629 else
1630 tmp |= RADEON_DAC_FORCE_DATA_SEL_G;
1631
1632 if (ASIC_IS_R300(rdev))
1633 tmp |= (0x1b6 << RADEON_DAC_FORCE_DATA_SHIFT);
1634 else
1635 tmp |= (0x180 << RADEON_DAC_FORCE_DATA_SHIFT);
1636
1637 WREG32(RADEON_DAC_EXT_CNTL, tmp);
1638
1639 tmp = dac_cntl2 | RADEON_DAC2_DAC2_CLK_SEL | RADEON_DAC2_CMP_EN;
1640 WREG32(RADEON_DAC_CNTL2, tmp);
1641
4de833c3 1642 mdelay(10);
771fe6b9
JG
1643
1644 if (ASIC_IS_R300(rdev)) {
1645 if (RREG32(RADEON_DAC_CNTL2) & RADEON_DAC2_CMP_OUT_B)
1646 found = connector_status_connected;
1647 } else {
1648 if (RREG32(RADEON_DAC_CNTL2) & RADEON_DAC2_CMP_OUTPUT)
1649 found = connector_status_connected;
1650 }
1651
1652 /* restore regs we used */
1653 WREG32(RADEON_DAC_CNTL2, dac_cntl2);
1654 WREG32(RADEON_DAC_EXT_CNTL, dac_ext_cntl);
1655 WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
771fe6b9 1656
701337dc
EE
1657 if (rdev->flags & RADEON_SINGLE_CRTC) {
1658 WREG32(RADEON_CRTC_EXT_CNTL, crtc_ext_cntl);
771fe6b9 1659 } else {
701337dc
EE
1660 WREG32(RADEON_CRTC2_GEN_CNTL, crtc2_gen_cntl);
1661 if (ASIC_IS_R300(rdev)) {
1662 WREG32(RADEON_DISP_OUTPUT_CNTL, disp_output_cntl);
1663 WREG32_P(RADEON_GPIOPAD_A, gpiopad_a, ~1);
1664 } else {
1665 WREG32(RADEON_DISP_HW_DEBUG, disp_hw_debug);
1666 }
771fe6b9 1667 }
d038db86 1668
771fe6b9
JG
1669 WREG32_PLL(RADEON_PIXCLKS_CNTL, pixclks_cntl);
1670
4ce001ab 1671 return found;
771fe6b9
JG
1672
1673}
1674
1675static const struct drm_encoder_helper_funcs radeon_legacy_tv_dac_helper_funcs = {
1676 .dpms = radeon_legacy_tv_dac_dpms,
80297e87 1677 .mode_fixup = radeon_legacy_mode_fixup,
771fe6b9
JG
1678 .prepare = radeon_legacy_tv_dac_prepare,
1679 .mode_set = radeon_legacy_tv_dac_mode_set,
1680 .commit = radeon_legacy_tv_dac_commit,
1681 .detect = radeon_legacy_tv_dac_detect,
4ce001ab 1682 .disable = radeon_legacy_encoder_disable,
771fe6b9
JG
1683};
1684
1685
1686static const struct drm_encoder_funcs radeon_legacy_tv_dac_enc_funcs = {
1687 .destroy = radeon_enc_destroy,
1688};
1689
445282db
DA
1690
1691static struct radeon_encoder_int_tmds *radeon_legacy_get_tmds_info(struct radeon_encoder *encoder)
1692{
1693 struct drm_device *dev = encoder->base.dev;
1694 struct radeon_device *rdev = dev->dev_private;
1695 struct radeon_encoder_int_tmds *tmds = NULL;
1696 bool ret;
1697
1698 tmds = kzalloc(sizeof(struct radeon_encoder_int_tmds), GFP_KERNEL);
1699
1700 if (!tmds)
1701 return NULL;
1702
1703 if (rdev->is_atom_bios)
1704 ret = radeon_atombios_get_tmds_info(encoder, tmds);
1705 else
1706 ret = radeon_legacy_get_tmds_info_from_combios(encoder, tmds);
1707
1708 if (ret == false)
1709 radeon_legacy_get_tmds_info_from_table(encoder, tmds);
1710
1711 return tmds;
1712}
1713
fcec570b
AD
1714static struct radeon_encoder_ext_tmds *radeon_legacy_get_ext_tmds_info(struct radeon_encoder *encoder)
1715{
1716 struct drm_device *dev = encoder->base.dev;
1717 struct radeon_device *rdev = dev->dev_private;
1718 struct radeon_encoder_ext_tmds *tmds = NULL;
1719 bool ret;
1720
1721 if (rdev->is_atom_bios)
1722 return NULL;
1723
1724 tmds = kzalloc(sizeof(struct radeon_encoder_ext_tmds), GFP_KERNEL);
1725
1726 if (!tmds)
1727 return NULL;
1728
1729 ret = radeon_legacy_get_ext_tmds_info_from_combios(encoder, tmds);
1730
1731 if (ret == false)
1732 radeon_legacy_get_ext_tmds_info_from_table(encoder, tmds);
1733
1734 return tmds;
1735}
1736
771fe6b9 1737void
5137ee94 1738radeon_add_legacy_encoder(struct drm_device *dev, uint32_t encoder_enum, uint32_t supported_device)
771fe6b9
JG
1739{
1740 struct radeon_device *rdev = dev->dev_private;
1741 struct drm_encoder *encoder;
1742 struct radeon_encoder *radeon_encoder;
1743
1744 /* see if we already added it */
1745 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
1746 radeon_encoder = to_radeon_encoder(encoder);
5137ee94 1747 if (radeon_encoder->encoder_enum == encoder_enum) {
771fe6b9
JG
1748 radeon_encoder->devices |= supported_device;
1749 return;
1750 }
1751
1752 }
1753
1754 /* add a new one */
1755 radeon_encoder = kzalloc(sizeof(struct radeon_encoder), GFP_KERNEL);
1756 if (!radeon_encoder)
1757 return;
1758
1759 encoder = &radeon_encoder->base;
dfee5614
DA
1760 if (rdev->flags & RADEON_SINGLE_CRTC)
1761 encoder->possible_crtcs = 0x1;
1762 else
1763 encoder->possible_crtcs = 0x3;
771fe6b9
JG
1764
1765 radeon_encoder->enc_priv = NULL;
1766
5137ee94
AD
1767 radeon_encoder->encoder_enum = encoder_enum;
1768 radeon_encoder->encoder_id = (encoder_enum & OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
771fe6b9 1769 radeon_encoder->devices = supported_device;
c93bb85b 1770 radeon_encoder->rmx_type = RMX_OFF;
771fe6b9
JG
1771
1772 switch (radeon_encoder->encoder_id) {
1773 case ENCODER_OBJECT_ID_INTERNAL_LVDS:
80e6914d 1774 encoder->possible_crtcs = 0x1;
13a3d91f
VS
1775 drm_encoder_init(dev, encoder, &radeon_legacy_lvds_enc_funcs,
1776 DRM_MODE_ENCODER_LVDS, NULL);
771fe6b9
JG
1777 drm_encoder_helper_add(encoder, &radeon_legacy_lvds_helper_funcs);
1778 if (rdev->is_atom_bios)
1779 radeon_encoder->enc_priv = radeon_atombios_get_lvds_info(radeon_encoder);
1780 else
1781 radeon_encoder->enc_priv = radeon_combios_get_lvds_info(radeon_encoder);
1782 radeon_encoder->rmx_type = RMX_FULL;
1783 break;
1784 case ENCODER_OBJECT_ID_INTERNAL_TMDS1:
13a3d91f
VS
1785 drm_encoder_init(dev, encoder, &radeon_legacy_tmds_int_enc_funcs,
1786 DRM_MODE_ENCODER_TMDS, NULL);
771fe6b9 1787 drm_encoder_helper_add(encoder, &radeon_legacy_tmds_int_helper_funcs);
445282db 1788 radeon_encoder->enc_priv = radeon_legacy_get_tmds_info(radeon_encoder);
771fe6b9
JG
1789 break;
1790 case ENCODER_OBJECT_ID_INTERNAL_DAC1:
13a3d91f
VS
1791 drm_encoder_init(dev, encoder, &radeon_legacy_primary_dac_enc_funcs,
1792 DRM_MODE_ENCODER_DAC, NULL);
771fe6b9 1793 drm_encoder_helper_add(encoder, &radeon_legacy_primary_dac_helper_funcs);
6fe7ac3f
AD
1794 if (rdev->is_atom_bios)
1795 radeon_encoder->enc_priv = radeon_atombios_get_primary_dac_info(radeon_encoder);
1796 else
771fe6b9
JG
1797 radeon_encoder->enc_priv = radeon_combios_get_primary_dac_info(radeon_encoder);
1798 break;
1799 case ENCODER_OBJECT_ID_INTERNAL_DAC2:
13a3d91f
VS
1800 drm_encoder_init(dev, encoder, &radeon_legacy_tv_dac_enc_funcs,
1801 DRM_MODE_ENCODER_TVDAC, NULL);
771fe6b9 1802 drm_encoder_helper_add(encoder, &radeon_legacy_tv_dac_helper_funcs);
6fe7ac3f
AD
1803 if (rdev->is_atom_bios)
1804 radeon_encoder->enc_priv = radeon_atombios_get_tv_dac_info(radeon_encoder);
1805 else
771fe6b9
JG
1806 radeon_encoder->enc_priv = radeon_combios_get_tv_dac_info(radeon_encoder);
1807 break;
1808 case ENCODER_OBJECT_ID_INTERNAL_DVO1:
13a3d91f
VS
1809 drm_encoder_init(dev, encoder, &radeon_legacy_tmds_ext_enc_funcs,
1810 DRM_MODE_ENCODER_TMDS, NULL);
771fe6b9
JG
1811 drm_encoder_helper_add(encoder, &radeon_legacy_tmds_ext_helper_funcs);
1812 if (!rdev->is_atom_bios)
fcec570b 1813 radeon_encoder->enc_priv = radeon_legacy_get_ext_tmds_info(radeon_encoder);
771fe6b9
JG
1814 break;
1815 }
1816}