Line data Source code
1 : #include <dev/pci/drm/drmP.h>
2 : #include <dev/pci/drm/drm_crtc_helper.h>
3 : #include "radeon.h"
4 :
5 : /*
6 : * Integrated TV out support based on the GATOS code by
7 : * Federico Ulivi <fulivi@lycos.com>
8 : */
9 :
10 :
11 : /*
12 : * Limits of h/v positions (hPos & vPos)
13 : */
14 : #define MAX_H_POSITION 5 /* Range: [-5..5], negative is on the left, 0 is default, positive is on the right */
15 : #define MAX_V_POSITION 5 /* Range: [-5..5], negative is up, 0 is default, positive is down */
16 :
17 : /*
18 : * Unit for hPos (in TV clock periods)
19 : */
20 : #define H_POS_UNIT 10
21 :
22 : /*
23 : * Indexes in h. code timing table for horizontal line position adjustment
24 : */
25 : #define H_TABLE_POS1 6
26 : #define H_TABLE_POS2 8
27 :
28 : /*
29 : * Limits of hor. size (hSize)
30 : */
31 : #define MAX_H_SIZE 5 /* Range: [-5..5], negative is smaller, positive is larger */
32 :
33 : /* tv standard constants */
34 : #define NTSC_TV_CLOCK_T 233
35 : #define NTSC_TV_VFTOTAL 1
36 : #define NTSC_TV_LINES_PER_FRAME 525
37 : #define NTSC_TV_ZERO_H_SIZE 479166
38 : #define NTSC_TV_H_SIZE_UNIT 9478
39 :
40 : #define PAL_TV_CLOCK_T 188
41 : #define PAL_TV_VFTOTAL 3
42 : #define PAL_TV_LINES_PER_FRAME 625
43 : #define PAL_TV_ZERO_H_SIZE 473200
44 : #define PAL_TV_H_SIZE_UNIT 9360
45 :
46 : /* tv pll setting for 27 mhz ref clk */
47 : #define NTSC_TV_PLL_M_27 22
48 : #define NTSC_TV_PLL_N_27 175
49 : #define NTSC_TV_PLL_P_27 5
50 :
51 : #define PAL_TV_PLL_M_27 113
52 : #define PAL_TV_PLL_N_27 668
53 : #define PAL_TV_PLL_P_27 3
54 :
55 : /* tv pll setting for 14 mhz ref clk */
56 : #define NTSC_TV_PLL_M_14 33
57 : #define NTSC_TV_PLL_N_14 693
58 : #define NTSC_TV_PLL_P_14 7
59 :
60 : #define PAL_TV_PLL_M_14 19
61 : #define PAL_TV_PLL_N_14 353
62 : #define PAL_TV_PLL_P_14 5
63 :
64 : #define VERT_LEAD_IN_LINES 2
65 : #define FRAC_BITS 0xe
66 : #define FRAC_MASK 0x3fff
67 :
68 : struct radeon_tv_mode_constants {
69 : uint16_t hor_resolution;
70 : uint16_t ver_resolution;
71 : enum radeon_tv_std standard;
72 : uint16_t hor_total;
73 : uint16_t ver_total;
74 : uint16_t hor_start;
75 : uint16_t hor_syncstart;
76 : uint16_t ver_syncstart;
77 : unsigned def_restart;
78 : uint16_t crtcPLL_N;
79 : uint8_t crtcPLL_M;
80 : uint8_t crtcPLL_post_div;
81 : unsigned pix_to_tv;
82 : };
83 :
84 : static const uint16_t hor_timing_NTSC[MAX_H_CODE_TIMING_LEN] = {
85 : 0x0007,
86 : 0x003f,
87 : 0x0263,
88 : 0x0a24,
89 : 0x2a6b,
90 : 0x0a36,
91 : 0x126d, /* H_TABLE_POS1 */
92 : 0x1bfe,
93 : 0x1a8f, /* H_TABLE_POS2 */
94 : 0x1ec7,
95 : 0x3863,
96 : 0x1bfe,
97 : 0x1bfe,
98 : 0x1a2a,
99 : 0x1e95,
100 : 0x0e31,
101 : 0x201b,
102 : 0
103 : };
104 :
105 : static const uint16_t vert_timing_NTSC[MAX_V_CODE_TIMING_LEN] = {
106 : 0x2001,
107 : 0x200d,
108 : 0x1006,
109 : 0x0c06,
110 : 0x1006,
111 : 0x1818,
112 : 0x21e3,
113 : 0x1006,
114 : 0x0c06,
115 : 0x1006,
116 : 0x1817,
117 : 0x21d4,
118 : 0x0002,
119 : 0
120 : };
121 :
122 : static const uint16_t hor_timing_PAL[MAX_H_CODE_TIMING_LEN] = {
123 : 0x0007,
124 : 0x0058,
125 : 0x027c,
126 : 0x0a31,
127 : 0x2a77,
128 : 0x0a95,
129 : 0x124f, /* H_TABLE_POS1 */
130 : 0x1bfe,
131 : 0x1b22, /* H_TABLE_POS2 */
132 : 0x1ef9,
133 : 0x387c,
134 : 0x1bfe,
135 : 0x1bfe,
136 : 0x1b31,
137 : 0x1eb5,
138 : 0x0e43,
139 : 0x201b,
140 : 0
141 : };
142 :
143 : static const uint16_t vert_timing_PAL[MAX_V_CODE_TIMING_LEN] = {
144 : 0x2001,
145 : 0x200c,
146 : 0x1005,
147 : 0x0c05,
148 : 0x1005,
149 : 0x1401,
150 : 0x1821,
151 : 0x2240,
152 : 0x1005,
153 : 0x0c05,
154 : 0x1005,
155 : 0x1401,
156 : 0x1822,
157 : 0x2230,
158 : 0x0002,
159 : 0
160 : };
161 :
162 : /**********************************************************************
163 : *
164 : * availableModes
165 : *
166 : * Table of all allowed modes for tv output
167 : *
168 : **********************************************************************/
169 : static const struct radeon_tv_mode_constants available_tv_modes[] = {
170 : { /* NTSC timing for 27 Mhz ref clk */
171 : 800, /* horResolution */
172 : 600, /* verResolution */
173 : TV_STD_NTSC, /* standard */
174 : 990, /* horTotal */
175 : 740, /* verTotal */
176 : 813, /* horStart */
177 : 824, /* horSyncStart */
178 : 632, /* verSyncStart */
179 : 625592, /* defRestart */
180 : 592, /* crtcPLL_N */
181 : 91, /* crtcPLL_M */
182 : 4, /* crtcPLL_postDiv */
183 : 1022, /* pixToTV */
184 : },
185 : { /* PAL timing for 27 Mhz ref clk */
186 : 800, /* horResolution */
187 : 600, /* verResolution */
188 : TV_STD_PAL, /* standard */
189 : 1144, /* horTotal */
190 : 706, /* verTotal */
191 : 812, /* horStart */
192 : 824, /* horSyncStart */
193 : 669, /* verSyncStart */
194 : 696700, /* defRestart */
195 : 1382, /* crtcPLL_N */
196 : 231, /* crtcPLL_M */
197 : 4, /* crtcPLL_postDiv */
198 : 759, /* pixToTV */
199 : },
200 : { /* NTSC timing for 14 Mhz ref clk */
201 : 800, /* horResolution */
202 : 600, /* verResolution */
203 : TV_STD_NTSC, /* standard */
204 : 1018, /* horTotal */
205 : 727, /* verTotal */
206 : 813, /* horStart */
207 : 840, /* horSyncStart */
208 : 633, /* verSyncStart */
209 : 630627, /* defRestart */
210 : 347, /* crtcPLL_N */
211 : 14, /* crtcPLL_M */
212 : 8, /* crtcPLL_postDiv */
213 : 1022, /* pixToTV */
214 : },
215 : { /* PAL timing for 14 Mhz ref clk */
216 : 800, /* horResolution */
217 : 600, /* verResolution */
218 : TV_STD_PAL, /* standard */
219 : 1131, /* horTotal */
220 : 742, /* verTotal */
221 : 813, /* horStart */
222 : 840, /* horSyncStart */
223 : 633, /* verSyncStart */
224 : 708369, /* defRestart */
225 : 211, /* crtcPLL_N */
226 : 9, /* crtcPLL_M */
227 : 8, /* crtcPLL_postDiv */
228 : 759, /* pixToTV */
229 : },
230 : };
231 :
232 : #define N_AVAILABLE_MODES ARRAY_SIZE(available_tv_modes)
233 :
234 0 : static const struct radeon_tv_mode_constants *radeon_legacy_tv_get_std_mode(struct radeon_encoder *radeon_encoder,
235 : uint16_t *pll_ref_freq)
236 : {
237 0 : struct drm_device *dev = radeon_encoder->base.dev;
238 0 : struct radeon_device *rdev = dev->dev_private;
239 : struct radeon_crtc *radeon_crtc;
240 0 : struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
241 : const struct radeon_tv_mode_constants *const_ptr;
242 : struct radeon_pll *pll;
243 :
244 0 : radeon_crtc = to_radeon_crtc(radeon_encoder->base.crtc);
245 0 : if (radeon_crtc->crtc_id == 1)
246 0 : pll = &rdev->clock.p2pll;
247 : else
248 0 : pll = &rdev->clock.p1pll;
249 :
250 0 : if (pll_ref_freq)
251 0 : *pll_ref_freq = pll->reference_freq;
252 :
253 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
254 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
255 0 : tv_dac->tv_std == TV_STD_PAL_M) {
256 0 : if (pll->reference_freq == 2700)
257 0 : const_ptr = &available_tv_modes[0];
258 : else
259 : const_ptr = &available_tv_modes[2];
260 : } else {
261 0 : if (pll->reference_freq == 2700)
262 0 : const_ptr = &available_tv_modes[1];
263 : else
264 : const_ptr = &available_tv_modes[3];
265 : }
266 0 : return const_ptr;
267 : }
268 :
269 : static long YCOEF_value[5] = { 2, 2, 0, 4, 0 };
270 : static long YCOEF_EN_value[5] = { 1, 1, 0, 1, 0 };
271 : static long SLOPE_value[5] = { 1, 2, 2, 4, 8 };
272 : static long SLOPE_limit[5] = { 6, 5, 4, 3, 2 };
273 :
274 0 : static void radeon_wait_pll_lock(struct drm_encoder *encoder, unsigned n_tests,
275 : unsigned n_wait_loops, unsigned cnt_threshold)
276 : {
277 0 : struct drm_device *dev = encoder->dev;
278 0 : struct radeon_device *rdev = dev->dev_private;
279 : uint32_t save_pll_test;
280 : unsigned int i, j;
281 :
282 0 : WREG32(RADEON_TEST_DEBUG_MUX, (RREG32(RADEON_TEST_DEBUG_MUX) & 0xffff60ff) | 0x100);
283 0 : save_pll_test = RREG32_PLL(RADEON_PLL_TEST_CNTL);
284 0 : WREG32_PLL(RADEON_PLL_TEST_CNTL, save_pll_test & ~RADEON_PLL_MASK_READ_B);
285 :
286 0 : WREG8(RADEON_CLOCK_CNTL_INDEX, RADEON_PLL_TEST_CNTL);
287 0 : for (i = 0; i < n_tests; i++) {
288 0 : WREG8(RADEON_CLOCK_CNTL_DATA + 3, 0);
289 0 : for (j = 0; j < n_wait_loops; j++)
290 0 : if (RREG8(RADEON_CLOCK_CNTL_DATA + 3) >= cnt_threshold)
291 : break;
292 : }
293 0 : WREG32_PLL(RADEON_PLL_TEST_CNTL, save_pll_test);
294 0 : WREG32(RADEON_TEST_DEBUG_MUX, RREG32(RADEON_TEST_DEBUG_MUX) & 0xffffe0ff);
295 0 : }
296 :
297 :
298 0 : static void radeon_legacy_tv_write_fifo(struct radeon_encoder *radeon_encoder,
299 : uint16_t addr, uint32_t value)
300 : {
301 0 : struct drm_device *dev = radeon_encoder->base.dev;
302 0 : struct radeon_device *rdev = dev->dev_private;
303 : uint32_t tmp;
304 : int i = 0;
305 :
306 0 : WREG32(RADEON_TV_HOST_WRITE_DATA, value);
307 :
308 0 : WREG32(RADEON_TV_HOST_RD_WT_CNTL, addr);
309 0 : WREG32(RADEON_TV_HOST_RD_WT_CNTL, addr | RADEON_HOST_FIFO_WT);
310 :
311 0 : do {
312 0 : tmp = RREG32(RADEON_TV_HOST_RD_WT_CNTL);
313 0 : if ((tmp & RADEON_HOST_FIFO_WT_ACK) == 0)
314 : break;
315 0 : i++;
316 0 : } while (i < 10000);
317 0 : WREG32(RADEON_TV_HOST_RD_WT_CNTL, 0);
318 0 : }
319 :
320 : #if 0 /* included for completeness */
321 : static uint32_t radeon_legacy_tv_read_fifo(struct radeon_encoder *radeon_encoder, uint16_t addr)
322 : {
323 : struct drm_device *dev = radeon_encoder->base.dev;
324 : struct radeon_device *rdev = dev->dev_private;
325 : uint32_t tmp;
326 : int i = 0;
327 :
328 : WREG32(RADEON_TV_HOST_RD_WT_CNTL, addr);
329 : WREG32(RADEON_TV_HOST_RD_WT_CNTL, addr | RADEON_HOST_FIFO_RD);
330 :
331 : do {
332 : tmp = RREG32(RADEON_TV_HOST_RD_WT_CNTL);
333 : if ((tmp & RADEON_HOST_FIFO_RD_ACK) == 0)
334 : break;
335 : i++;
336 : } while (i < 10000);
337 : WREG32(RADEON_TV_HOST_RD_WT_CNTL, 0);
338 : return RREG32(RADEON_TV_HOST_READ_DATA);
339 : }
340 : #endif
341 :
342 0 : static uint16_t radeon_get_htiming_tables_addr(uint32_t tv_uv_adr)
343 : {
344 : uint16_t h_table;
345 :
346 0 : switch ((tv_uv_adr & RADEON_HCODE_TABLE_SEL_MASK) >> RADEON_HCODE_TABLE_SEL_SHIFT) {
347 : case 0:
348 : h_table = RADEON_TV_MAX_FIFO_ADDR_INTERNAL;
349 0 : break;
350 : case 1:
351 0 : h_table = ((tv_uv_adr & RADEON_TABLE1_BOT_ADR_MASK) >> RADEON_TABLE1_BOT_ADR_SHIFT) * 2;
352 0 : break;
353 : case 2:
354 0 : h_table = ((tv_uv_adr & RADEON_TABLE3_TOP_ADR_MASK) >> RADEON_TABLE3_TOP_ADR_SHIFT) * 2;
355 0 : break;
356 : default:
357 : h_table = 0;
358 0 : break;
359 : }
360 0 : return h_table;
361 : }
362 :
363 0 : static uint16_t radeon_get_vtiming_tables_addr(uint32_t tv_uv_adr)
364 : {
365 : uint16_t v_table;
366 :
367 0 : switch ((tv_uv_adr & RADEON_VCODE_TABLE_SEL_MASK) >> RADEON_VCODE_TABLE_SEL_SHIFT) {
368 : case 0:
369 0 : v_table = ((tv_uv_adr & RADEON_MAX_UV_ADR_MASK) >> RADEON_MAX_UV_ADR_SHIFT) * 2 + 1;
370 0 : break;
371 : case 1:
372 0 : v_table = ((tv_uv_adr & RADEON_TABLE1_BOT_ADR_MASK) >> RADEON_TABLE1_BOT_ADR_SHIFT) * 2 + 1;
373 0 : break;
374 : case 2:
375 0 : v_table = ((tv_uv_adr & RADEON_TABLE3_TOP_ADR_MASK) >> RADEON_TABLE3_TOP_ADR_SHIFT) * 2 + 1;
376 0 : break;
377 : default:
378 : v_table = 0;
379 0 : break;
380 : }
381 0 : return v_table;
382 : }
383 :
384 0 : static void radeon_restore_tv_timing_tables(struct radeon_encoder *radeon_encoder)
385 : {
386 0 : struct drm_device *dev = radeon_encoder->base.dev;
387 0 : struct radeon_device *rdev = dev->dev_private;
388 0 : struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
389 : uint16_t h_table, v_table;
390 : uint32_t tmp;
391 : int i;
392 :
393 0 : WREG32(RADEON_TV_UV_ADR, tv_dac->tv.tv_uv_adr);
394 0 : h_table = radeon_get_htiming_tables_addr(tv_dac->tv.tv_uv_adr);
395 0 : v_table = radeon_get_vtiming_tables_addr(tv_dac->tv.tv_uv_adr);
396 :
397 0 : for (i = 0; i < MAX_H_CODE_TIMING_LEN; i += 2, h_table--) {
398 0 : tmp = ((uint32_t)tv_dac->tv.h_code_timing[i] << 14) | ((uint32_t)tv_dac->tv.h_code_timing[i+1]);
399 0 : radeon_legacy_tv_write_fifo(radeon_encoder, h_table, tmp);
400 0 : if (tv_dac->tv.h_code_timing[i] == 0 || tv_dac->tv.h_code_timing[i + 1] == 0)
401 : break;
402 : }
403 0 : for (i = 0; i < MAX_V_CODE_TIMING_LEN; i += 2, v_table++) {
404 0 : tmp = ((uint32_t)tv_dac->tv.v_code_timing[i+1] << 14) | ((uint32_t)tv_dac->tv.v_code_timing[i]);
405 0 : radeon_legacy_tv_write_fifo(radeon_encoder, v_table, tmp);
406 0 : if (tv_dac->tv.v_code_timing[i] == 0 || tv_dac->tv.v_code_timing[i + 1] == 0)
407 : break;
408 : }
409 0 : }
410 :
411 0 : static void radeon_legacy_write_tv_restarts(struct radeon_encoder *radeon_encoder)
412 : {
413 0 : struct drm_device *dev = radeon_encoder->base.dev;
414 0 : struct radeon_device *rdev = dev->dev_private;
415 0 : struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
416 0 : WREG32(RADEON_TV_FRESTART, tv_dac->tv.frestart);
417 0 : WREG32(RADEON_TV_HRESTART, tv_dac->tv.hrestart);
418 0 : WREG32(RADEON_TV_VRESTART, tv_dac->tv.vrestart);
419 0 : }
420 :
421 0 : static bool radeon_legacy_tv_init_restarts(struct drm_encoder *encoder)
422 : {
423 0 : struct drm_device *dev = encoder->dev;
424 0 : struct radeon_device *rdev = dev->dev_private;
425 0 : struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
426 0 : struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
427 : struct radeon_crtc *radeon_crtc;
428 : int restart;
429 : unsigned int h_total, v_total, f_total;
430 : int v_offset, h_offset;
431 : u16 p1, p2, h_inc;
432 : bool h_changed;
433 : const struct radeon_tv_mode_constants *const_ptr;
434 : struct radeon_pll *pll;
435 :
436 0 : radeon_crtc = to_radeon_crtc(radeon_encoder->base.crtc);
437 0 : if (radeon_crtc->crtc_id == 1)
438 0 : pll = &rdev->clock.p2pll;
439 : else
440 : pll = &rdev->clock.p1pll;
441 :
442 0 : const_ptr = radeon_legacy_tv_get_std_mode(radeon_encoder, NULL);
443 0 : if (!const_ptr)
444 0 : return false;
445 :
446 0 : h_total = const_ptr->hor_total;
447 0 : v_total = const_ptr->ver_total;
448 :
449 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
450 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
451 0 : tv_dac->tv_std == TV_STD_PAL_M ||
452 0 : tv_dac->tv_std == TV_STD_PAL_60)
453 0 : f_total = NTSC_TV_VFTOTAL + 1;
454 : else
455 : f_total = PAL_TV_VFTOTAL + 1;
456 :
457 : /* adjust positions 1&2 in hor. cod timing table */
458 0 : h_offset = tv_dac->h_pos * H_POS_UNIT;
459 :
460 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
461 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
462 0 : tv_dac->tv_std == TV_STD_PAL_M) {
463 0 : h_offset -= 50;
464 : p1 = hor_timing_NTSC[H_TABLE_POS1];
465 : p2 = hor_timing_NTSC[H_TABLE_POS2];
466 0 : } else {
467 : p1 = hor_timing_PAL[H_TABLE_POS1];
468 : p2 = hor_timing_PAL[H_TABLE_POS2];
469 : }
470 :
471 0 : p1 = (u16)((int)p1 + h_offset);
472 0 : p2 = (u16)((int)p2 - h_offset);
473 :
474 0 : h_changed = (p1 != tv_dac->tv.h_code_timing[H_TABLE_POS1] ||
475 0 : p2 != tv_dac->tv.h_code_timing[H_TABLE_POS2]);
476 :
477 0 : tv_dac->tv.h_code_timing[H_TABLE_POS1] = p1;
478 0 : tv_dac->tv.h_code_timing[H_TABLE_POS2] = p2;
479 :
480 : /* Convert hOffset from n. of TV clock periods to n. of CRTC clock periods (CRTC pixels) */
481 0 : h_offset = (h_offset * (int)(const_ptr->pix_to_tv)) / 1000;
482 :
483 : /* adjust restart */
484 0 : restart = const_ptr->def_restart;
485 :
486 : /*
487 : * convert v_pos TV lines to n. of CRTC pixels
488 : */
489 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
490 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
491 0 : tv_dac->tv_std == TV_STD_PAL_M ||
492 0 : tv_dac->tv_std == TV_STD_PAL_60)
493 0 : v_offset = ((int)(v_total * h_total) * 2 * tv_dac->v_pos) / (int)(NTSC_TV_LINES_PER_FRAME);
494 : else
495 0 : v_offset = ((int)(v_total * h_total) * 2 * tv_dac->v_pos) / (int)(PAL_TV_LINES_PER_FRAME);
496 :
497 0 : restart -= v_offset + h_offset;
498 :
499 : DRM_DEBUG_KMS("compute_restarts: def = %u h = %d v = %d, p1 = %04x, p2 = %04x, restart = %d\n",
500 : const_ptr->def_restart, tv_dac->h_pos, tv_dac->v_pos, p1, p2, restart);
501 :
502 0 : tv_dac->tv.hrestart = restart % h_total;
503 0 : restart /= h_total;
504 0 : tv_dac->tv.vrestart = restart % v_total;
505 0 : restart /= v_total;
506 0 : tv_dac->tv.frestart = restart % f_total;
507 :
508 : DRM_DEBUG_KMS("compute_restart: F/H/V=%u,%u,%u\n",
509 : (unsigned)tv_dac->tv.frestart,
510 : (unsigned)tv_dac->tv.vrestart,
511 : (unsigned)tv_dac->tv.hrestart);
512 :
513 : /* compute h_inc from hsize */
514 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
515 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
516 0 : tv_dac->tv_std == TV_STD_PAL_M)
517 0 : h_inc = (u16)((int)(const_ptr->hor_resolution * 4096 * NTSC_TV_CLOCK_T) /
518 0 : (tv_dac->h_size * (int)(NTSC_TV_H_SIZE_UNIT) + (int)(NTSC_TV_ZERO_H_SIZE)));
519 : else
520 0 : h_inc = (u16)((int)(const_ptr->hor_resolution * 4096 * PAL_TV_CLOCK_T) /
521 0 : (tv_dac->h_size * (int)(PAL_TV_H_SIZE_UNIT) + (int)(PAL_TV_ZERO_H_SIZE)));
522 :
523 0 : tv_dac->tv.timing_cntl = (tv_dac->tv.timing_cntl & ~RADEON_H_INC_MASK) |
524 0 : ((u32)h_inc << RADEON_H_INC_SHIFT);
525 :
526 : DRM_DEBUG_KMS("compute_restart: h_size = %d h_inc = %d\n", tv_dac->h_size, h_inc);
527 :
528 0 : return h_changed;
529 0 : }
530 :
531 0 : void radeon_legacy_tv_mode_set(struct drm_encoder *encoder,
532 : struct drm_display_mode *mode,
533 : struct drm_display_mode *adjusted_mode)
534 : {
535 0 : struct drm_device *dev = encoder->dev;
536 0 : struct radeon_device *rdev = dev->dev_private;
537 0 : struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
538 0 : struct radeon_encoder_tv_dac *tv_dac = radeon_encoder->enc_priv;
539 : const struct radeon_tv_mode_constants *const_ptr;
540 : struct radeon_crtc *radeon_crtc;
541 : int i;
542 0 : uint16_t pll_ref_freq;
543 : uint32_t vert_space, flicker_removal, tmp;
544 : uint32_t tv_master_cntl, tv_rgb_cntl, tv_dac_cntl;
545 : uint32_t tv_modulator_cntl1, tv_modulator_cntl2;
546 : uint32_t tv_vscaler_cntl1, tv_vscaler_cntl2;
547 : uint32_t tv_pll_cntl, tv_pll_cntl1, tv_ftotal;
548 : uint32_t tv_y_fall_cntl, tv_y_rise_cntl, tv_y_saw_tooth_cntl;
549 : uint32_t m, n, p;
550 : const uint16_t *hor_timing;
551 : const uint16_t *vert_timing;
552 :
553 0 : const_ptr = radeon_legacy_tv_get_std_mode(radeon_encoder, &pll_ref_freq);
554 0 : if (!const_ptr)
555 0 : return;
556 :
557 0 : radeon_crtc = to_radeon_crtc(encoder->crtc);
558 :
559 : tv_master_cntl = (RADEON_VIN_ASYNC_RST |
560 : RADEON_CRT_FIFO_CE_EN |
561 : RADEON_TV_FIFO_CE_EN |
562 : RADEON_TV_ON);
563 :
564 0 : if (!ASIC_IS_R300(rdev))
565 0 : tv_master_cntl |= RADEON_TVCLK_ALWAYS_ONb;
566 :
567 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
568 0 : tv_dac->tv_std == TV_STD_NTSC_J)
569 0 : tv_master_cntl |= RADEON_RESTART_PHASE_FIX;
570 :
571 : tv_modulator_cntl1 = (RADEON_SLEW_RATE_LIMIT |
572 : RADEON_SYNC_TIP_LEVEL |
573 : RADEON_YFLT_EN |
574 : RADEON_UVFLT_EN |
575 : (6 << RADEON_CY_FILT_BLEND_SHIFT));
576 :
577 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
578 0 : tv_dac->tv_std == TV_STD_NTSC_J) {
579 : tv_modulator_cntl1 |= (0x46 << RADEON_SET_UP_LEVEL_SHIFT) |
580 : (0x3b << RADEON_BLANK_LEVEL_SHIFT);
581 : tv_modulator_cntl2 = (-111 & RADEON_TV_U_BURST_LEVEL_MASK) |
582 : ((0 & RADEON_TV_V_BURST_LEVEL_MASK) << RADEON_TV_V_BURST_LEVEL_SHIFT);
583 0 : } else if (tv_dac->tv_std == TV_STD_SCART_PAL) {
584 : tv_modulator_cntl1 |= RADEON_ALT_PHASE_EN;
585 : tv_modulator_cntl2 = (0 & RADEON_TV_U_BURST_LEVEL_MASK) |
586 : ((0 & RADEON_TV_V_BURST_LEVEL_MASK) << RADEON_TV_V_BURST_LEVEL_SHIFT);
587 0 : } else {
588 : tv_modulator_cntl1 |= RADEON_ALT_PHASE_EN |
589 : (0x3b << RADEON_SET_UP_LEVEL_SHIFT) |
590 : (0x3b << RADEON_BLANK_LEVEL_SHIFT);
591 : tv_modulator_cntl2 = (-78 & RADEON_TV_U_BURST_LEVEL_MASK) |
592 : ((62 & RADEON_TV_V_BURST_LEVEL_MASK) << RADEON_TV_V_BURST_LEVEL_SHIFT);
593 : }
594 :
595 :
596 : tv_rgb_cntl = (RADEON_RGB_DITHER_EN
597 : | RADEON_TVOUT_SCALE_EN
598 : | (0x0b << RADEON_UVRAM_READ_MARGIN_SHIFT)
599 : | (0x07 << RADEON_FIFORAM_FFMACRO_READ_MARGIN_SHIFT)
600 : | RADEON_RGB_ATTEN_SEL(0x3)
601 : | RADEON_RGB_ATTEN_VAL(0xc));
602 :
603 0 : if (radeon_crtc->crtc_id == 1)
604 0 : tv_rgb_cntl |= RADEON_RGB_SRC_SEL_CRTC2;
605 : else {
606 0 : if (radeon_crtc->rmx_type != RMX_OFF)
607 0 : tv_rgb_cntl |= RADEON_RGB_SRC_SEL_RMX;
608 : else
609 : tv_rgb_cntl |= RADEON_RGB_SRC_SEL_CRTC1;
610 : }
611 :
612 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
613 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
614 0 : tv_dac->tv_std == TV_STD_PAL_M ||
615 0 : tv_dac->tv_std == TV_STD_PAL_60)
616 0 : vert_space = const_ptr->ver_total * 2 * 10000 / NTSC_TV_LINES_PER_FRAME;
617 : else
618 0 : vert_space = const_ptr->ver_total * 2 * 10000 / PAL_TV_LINES_PER_FRAME;
619 :
620 0 : tmp = RREG32(RADEON_TV_VSCALER_CNTL1);
621 0 : tmp &= 0xe3ff0000;
622 0 : tmp |= (vert_space * (1 << FRAC_BITS) / 10000);
623 : tv_vscaler_cntl1 = tmp;
624 :
625 0 : if (pll_ref_freq == 2700)
626 0 : tv_vscaler_cntl1 |= RADEON_RESTART_FIELD;
627 :
628 0 : if (const_ptr->hor_resolution == 1024)
629 0 : tv_vscaler_cntl1 |= (4 << RADEON_Y_DEL_W_SIG_SHIFT);
630 : else
631 0 : tv_vscaler_cntl1 |= (2 << RADEON_Y_DEL_W_SIG_SHIFT);
632 :
633 : /* scale up for int divide */
634 0 : tmp = const_ptr->ver_total * 2 * 1000;
635 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
636 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
637 0 : tv_dac->tv_std == TV_STD_PAL_M ||
638 0 : tv_dac->tv_std == TV_STD_PAL_60) {
639 0 : tmp /= NTSC_TV_LINES_PER_FRAME;
640 0 : } else {
641 0 : tmp /= PAL_TV_LINES_PER_FRAME;
642 : }
643 0 : flicker_removal = (tmp + 500) / 1000;
644 :
645 0 : if (flicker_removal < 3)
646 : flicker_removal = 3;
647 0 : for (i = 0; i < ARRAY_SIZE(SLOPE_limit); ++i) {
648 0 : if (flicker_removal == SLOPE_limit[i])
649 : break;
650 : }
651 :
652 0 : tv_y_saw_tooth_cntl = (vert_space * SLOPE_value[i] * (1 << (FRAC_BITS - 1)) +
653 0 : 5001) / 10000 / 8 | ((SLOPE_value[i] *
654 0 : (1 << (FRAC_BITS - 1)) / 8) << 16);
655 : tv_y_fall_cntl =
656 0 : (YCOEF_EN_value[i] << 17) | ((YCOEF_value[i] * (1 << 8) / 8) << 24) |
657 0 : RADEON_Y_FALL_PING_PONG | (272 * SLOPE_value[i] / 8) * (1 << (FRAC_BITS - 1)) /
658 : 1024;
659 0 : tv_y_rise_cntl = RADEON_Y_RISE_PING_PONG|
660 0 : (flicker_removal * 1024 - 272) * SLOPE_value[i] / 8 * (1 << (FRAC_BITS - 1)) / 1024;
661 :
662 0 : tv_vscaler_cntl2 = RREG32(RADEON_TV_VSCALER_CNTL2) & 0x00fffff0;
663 0 : tv_vscaler_cntl2 |= (0x10 << 24) |
664 : RADEON_DITHER_MODE |
665 : RADEON_Y_OUTPUT_DITHER_EN |
666 : RADEON_UV_OUTPUT_DITHER_EN |
667 : RADEON_UV_TO_BUF_DITHER_EN;
668 :
669 0 : tmp = (tv_vscaler_cntl1 >> RADEON_UV_INC_SHIFT) & RADEON_UV_INC_MASK;
670 0 : tmp = ((16384 * 256 * 10) / tmp + 5) / 10;
671 0 : tmp = (tmp << RADEON_UV_OUTPUT_POST_SCALE_SHIFT) | 0x000b0000;
672 0 : tv_dac->tv.timing_cntl = tmp;
673 :
674 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
675 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
676 0 : tv_dac->tv_std == TV_STD_PAL_M ||
677 0 : tv_dac->tv_std == TV_STD_PAL_60)
678 0 : tv_dac_cntl = tv_dac->ntsc_tvdac_adj;
679 : else
680 0 : tv_dac_cntl = tv_dac->pal_tvdac_adj;
681 :
682 0 : tv_dac_cntl |= RADEON_TV_DAC_NBLANK | RADEON_TV_DAC_NHOLD;
683 :
684 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
685 0 : tv_dac->tv_std == TV_STD_NTSC_J)
686 0 : tv_dac_cntl |= RADEON_TV_DAC_STD_NTSC;
687 : else
688 : tv_dac_cntl |= RADEON_TV_DAC_STD_PAL;
689 :
690 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
691 0 : tv_dac->tv_std == TV_STD_NTSC_J) {
692 0 : if (pll_ref_freq == 2700) {
693 : m = NTSC_TV_PLL_M_27;
694 : n = NTSC_TV_PLL_N_27;
695 : p = NTSC_TV_PLL_P_27;
696 0 : } else {
697 : m = NTSC_TV_PLL_M_14;
698 : n = NTSC_TV_PLL_N_14;
699 : p = NTSC_TV_PLL_P_14;
700 : }
701 : } else {
702 0 : if (pll_ref_freq == 2700) {
703 : m = PAL_TV_PLL_M_27;
704 : n = PAL_TV_PLL_N_27;
705 : p = PAL_TV_PLL_P_27;
706 0 : } else {
707 : m = PAL_TV_PLL_M_14;
708 : n = PAL_TV_PLL_N_14;
709 : p = PAL_TV_PLL_P_14;
710 : }
711 : }
712 :
713 0 : tv_pll_cntl = (m & RADEON_TV_M0LO_MASK) |
714 0 : (((m >> 8) & RADEON_TV_M0HI_MASK) << RADEON_TV_M0HI_SHIFT) |
715 0 : ((n & RADEON_TV_N0LO_MASK) << RADEON_TV_N0LO_SHIFT) |
716 0 : (((n >> 9) & RADEON_TV_N0HI_MASK) << RADEON_TV_N0HI_SHIFT) |
717 0 : ((p & RADEON_TV_P_MASK) << RADEON_TV_P_SHIFT);
718 :
719 : tv_pll_cntl1 = (((4 & RADEON_TVPCP_MASK) << RADEON_TVPCP_SHIFT) |
720 : ((4 & RADEON_TVPVG_MASK) << RADEON_TVPVG_SHIFT) |
721 : ((1 & RADEON_TVPDC_MASK) << RADEON_TVPDC_SHIFT) |
722 : RADEON_TVCLK_SRC_SEL_TVPLL |
723 : RADEON_TVPLL_TEST_DIS);
724 :
725 0 : tv_dac->tv.tv_uv_adr = 0xc8;
726 :
727 0 : if (tv_dac->tv_std == TV_STD_NTSC ||
728 0 : tv_dac->tv_std == TV_STD_NTSC_J ||
729 0 : tv_dac->tv_std == TV_STD_PAL_M ||
730 0 : tv_dac->tv_std == TV_STD_PAL_60) {
731 : tv_ftotal = NTSC_TV_VFTOTAL;
732 : hor_timing = hor_timing_NTSC;
733 : vert_timing = vert_timing_NTSC;
734 0 : } else {
735 : hor_timing = hor_timing_PAL;
736 : vert_timing = vert_timing_PAL;
737 : tv_ftotal = PAL_TV_VFTOTAL;
738 : }
739 :
740 0 : for (i = 0; i < MAX_H_CODE_TIMING_LEN; i++) {
741 0 : if ((tv_dac->tv.h_code_timing[i] = hor_timing[i]) == 0)
742 : break;
743 : }
744 :
745 0 : for (i = 0; i < MAX_V_CODE_TIMING_LEN; i++) {
746 0 : if ((tv_dac->tv.v_code_timing[i] = vert_timing[i]) == 0)
747 : break;
748 : }
749 :
750 0 : radeon_legacy_tv_init_restarts(encoder);
751 :
752 : /* play with DAC_CNTL */
753 : /* play with GPIOPAD_A */
754 : /* DISP_OUTPUT_CNTL */
755 : /* use reference freq */
756 :
757 : /* program the TV registers */
758 0 : WREG32(RADEON_TV_MASTER_CNTL, (tv_master_cntl | RADEON_TV_ASYNC_RST |
759 : RADEON_CRT_ASYNC_RST | RADEON_TV_FIFO_ASYNC_RST));
760 :
761 0 : tmp = RREG32(RADEON_TV_DAC_CNTL);
762 0 : tmp &= ~RADEON_TV_DAC_NBLANK;
763 0 : tmp |= RADEON_TV_DAC_BGSLEEP |
764 : RADEON_TV_DAC_RDACPD |
765 : RADEON_TV_DAC_GDACPD |
766 : RADEON_TV_DAC_BDACPD;
767 0 : WREG32(RADEON_TV_DAC_CNTL, tmp);
768 :
769 : /* TV PLL */
770 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, 0, ~RADEON_TVCLK_SRC_SEL_TVPLL);
771 0 : WREG32_PLL(RADEON_TV_PLL_CNTL, tv_pll_cntl);
772 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, RADEON_TVPLL_RESET, ~RADEON_TVPLL_RESET);
773 :
774 0 : radeon_wait_pll_lock(encoder, 200, 800, 135);
775 :
776 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, 0, ~RADEON_TVPLL_RESET);
777 :
778 0 : radeon_wait_pll_lock(encoder, 300, 160, 27);
779 0 : radeon_wait_pll_lock(encoder, 200, 800, 135);
780 :
781 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, 0, ~0xf);
782 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, RADEON_TVCLK_SRC_SEL_TVPLL, ~RADEON_TVCLK_SRC_SEL_TVPLL);
783 :
784 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, (1 << RADEON_TVPDC_SHIFT), ~RADEON_TVPDC_MASK);
785 0 : WREG32_PLL_P(RADEON_TV_PLL_CNTL1, 0, ~RADEON_TVPLL_SLEEP);
786 :
787 : /* TV HV */
788 0 : WREG32(RADEON_TV_RGB_CNTL, tv_rgb_cntl);
789 0 : WREG32(RADEON_TV_HTOTAL, const_ptr->hor_total - 1);
790 0 : WREG32(RADEON_TV_HDISP, const_ptr->hor_resolution - 1);
791 0 : WREG32(RADEON_TV_HSTART, const_ptr->hor_start);
792 :
793 0 : WREG32(RADEON_TV_VTOTAL, const_ptr->ver_total - 1);
794 0 : WREG32(RADEON_TV_VDISP, const_ptr->ver_resolution - 1);
795 0 : WREG32(RADEON_TV_FTOTAL, tv_ftotal);
796 0 : WREG32(RADEON_TV_VSCALER_CNTL1, tv_vscaler_cntl1);
797 0 : WREG32(RADEON_TV_VSCALER_CNTL2, tv_vscaler_cntl2);
798 :
799 0 : WREG32(RADEON_TV_Y_FALL_CNTL, tv_y_fall_cntl);
800 0 : WREG32(RADEON_TV_Y_RISE_CNTL, tv_y_rise_cntl);
801 0 : WREG32(RADEON_TV_Y_SAW_TOOTH_CNTL, tv_y_saw_tooth_cntl);
802 :
803 0 : WREG32(RADEON_TV_MASTER_CNTL, (tv_master_cntl | RADEON_TV_ASYNC_RST |
804 : RADEON_CRT_ASYNC_RST));
805 :
806 : /* TV restarts */
807 0 : radeon_legacy_write_tv_restarts(radeon_encoder);
808 :
809 : /* tv timings */
810 0 : radeon_restore_tv_timing_tables(radeon_encoder);
811 :
812 0 : WREG32(RADEON_TV_MASTER_CNTL, (tv_master_cntl | RADEON_TV_ASYNC_RST));
813 :
814 : /* tv std */
815 0 : WREG32(RADEON_TV_SYNC_CNTL, (RADEON_SYNC_PUB | RADEON_TV_SYNC_IO_DRIVE));
816 0 : WREG32(RADEON_TV_TIMING_CNTL, tv_dac->tv.timing_cntl);
817 0 : WREG32(RADEON_TV_MODULATOR_CNTL1, tv_modulator_cntl1);
818 0 : WREG32(RADEON_TV_MODULATOR_CNTL2, tv_modulator_cntl2);
819 0 : WREG32(RADEON_TV_PRE_DAC_MUX_CNTL, (RADEON_Y_RED_EN |
820 : RADEON_C_GRN_EN |
821 : RADEON_CMP_BLU_EN |
822 : RADEON_DAC_DITHER_EN));
823 :
824 0 : WREG32(RADEON_TV_CRC_CNTL, 0);
825 :
826 0 : WREG32(RADEON_TV_MASTER_CNTL, tv_master_cntl);
827 :
828 0 : WREG32(RADEON_TV_GAIN_LIMIT_SETTINGS, ((0x17f << RADEON_UV_GAIN_LIMIT_SHIFT) |
829 : (0x5ff << RADEON_Y_GAIN_LIMIT_SHIFT)));
830 0 : WREG32(RADEON_TV_LINEAR_GAIN_SETTINGS, ((0x100 << RADEON_UV_GAIN_SHIFT) |
831 : (0x100 << RADEON_Y_GAIN_SHIFT)));
832 :
833 0 : WREG32(RADEON_TV_DAC_CNTL, tv_dac_cntl);
834 :
835 0 : }
836 :
837 0 : void radeon_legacy_tv_adjust_crtc_reg(struct drm_encoder *encoder,
838 : uint32_t *h_total_disp, uint32_t *h_sync_strt_wid,
839 : uint32_t *v_total_disp, uint32_t *v_sync_strt_wid)
840 : {
841 0 : struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
842 : const struct radeon_tv_mode_constants *const_ptr;
843 : uint32_t tmp;
844 :
845 0 : const_ptr = radeon_legacy_tv_get_std_mode(radeon_encoder, NULL);
846 0 : if (!const_ptr)
847 0 : return;
848 :
849 0 : *h_total_disp = (((const_ptr->hor_resolution / 8) - 1) << RADEON_CRTC_H_DISP_SHIFT) |
850 0 : (((const_ptr->hor_total / 8) - 1) << RADEON_CRTC_H_TOTAL_SHIFT);
851 :
852 0 : tmp = *h_sync_strt_wid;
853 0 : tmp &= ~(RADEON_CRTC_H_SYNC_STRT_PIX | RADEON_CRTC_H_SYNC_STRT_CHAR);
854 0 : tmp |= (((const_ptr->hor_syncstart / 8) - 1) << RADEON_CRTC_H_SYNC_STRT_CHAR_SHIFT) |
855 0 : (const_ptr->hor_syncstart & 7);
856 0 : *h_sync_strt_wid = tmp;
857 :
858 0 : *v_total_disp = ((const_ptr->ver_resolution - 1) << RADEON_CRTC_V_DISP_SHIFT) |
859 0 : ((const_ptr->ver_total - 1) << RADEON_CRTC_V_TOTAL_SHIFT);
860 :
861 0 : tmp = *v_sync_strt_wid;
862 0 : tmp &= ~RADEON_CRTC_V_SYNC_STRT;
863 0 : tmp |= ((const_ptr->ver_syncstart - 1) << RADEON_CRTC_V_SYNC_STRT_SHIFT);
864 0 : *v_sync_strt_wid = tmp;
865 0 : }
866 :
867 0 : static int get_post_div(int value)
868 : {
869 : int post_div;
870 0 : switch (value) {
871 0 : case 1: post_div = 0; break;
872 0 : case 2: post_div = 1; break;
873 0 : case 3: post_div = 4; break;
874 0 : case 4: post_div = 2; break;
875 0 : case 6: post_div = 6; break;
876 0 : case 8: post_div = 3; break;
877 0 : case 12: post_div = 7; break;
878 : case 16:
879 0 : default: post_div = 5; break;
880 : }
881 0 : return post_div;
882 : }
883 :
884 0 : void radeon_legacy_tv_adjust_pll1(struct drm_encoder *encoder,
885 : uint32_t *htotal_cntl, uint32_t *ppll_ref_div,
886 : uint32_t *ppll_div_3, uint32_t *pixclks_cntl)
887 : {
888 0 : struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
889 : const struct radeon_tv_mode_constants *const_ptr;
890 :
891 0 : const_ptr = radeon_legacy_tv_get_std_mode(radeon_encoder, NULL);
892 0 : if (!const_ptr)
893 0 : return;
894 :
895 0 : *htotal_cntl = (const_ptr->hor_total & 0x7) | RADEON_HTOT_CNTL_VGA_EN;
896 :
897 0 : *ppll_ref_div = const_ptr->crtcPLL_M;
898 :
899 0 : *ppll_div_3 = (const_ptr->crtcPLL_N & 0x7ff) | (get_post_div(const_ptr->crtcPLL_post_div) << 16);
900 0 : *pixclks_cntl &= ~(RADEON_PIX2CLK_SRC_SEL_MASK | RADEON_PIXCLK_TV_SRC_SEL);
901 0 : *pixclks_cntl |= RADEON_PIX2CLK_SRC_SEL_P2PLLCLK;
902 0 : }
903 :
904 0 : void radeon_legacy_tv_adjust_pll2(struct drm_encoder *encoder,
905 : uint32_t *htotal2_cntl, uint32_t *p2pll_ref_div,
906 : uint32_t *p2pll_div_0, uint32_t *pixclks_cntl)
907 : {
908 0 : struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
909 : const struct radeon_tv_mode_constants *const_ptr;
910 :
911 0 : const_ptr = radeon_legacy_tv_get_std_mode(radeon_encoder, NULL);
912 0 : if (!const_ptr)
913 0 : return;
914 :
915 0 : *htotal2_cntl = (const_ptr->hor_total & 0x7);
916 :
917 0 : *p2pll_ref_div = const_ptr->crtcPLL_M;
918 :
919 0 : *p2pll_div_0 = (const_ptr->crtcPLL_N & 0x7ff) | (get_post_div(const_ptr->crtcPLL_post_div) << 16);
920 0 : *pixclks_cntl &= ~RADEON_PIX2CLK_SRC_SEL_MASK;
921 0 : *pixclks_cntl |= RADEON_PIX2CLK_SRC_SEL_P2PLLCLK | RADEON_PIXCLK_TV_SRC_SEL;
922 0 : }
923 :
|