xref: /haiku/src/add-ons/accelerants/skeleton/engine/dac2.c (revision e81a954787e50e56a7f06f72705b7859b6ab06d1)
1 /* program the secondary DAC */
2 /* Author:
3    Rudolf Cornelissen 12/2003-9/2004
4 */
5 
6 #define MODULE_BIT 0x00001000
7 
8 #include "std.h"
9 
10 static status_t nv10_nv20_dac2_pix_pll_find(
11 	display_mode target,float * calc_pclk,uint8 * m_result,uint8 * n_result,uint8 * p_result, uint8 test);
12 
13 /* see if an analog VGA monitor is connected to connector #2 */
14 bool eng_dac2_crt_connected()
15 {
16 	uint32 output, dac;
17 	bool present;
18 
19 	/* NOTE:
20 	 * NV11 can't do this: It will report DAC1 status instead because it HAS no
21 	 * actual secondary DAC function. */
22 	/* (It DOES have a secondary palette RAM and pixelclock PLL though.) */
23 
24 	/* save output connector setting */
25 	output = DAC2R(OUTPUT);
26 	/* save DAC state */
27 	dac = DAC2R(TSTCTRL);
28 
29 	/* turn on DAC2 */
30 	DAC2W(TSTCTRL, (DAC2R(TSTCTRL) & 0xfffeffff));
31 	/* select primary head and turn off CRT (and DVI?) outputs */
32 	DAC2W(OUTPUT, (output & 0x0000feee));
33 	/* wait for signal lines to stabilize */
34 	snooze(1000);
35 	/* re-enable CRT output */
36 	DAC2W(OUTPUT, (DAC2R(OUTPUT) | 0x00000001));
37 
38 	/* setup RGB test signal levels to approx 30% of DAC range and enable them
39 	 * (NOTE: testsignal function block resides in DAC1 only (!)) */
40 	DACW(TSTDATA, ((0x2 << 30) | (0x140 << 20) | (0x140 << 10) | (0x140 << 0)));
41 	/* route test signals to output
42 	 * (NOTE: testsignal function block resides in DAC1 only (!)) */
43 	DACW(TSTCTRL, (DACR(TSTCTRL) | 0x00001000));
44 	/* wait for signal lines to stabilize */
45 	snooze(1000);
46 
47 	/* do actual detection: all signals paths high == CRT connected */
48 	if (DAC2R(TSTCTRL) & 0x10000000)
49 	{
50 		present = true;
51 		LOG(4,("DAC2: CRT detected on connector #2\n"));
52 	}
53 	else
54 	{
55 		present = false;
56 		LOG(4,("DAC2: no CRT detected on connector #2\n"));
57 	}
58 
59 	/* kill test signal routing
60 	 * (NOTE: testsignal function block resides in DAC1 only (!)) */
61 	DACW(TSTCTRL, (DACR(TSTCTRL) & 0xffffefff));
62 
63 	/* restore output connector setting */
64 	DAC2W(OUTPUT, output);
65 	/* restore DAC state */
66 	DAC2W(TSTCTRL, dac);
67 
68 	return present;
69 }
70 
71 /*set the mode, brightness is a value from 0->2 (where 1 is equivalent to direct)*/
72 status_t eng_dac2_mode(int mode,float brightness)
73 {
74 	uint8 *r,*g,*b;
75 	int i, ri;
76 
77 	/*set colour arrays to point to space reserved in shared info*/
78 	r = si->color_data;
79 	g = r + 256;
80 	b = g + 256;
81 
82 	LOG(4,("DAC2: Setting screen mode %d brightness %f\n", mode, brightness));
83 	/* init the palette for brightness specified */
84 	/* (Nvidia cards always use MSbits from screenbuffer as index for PAL) */
85 	for (i = 0; i < 256; i++)
86 	{
87 		ri = i * brightness;
88 		if (ri > 255) ri = 255;
89 		b[i] = g[i] = r[i] = ri;
90 	}
91 
92 	if (eng_dac2_palette(r,g,b) != B_OK) return B_ERROR;
93 
94 	/* disable palette RAM adressing mask */
95 	ENG_REG8(RG8_PAL2MASK) = 0xff;
96 	LOG(2,("DAC2: PAL pixrdmsk readback $%02x\n", ENG_REG8(RG8_PAL2MASK)));
97 
98 	return B_OK;
99 }
100 
101 /*program the DAC palette using the given r,g,b values*/
102 status_t eng_dac2_palette(uint8 r[256],uint8 g[256],uint8 b[256])
103 {
104 	int i;
105 
106 	LOG(4,("DAC2: setting palette\n"));
107 
108 	/* select first PAL adress before starting programming */
109 	ENG_REG8(RG8_PAL2INDW) = 0x00;
110 
111 	/* loop through all 256 to program DAC */
112 	for (i = 0; i < 256; i++)
113 	{
114 		/* the 6 implemented bits are on b0-b5 of the bus */
115 		ENG_REG8(RG8_PAL2DATA) = r[i];
116 		ENG_REG8(RG8_PAL2DATA) = g[i];
117 		ENG_REG8(RG8_PAL2DATA) = b[i];
118 	}
119 	if (ENG_REG8(RG8_PAL2INDW) != 0x00)
120 	{
121 		LOG(8,("DAC2: PAL write index incorrect after programming\n"));
122 		return B_ERROR;
123 	}
124 if (1)
125  {//reread LUT
126 	uint8 R, G, B;
127 
128 	/* select first PAL adress to read (modulo 3 counter) */
129 	ENG_REG8(RG8_PAL2INDR) = 0x00;
130 	for (i = 0; i < 256; i++)
131 	{
132 		R = ENG_REG8(RG8_PAL2DATA);
133 		G = ENG_REG8(RG8_PAL2DATA);
134 		B = ENG_REG8(RG8_PAL2DATA);
135 		if ((r[i] != R) || (g[i] != G) || (b[i] != B))
136 			LOG(1,("DAC2 palette %d: w %x %x %x, r %x %x %x\n", i, r[i], g[i], b[i], R, G, B)); // apsed
137 	}
138  }
139 
140 	return B_OK;
141 }
142 
143 /*program the pixpll - frequency in kHz*/
144 status_t eng_dac2_set_pix_pll(display_mode target)
145 {
146 	uint8 m=0,n=0,p=0;
147 //	uint time = 0;
148 
149 	float pix_setting, req_pclk;
150 	status_t result;
151 
152 	/* we offer this option because some panels have very tight restrictions,
153 	 * and there's no overlapping settings range that makes them all work.
154 	 * note:
155 	 * this assumes the cards BIOS correctly programmed the panel (is likely) */
156 	//fixme: when VESA DDC EDID stuff is implemented, this option can be deleted...
157 	if (si->ps.tmds2_active && !si->settings.pgm_panel)
158 	{
159 		LOG(4,("DAC2: Not programming DFP refresh (specified in skel.settings)\n"));
160 		return B_OK;
161 	}
162 
163 	/* fix a DVI or laptop flatpanel to 60Hz refresh! */
164 	/* Note:
165 	 * The pixelclock drives the flatpanel modeline, not the CRTC modeline. */
166 	if (si->ps.tmds2_active)
167 	{
168 		LOG(4,("DAC2: Fixing DFP refresh to 60Hz!\n"));
169 
170 		/* use the panel's modeline to determine the needed pixelclock */
171 		target.timing.pixel_clock = si->ps.p2_timing.pixel_clock;
172 	}
173 
174 	req_pclk = (target.timing.pixel_clock)/1000.0;
175 	LOG(4,("DAC2: Setting PIX PLL for pixelclock %f\n", req_pclk));
176 
177 	/* signal that we actually want to set the mode */
178 	result = eng_dac2_pix_pll_find(target,&pix_setting,&m,&n,&p, 1);
179 	if (result != B_OK)
180 	{
181 		return result;
182 	}
183 
184 	/*reprogram (disable,select,wait for stability,enable)*/
185 //	DXIW(PIXCLKCTRL,(DXIR(PIXCLKCTRL)&0x0F)|0x04);  /*disable the PIXPLL*/
186 //	DXIW(PIXCLKCTRL,(DXIR(PIXCLKCTRL)&0x0C)|0x01);  /*select the PIXPLL*/
187 
188 	/* program new frequency */
189 	DAC2W(PIXPLLC, ((p << 16) | (n << 8) | m));
190 
191 	/* program 2nd set N and M scalers if they exist (b31=1 enables them) */
192 	if (si->ps.ext_pll) DAC2W(PIXPLLC2, 0x80000401);
193 
194 	/* Wait for the PIXPLL frequency to lock until timeout occurs */
195 //fixme: do NV cards have a LOCK indication bit??
196 /*	while((!(DXIR(PIXPLLSTAT)&0x40)) & (time <= 2000))
197 	{
198 		time++;
199 		snooze(1);
200 	}
201 
202 	if (time > 2000)
203 		LOG(2,("DAC: PIX PLL frequency not locked!\n"));
204 	else
205 		LOG(2,("DAC: PIX PLL frequency locked\n"));
206 	DXIW(PIXCLKCTRL,DXIR(PIXCLKCTRL)&0x0B);         //enable the PIXPLL
207 */
208 
209 //for now:
210 	/* Give the PIXPLL frequency some time to lock... */
211 	snooze(1000);
212 	LOG(2,("DAC2: PIX PLL frequency should be locked now...\n"));
213 
214 	return B_OK;
215 }
216 
217 /* find nearest valid pix pll */
218 status_t eng_dac2_pix_pll_find
219 	(display_mode target,float * calc_pclk,uint8 * m_result,uint8 * n_result,uint8 * p_result, uint8 test)
220 {
221 	switch (si->ps.card_type) {
222 		default:   return nv10_nv20_dac2_pix_pll_find(target, calc_pclk, m_result, n_result, p_result, test);
223 	}
224 	return B_ERROR;
225 }
226 
227 /* find nearest valid pixel PLL setting */
228 static status_t nv10_nv20_dac2_pix_pll_find(
229 	display_mode target,float * calc_pclk,uint8 * m_result,uint8 * n_result,uint8 * p_result, uint8 test)
230 {
231 	int m = 0, n = 0, p = 0/*, m_max*/;
232 	float error, error_best = 999999999;
233 	int best[3];
234 	float f_vco, max_pclk;
235 	float req_pclk = target.timing.pixel_clock/1000.0;
236 
237 	/* determine the max. reference-frequency postscaler setting for the
238 	 * current card (see G100, G200 and G400 specs). */
239 /*	switch(si->ps.card_type)
240 	{
241 	case G100:
242 		LOG(4,("DAC: G100 restrictions apply\n"));
243 		m_max = 7;
244 		break;
245 	case G200:
246 		LOG(4,("DAC: G200 restrictions apply\n"));
247 		m_max = 7;
248 		break;
249 	default:
250 		LOG(4,("DAC: G400/G400MAX restrictions apply\n"));
251 		m_max = 32;
252 		break;
253 	}
254 */
255 	LOG(4,("DAC2: NV10/NV20 restrictions apply\n"));
256 
257 	/* determine the max. pixelclock for the current videomode */
258 	switch (target.space)
259 	{
260 		case B_CMAP8:
261 			max_pclk = si->ps.max_dac2_clock_8;
262 			break;
263 		case B_RGB15_LITTLE:
264 		case B_RGB16_LITTLE:
265 			max_pclk = si->ps.max_dac2_clock_16;
266 			break;
267 		case B_RGB24_LITTLE:
268 			max_pclk = si->ps.max_dac2_clock_24;
269 			break;
270 		case B_RGB32_LITTLE:
271 			max_pclk = si->ps.max_dac2_clock_32;
272 			break;
273 		default:
274 			/* use fail-safe value */
275 			max_pclk = si->ps.max_dac2_clock_32;
276 			break;
277 	}
278 	/* if some dualhead mode is active, an extra restriction might apply */
279 	if ((target.flags & DUALHEAD_BITS) && (target.space == B_RGB32_LITTLE))
280 		max_pclk = si->ps.max_dac2_clock_32dh;
281 
282 	/* Make sure the requested pixelclock is within the PLL's operational limits */
283 	/* lower limit is min_pixel_vco divided by highest postscaler-factor */
284 	if (req_pclk < (si->ps.min_video_vco / 16.0))
285 	{
286 		LOG(4,("DAC2: clamping pixclock: requested %fMHz, set to %fMHz\n",
287 										req_pclk, (float)(si->ps.min_video_vco / 16.0)));
288 		req_pclk = (si->ps.min_video_vco / 16.0);
289 	}
290 	/* upper limit is given by pins in combination with current active mode */
291 	if (req_pclk > max_pclk)
292 	{
293 		LOG(4,("DAC2: clamping pixclock: requested %fMHz, set to %fMHz\n",
294 														req_pclk, (float)max_pclk));
295 		req_pclk = max_pclk;
296 	}
297 
298 	/* iterate through all valid PLL postscaler settings */
299 	for (p=0x01; p < 0x20; p = p<<1)
300 	{
301 		/* calculate the needed VCO frequency for this postscaler setting */
302 		f_vco = req_pclk * p;
303 
304 		/* check if this is within range of the VCO specs */
305 		if ((f_vco >= si->ps.min_video_vco) && (f_vco <= si->ps.max_video_vco))
306 		{
307 			/* FX5600 and FX5700 tweak for 2nd set N and M scalers */
308 			if (si->ps.ext_pll) f_vco /= 4;
309 
310 			/* iterate trough all valid reference-frequency postscaler settings */
311 			for (m = 7; m <= 14; m++)
312 			{
313 				/* check if phase-discriminator will be within operational limits */
314 				//fixme: PLL calcs will be resetup/splitup/updated...
315 				if (si->ps.card_type == NV36)
316 				{
317 					if (((si->ps.f_ref / m) < 3.2) || ((si->ps.f_ref / m) > 6.4)) continue;
318 				}
319 				else
320 				{
321 					if (((si->ps.f_ref / m) < 1.0) || ((si->ps.f_ref / m) > 2.0)) continue;
322 				}
323 
324 				/* calculate VCO postscaler setting for current setup.. */
325 				n = (int)(((f_vco * m) / si->ps.f_ref) + 0.5);
326 				/* ..and check for validity */
327 				if ((n < 1) || (n > 255))	continue;
328 
329 				/* find error in frequency this setting gives */
330 				if (si->ps.ext_pll)
331 				{
332 					/* FX5600 and FX5700 tweak for 2nd set N and M scalers */
333 					error = fabs((req_pclk / 4) - (((si->ps.f_ref / m) * n) / p));
334 				}
335 				else
336 					error = fabs(req_pclk - (((si->ps.f_ref / m) * n) / p));
337 
338 				/* note the setting if best yet */
339 				if (error < error_best)
340 				{
341 					error_best = error;
342 					best[0]=m;
343 					best[1]=n;
344 					best[2]=p;
345 				}
346 			}
347 		}
348 	}
349 
350 	/* setup the scalers programming values for found optimum setting */
351 	m = best[0];
352 	n = best[1];
353 	p = best[2];
354 
355 	/* log the VCO frequency found */
356 	f_vco = ((si->ps.f_ref / m) * n);
357 	/* FX5600 and FX5700 tweak for 2nd set N and M scalers */
358 	if (si->ps.ext_pll) f_vco *= 4;
359 
360 	LOG(2,("DAC2: pix VCO frequency found %fMhz\n", f_vco));
361 
362 	/* return the results */
363 	*calc_pclk = (f_vco / p);
364 	*m_result = m;
365 	*n_result = n;
366 	switch(p)
367 	{
368 	case 1:
369 		p = 0x00;
370 		break;
371 	case 2:
372 		p = 0x01;
373 		break;
374 	case 4:
375 		p = 0x02;
376 		break;
377 	case 8:
378 		p = 0x03;
379 		break;
380 	case 16:
381 		p = 0x04;
382 		break;
383 	}
384 	*p_result = p;
385 
386 	/* display the found pixelclock values */
387 	LOG(2,("DAC2: pix PLL check: requested %fMHz got %fMHz, mnp 0x%02x 0x%02x 0x%02x\n",
388 		req_pclk, *calc_pclk, *m_result, *n_result, *p_result));
389 
390 	return B_OK;
391 }
392