xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/nouveau/dispnv04/dac.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Copyright 2003 NVIDIA, Corporation
3*4882a593Smuzhiyun  * Copyright 2006 Dave Airlie
4*4882a593Smuzhiyun  * Copyright 2007 Maarten Maathuis
5*4882a593Smuzhiyun  * Copyright 2007-2009 Stuart Bennett
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Permission is hereby granted, free of charge, to any person obtaining a
8*4882a593Smuzhiyun  * copy of this software and associated documentation files (the "Software"),
9*4882a593Smuzhiyun  * to deal in the Software without restriction, including without limitation
10*4882a593Smuzhiyun  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
11*4882a593Smuzhiyun  * and/or sell copies of the Software, and to permit persons to whom the
12*4882a593Smuzhiyun  * Software is furnished to do so, subject to the following conditions:
13*4882a593Smuzhiyun  *
14*4882a593Smuzhiyun  * The above copyright notice and this permission notice (including the next
15*4882a593Smuzhiyun  * paragraph) shall be included in all copies or substantial portions of the
16*4882a593Smuzhiyun  * Software.
17*4882a593Smuzhiyun  *
18*4882a593Smuzhiyun  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
19*4882a593Smuzhiyun  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20*4882a593Smuzhiyun  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
21*4882a593Smuzhiyun  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
22*4882a593Smuzhiyun  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
23*4882a593Smuzhiyun  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
24*4882a593Smuzhiyun  * DEALINGS IN THE SOFTWARE.
25*4882a593Smuzhiyun  */
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun #include <drm/drm_crtc_helper.h>
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #include "nouveau_drv.h"
30*4882a593Smuzhiyun #include "nouveau_encoder.h"
31*4882a593Smuzhiyun #include "nouveau_connector.h"
32*4882a593Smuzhiyun #include "nouveau_crtc.h"
33*4882a593Smuzhiyun #include "hw.h"
34*4882a593Smuzhiyun #include "nvreg.h"
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #include <subdev/bios/gpio.h>
37*4882a593Smuzhiyun #include <subdev/gpio.h>
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun #include <nvif/timer.h>
40*4882a593Smuzhiyun 
nv04_dac_output_offset(struct drm_encoder * encoder)41*4882a593Smuzhiyun int nv04_dac_output_offset(struct drm_encoder *encoder)
42*4882a593Smuzhiyun {
43*4882a593Smuzhiyun 	struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
44*4882a593Smuzhiyun 	int offset = 0;
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 	if (dcb->or & (8 | DCB_OUTPUT_C))
47*4882a593Smuzhiyun 		offset += 0x68;
48*4882a593Smuzhiyun 	if (dcb->or & (8 | DCB_OUTPUT_B))
49*4882a593Smuzhiyun 		offset += 0x2000;
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun 	return offset;
52*4882a593Smuzhiyun }
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun /*
55*4882a593Smuzhiyun  * arbitrary limit to number of sense oscillations tolerated in one sample
56*4882a593Smuzhiyun  * period (observed to be at least 13 in "nvidia")
57*4882a593Smuzhiyun  */
58*4882a593Smuzhiyun #define MAX_HBLANK_OSC 20
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun /*
61*4882a593Smuzhiyun  * arbitrary limit to number of conflicting sample pairs to tolerate at a
62*4882a593Smuzhiyun  * voltage step (observed to be at least 5 in "nvidia")
63*4882a593Smuzhiyun  */
64*4882a593Smuzhiyun #define MAX_SAMPLE_PAIRS 10
65*4882a593Smuzhiyun 
sample_load_twice(struct drm_device * dev,bool sense[2])66*4882a593Smuzhiyun static int sample_load_twice(struct drm_device *dev, bool sense[2])
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(dev);
69*4882a593Smuzhiyun 	struct nvif_object *device = &drm->client.device.object;
70*4882a593Smuzhiyun 	int i;
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun 	for (i = 0; i < 2; i++) {
73*4882a593Smuzhiyun 		bool sense_a, sense_b, sense_b_prime;
74*4882a593Smuzhiyun 		int j = 0;
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun 		/*
77*4882a593Smuzhiyun 		 * wait for bit 0 clear -- out of hblank -- (say reg value 0x4),
78*4882a593Smuzhiyun 		 * then wait for transition 0x4->0x5->0x4: enter hblank, leave
79*4882a593Smuzhiyun 		 * hblank again
80*4882a593Smuzhiyun 		 * use a 10ms timeout (guards against crtc being inactive, in
81*4882a593Smuzhiyun 		 * which case blank state would never change)
82*4882a593Smuzhiyun 		 */
83*4882a593Smuzhiyun 		if (nvif_msec(&drm->client.device, 10,
84*4882a593Smuzhiyun 			if (!(nvif_rd32(device, NV_PRMCIO_INP0__COLOR) & 1))
85*4882a593Smuzhiyun 				break;
86*4882a593Smuzhiyun 		) < 0)
87*4882a593Smuzhiyun 			return -EBUSY;
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 		if (nvif_msec(&drm->client.device, 10,
90*4882a593Smuzhiyun 			if ( (nvif_rd32(device, NV_PRMCIO_INP0__COLOR) & 1))
91*4882a593Smuzhiyun 				break;
92*4882a593Smuzhiyun 		) < 0)
93*4882a593Smuzhiyun 			return -EBUSY;
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun 		if (nvif_msec(&drm->client.device, 10,
96*4882a593Smuzhiyun 			if (!(nvif_rd32(device, NV_PRMCIO_INP0__COLOR) & 1))
97*4882a593Smuzhiyun 				break;
98*4882a593Smuzhiyun 		) < 0)
99*4882a593Smuzhiyun 			return -EBUSY;
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun 		udelay(100);
102*4882a593Smuzhiyun 		/* when level triggers, sense is _LO_ */
103*4882a593Smuzhiyun 		sense_a = nvif_rd08(device, NV_PRMCIO_INP0) & 0x10;
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 		/* take another reading until it agrees with sense_a... */
106*4882a593Smuzhiyun 		do {
107*4882a593Smuzhiyun 			udelay(100);
108*4882a593Smuzhiyun 			sense_b = nvif_rd08(device, NV_PRMCIO_INP0) & 0x10;
109*4882a593Smuzhiyun 			if (sense_a != sense_b) {
110*4882a593Smuzhiyun 				sense_b_prime =
111*4882a593Smuzhiyun 					nvif_rd08(device, NV_PRMCIO_INP0) & 0x10;
112*4882a593Smuzhiyun 				if (sense_b == sense_b_prime) {
113*4882a593Smuzhiyun 					/* ... unless two consecutive subsequent
114*4882a593Smuzhiyun 					 * samples agree; sense_a is replaced */
115*4882a593Smuzhiyun 					sense_a = sense_b;
116*4882a593Smuzhiyun 					/* force mis-match so we loop */
117*4882a593Smuzhiyun 					sense_b = !sense_a;
118*4882a593Smuzhiyun 				}
119*4882a593Smuzhiyun 			}
120*4882a593Smuzhiyun 		} while ((sense_a != sense_b) && ++j < MAX_HBLANK_OSC);
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 		if (j == MAX_HBLANK_OSC)
123*4882a593Smuzhiyun 			/* with so much oscillation, default to sense:LO */
124*4882a593Smuzhiyun 			sense[i] = false;
125*4882a593Smuzhiyun 		else
126*4882a593Smuzhiyun 			sense[i] = sense_a;
127*4882a593Smuzhiyun 	}
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 	return 0;
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun 
nv04_dac_detect(struct drm_encoder * encoder,struct drm_connector * connector)132*4882a593Smuzhiyun static enum drm_connector_status nv04_dac_detect(struct drm_encoder *encoder,
133*4882a593Smuzhiyun 						 struct drm_connector *connector)
134*4882a593Smuzhiyun {
135*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
136*4882a593Smuzhiyun 	struct nvif_object *device = &nouveau_drm(dev)->client.device.object;
137*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(dev);
138*4882a593Smuzhiyun 	uint8_t saved_seq1, saved_pi, saved_rpc1, saved_cr_mode;
139*4882a593Smuzhiyun 	uint8_t saved_palette0[3], saved_palette_mask;
140*4882a593Smuzhiyun 	uint32_t saved_rtest_ctrl, saved_rgen_ctrl;
141*4882a593Smuzhiyun 	int i;
142*4882a593Smuzhiyun 	uint8_t blue;
143*4882a593Smuzhiyun 	bool sense = true;
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 	/*
146*4882a593Smuzhiyun 	 * for this detection to work, there needs to be a mode set up on the
147*4882a593Smuzhiyun 	 * CRTC.  this is presumed to be the case
148*4882a593Smuzhiyun 	 */
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	if (nv_two_heads(dev))
151*4882a593Smuzhiyun 		/* only implemented for head A for now */
152*4882a593Smuzhiyun 		NVSetOwner(dev, 0);
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 	saved_cr_mode = NVReadVgaCrtc(dev, 0, NV_CIO_CR_MODE_INDEX);
155*4882a593Smuzhiyun 	NVWriteVgaCrtc(dev, 0, NV_CIO_CR_MODE_INDEX, saved_cr_mode | 0x80);
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	saved_seq1 = NVReadVgaSeq(dev, 0, NV_VIO_SR_CLOCK_INDEX);
158*4882a593Smuzhiyun 	NVWriteVgaSeq(dev, 0, NV_VIO_SR_CLOCK_INDEX, saved_seq1 & ~0x20);
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	saved_rtest_ctrl = NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL);
161*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL,
162*4882a593Smuzhiyun 		      saved_rtest_ctrl & ~NV_PRAMDAC_TEST_CONTROL_PWRDWN_DAC_OFF);
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	msleep(10);
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun 	saved_pi = NVReadVgaCrtc(dev, 0, NV_CIO_CRE_PIXEL_INDEX);
167*4882a593Smuzhiyun 	NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_PIXEL_INDEX,
168*4882a593Smuzhiyun 		       saved_pi & ~(0x80 | MASK(NV_CIO_CRE_PIXEL_FORMAT)));
169*4882a593Smuzhiyun 	saved_rpc1 = NVReadVgaCrtc(dev, 0, NV_CIO_CRE_RPC1_INDEX);
170*4882a593Smuzhiyun 	NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_RPC1_INDEX, saved_rpc1 & ~0xc0);
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	nvif_wr08(device, NV_PRMDIO_READ_MODE_ADDRESS, 0x0);
173*4882a593Smuzhiyun 	for (i = 0; i < 3; i++)
174*4882a593Smuzhiyun 		saved_palette0[i] = nvif_rd08(device, NV_PRMDIO_PALETTE_DATA);
175*4882a593Smuzhiyun 	saved_palette_mask = nvif_rd08(device, NV_PRMDIO_PIXEL_MASK);
176*4882a593Smuzhiyun 	nvif_wr08(device, NV_PRMDIO_PIXEL_MASK, 0);
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	saved_rgen_ctrl = NVReadRAMDAC(dev, 0, NV_PRAMDAC_GENERAL_CONTROL);
179*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_GENERAL_CONTROL,
180*4882a593Smuzhiyun 		      (saved_rgen_ctrl & ~(NV_PRAMDAC_GENERAL_CONTROL_BPC_8BITS |
181*4882a593Smuzhiyun 					   NV_PRAMDAC_GENERAL_CONTROL_TERMINATION_75OHM)) |
182*4882a593Smuzhiyun 		      NV_PRAMDAC_GENERAL_CONTROL_PIXMIX_ON);
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	blue = 8;	/* start of test range */
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 	do {
187*4882a593Smuzhiyun 		bool sense_pair[2];
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 		nvif_wr08(device, NV_PRMDIO_WRITE_MODE_ADDRESS, 0);
190*4882a593Smuzhiyun 		nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, 0);
191*4882a593Smuzhiyun 		nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, 0);
192*4882a593Smuzhiyun 		/* testing blue won't find monochrome monitors.  I don't care */
193*4882a593Smuzhiyun 		nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, blue);
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 		i = 0;
196*4882a593Smuzhiyun 		/* take sample pairs until both samples in the pair agree */
197*4882a593Smuzhiyun 		do {
198*4882a593Smuzhiyun 			if (sample_load_twice(dev, sense_pair))
199*4882a593Smuzhiyun 				goto out;
200*4882a593Smuzhiyun 		} while ((sense_pair[0] != sense_pair[1]) &&
201*4882a593Smuzhiyun 							++i < MAX_SAMPLE_PAIRS);
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 		if (i == MAX_SAMPLE_PAIRS)
204*4882a593Smuzhiyun 			/* too much oscillation defaults to LO */
205*4882a593Smuzhiyun 			sense = false;
206*4882a593Smuzhiyun 		else
207*4882a593Smuzhiyun 			sense = sense_pair[0];
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 	/*
210*4882a593Smuzhiyun 	 * if sense goes LO before blue ramps to 0x18, monitor is not connected.
211*4882a593Smuzhiyun 	 * ergo, if blue gets to 0x18, monitor must be connected
212*4882a593Smuzhiyun 	 */
213*4882a593Smuzhiyun 	} while (++blue < 0x18 && sense);
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun out:
216*4882a593Smuzhiyun 	nvif_wr08(device, NV_PRMDIO_PIXEL_MASK, saved_palette_mask);
217*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_GENERAL_CONTROL, saved_rgen_ctrl);
218*4882a593Smuzhiyun 	nvif_wr08(device, NV_PRMDIO_WRITE_MODE_ADDRESS, 0);
219*4882a593Smuzhiyun 	for (i = 0; i < 3; i++)
220*4882a593Smuzhiyun 		nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, saved_palette0[i]);
221*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL, saved_rtest_ctrl);
222*4882a593Smuzhiyun 	NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_PIXEL_INDEX, saved_pi);
223*4882a593Smuzhiyun 	NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_RPC1_INDEX, saved_rpc1);
224*4882a593Smuzhiyun 	NVWriteVgaSeq(dev, 0, NV_VIO_SR_CLOCK_INDEX, saved_seq1);
225*4882a593Smuzhiyun 	NVWriteVgaCrtc(dev, 0, NV_CIO_CR_MODE_INDEX, saved_cr_mode);
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 	if (blue == 0x18) {
228*4882a593Smuzhiyun 		NV_DEBUG(drm, "Load detected on head A\n");
229*4882a593Smuzhiyun 		return connector_status_connected;
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	return connector_status_disconnected;
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun 
nv17_dac_sample_load(struct drm_encoder * encoder)235*4882a593Smuzhiyun uint32_t nv17_dac_sample_load(struct drm_encoder *encoder)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
238*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(dev);
239*4882a593Smuzhiyun 	struct nvif_object *device = &nouveau_drm(dev)->client.device.object;
240*4882a593Smuzhiyun 	struct nvkm_gpio *gpio = nvxx_gpio(&drm->client.device);
241*4882a593Smuzhiyun 	struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
242*4882a593Smuzhiyun 	uint32_t sample, testval, regoffset = nv04_dac_output_offset(encoder);
243*4882a593Smuzhiyun 	uint32_t saved_powerctrl_2 = 0, saved_powerctrl_4 = 0, saved_routput,
244*4882a593Smuzhiyun 		saved_rtest_ctrl, saved_gpio0 = 0, saved_gpio1 = 0, temp, routput;
245*4882a593Smuzhiyun 	int head;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun #define RGB_TEST_DATA(r, g, b) (r << 0 | g << 10 | b << 20)
248*4882a593Smuzhiyun 	if (dcb->type == DCB_OUTPUT_TV) {
249*4882a593Smuzhiyun 		testval = RGB_TEST_DATA(0xa0, 0xa0, 0xa0);
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 		if (drm->vbios.tvdactestval)
252*4882a593Smuzhiyun 			testval = drm->vbios.tvdactestval;
253*4882a593Smuzhiyun 	} else {
254*4882a593Smuzhiyun 		testval = RGB_TEST_DATA(0x140, 0x140, 0x140); /* 0x94050140 */
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 		if (drm->vbios.dactestval)
257*4882a593Smuzhiyun 			testval = drm->vbios.dactestval;
258*4882a593Smuzhiyun 	}
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun 	saved_rtest_ctrl = NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset);
261*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset,
262*4882a593Smuzhiyun 		      saved_rtest_ctrl & ~NV_PRAMDAC_TEST_CONTROL_PWRDWN_DAC_OFF);
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	saved_powerctrl_2 = nvif_rd32(device, NV_PBUS_POWERCTRL_2);
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 	nvif_wr32(device, NV_PBUS_POWERCTRL_2, saved_powerctrl_2 & 0xd7ffffff);
267*4882a593Smuzhiyun 	if (regoffset == 0x68) {
268*4882a593Smuzhiyun 		saved_powerctrl_4 = nvif_rd32(device, NV_PBUS_POWERCTRL_4);
269*4882a593Smuzhiyun 		nvif_wr32(device, NV_PBUS_POWERCTRL_4, saved_powerctrl_4 & 0xffffffcf);
270*4882a593Smuzhiyun 	}
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	if (gpio) {
273*4882a593Smuzhiyun 		saved_gpio1 = nvkm_gpio_get(gpio, 0, DCB_GPIO_TVDAC1, 0xff);
274*4882a593Smuzhiyun 		saved_gpio0 = nvkm_gpio_get(gpio, 0, DCB_GPIO_TVDAC0, 0xff);
275*4882a593Smuzhiyun 		nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC1, 0xff, dcb->type == DCB_OUTPUT_TV);
276*4882a593Smuzhiyun 		nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC0, 0xff, dcb->type == DCB_OUTPUT_TV);
277*4882a593Smuzhiyun 	}
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	msleep(4);
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	saved_routput = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset);
282*4882a593Smuzhiyun 	head = (saved_routput & 0x100) >> 8;
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	/* if there's a spare crtc, using it will minimise flicker */
285*4882a593Smuzhiyun 	if (!(NVReadVgaCrtc(dev, head, NV_CIO_CRE_RPC1_INDEX) & 0xC0))
286*4882a593Smuzhiyun 		head ^= 1;
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	/* nv driver and nv31 use 0xfffffeee, nv34 and 6600 use 0xfffffece */
289*4882a593Smuzhiyun 	routput = (saved_routput & 0xfffffece) | head << 8;
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 	if (drm->client.device.info.family >= NV_DEVICE_INFO_V0_CURIE) {
292*4882a593Smuzhiyun 		if (dcb->type == DCB_OUTPUT_TV)
293*4882a593Smuzhiyun 			routput |= 0x1a << 16;
294*4882a593Smuzhiyun 		else
295*4882a593Smuzhiyun 			routput &= ~(0x1a << 16);
296*4882a593Smuzhiyun 	}
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset, routput);
299*4882a593Smuzhiyun 	msleep(1);
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun 	temp = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset);
302*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset, temp | 1);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, head, NV_PRAMDAC_TESTPOINT_DATA,
305*4882a593Smuzhiyun 		      NV_PRAMDAC_TESTPOINT_DATA_NOTBLANK | testval);
306*4882a593Smuzhiyun 	temp = NVReadRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL);
307*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL,
308*4882a593Smuzhiyun 		      temp | NV_PRAMDAC_TEST_CONTROL_TP_INS_EN_ASSERTED);
309*4882a593Smuzhiyun 	msleep(5);
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	sample = NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset);
312*4882a593Smuzhiyun 	/* do it again just in case it's a residual current */
313*4882a593Smuzhiyun 	sample &= NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset);
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	temp = NVReadRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL);
316*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL,
317*4882a593Smuzhiyun 		      temp & ~NV_PRAMDAC_TEST_CONTROL_TP_INS_EN_ASSERTED);
318*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, head, NV_PRAMDAC_TESTPOINT_DATA, 0);
319*4882a593Smuzhiyun 
320*4882a593Smuzhiyun 	/* bios does something more complex for restoring, but I think this is good enough */
321*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset, saved_routput);
322*4882a593Smuzhiyun 	NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset, saved_rtest_ctrl);
323*4882a593Smuzhiyun 	if (regoffset == 0x68)
324*4882a593Smuzhiyun 		nvif_wr32(device, NV_PBUS_POWERCTRL_4, saved_powerctrl_4);
325*4882a593Smuzhiyun 	nvif_wr32(device, NV_PBUS_POWERCTRL_2, saved_powerctrl_2);
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	if (gpio) {
328*4882a593Smuzhiyun 		nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC1, 0xff, saved_gpio1);
329*4882a593Smuzhiyun 		nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC0, 0xff, saved_gpio0);
330*4882a593Smuzhiyun 	}
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 	return sample;
333*4882a593Smuzhiyun }
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun static enum drm_connector_status
nv17_dac_detect(struct drm_encoder * encoder,struct drm_connector * connector)336*4882a593Smuzhiyun nv17_dac_detect(struct drm_encoder *encoder, struct drm_connector *connector)
337*4882a593Smuzhiyun {
338*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(encoder->dev);
339*4882a593Smuzhiyun 	struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	if (nv04_dac_in_use(encoder))
342*4882a593Smuzhiyun 		return connector_status_disconnected;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	if (nv17_dac_sample_load(encoder) &
345*4882a593Smuzhiyun 	    NV_PRAMDAC_TEST_CONTROL_SENSEB_ALLHI) {
346*4882a593Smuzhiyun 		NV_DEBUG(drm, "Load detected on output %c\n",
347*4882a593Smuzhiyun 			 '@' + ffs(dcb->or));
348*4882a593Smuzhiyun 		return connector_status_connected;
349*4882a593Smuzhiyun 	} else {
350*4882a593Smuzhiyun 		return connector_status_disconnected;
351*4882a593Smuzhiyun 	}
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun 
nv04_dac_mode_fixup(struct drm_encoder * encoder,const struct drm_display_mode * mode,struct drm_display_mode * adjusted_mode)354*4882a593Smuzhiyun static bool nv04_dac_mode_fixup(struct drm_encoder *encoder,
355*4882a593Smuzhiyun 				const struct drm_display_mode *mode,
356*4882a593Smuzhiyun 				struct drm_display_mode *adjusted_mode)
357*4882a593Smuzhiyun {
358*4882a593Smuzhiyun 	if (nv04_dac_in_use(encoder))
359*4882a593Smuzhiyun 		return false;
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	return true;
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun 
nv04_dac_prepare(struct drm_encoder * encoder)364*4882a593Smuzhiyun static void nv04_dac_prepare(struct drm_encoder *encoder)
365*4882a593Smuzhiyun {
366*4882a593Smuzhiyun 	const struct drm_encoder_helper_funcs *helper = encoder->helper_private;
367*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
368*4882a593Smuzhiyun 	int head = nouveau_crtc(encoder->crtc)->index;
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	helper->dpms(encoder, DRM_MODE_DPMS_OFF);
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	nv04_dfp_disable(dev, head);
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun 
nv04_dac_mode_set(struct drm_encoder * encoder,struct drm_display_mode * mode,struct drm_display_mode * adjusted_mode)375*4882a593Smuzhiyun static void nv04_dac_mode_set(struct drm_encoder *encoder,
376*4882a593Smuzhiyun 			      struct drm_display_mode *mode,
377*4882a593Smuzhiyun 			      struct drm_display_mode *adjusted_mode)
378*4882a593Smuzhiyun {
379*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
380*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(dev);
381*4882a593Smuzhiyun 	int head = nouveau_crtc(encoder->crtc)->index;
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	if (nv_gf4_disp_arch(dev)) {
384*4882a593Smuzhiyun 		struct drm_encoder *rebind;
385*4882a593Smuzhiyun 		uint32_t dac_offset = nv04_dac_output_offset(encoder);
386*4882a593Smuzhiyun 		uint32_t otherdac;
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun 		/* bit 16-19 are bits that are set on some G70 cards,
389*4882a593Smuzhiyun 		 * but don't seem to have much effect */
390*4882a593Smuzhiyun 		NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + dac_offset,
391*4882a593Smuzhiyun 			      head << 8 | NV_PRAMDAC_DACCLK_SEL_DACCLK);
392*4882a593Smuzhiyun 		/* force any other vga encoders to bind to the other crtc */
393*4882a593Smuzhiyun 		list_for_each_entry(rebind, &dev->mode_config.encoder_list, head) {
394*4882a593Smuzhiyun 			if (rebind == encoder
395*4882a593Smuzhiyun 			    || nouveau_encoder(rebind)->dcb->type != DCB_OUTPUT_ANALOG)
396*4882a593Smuzhiyun 				continue;
397*4882a593Smuzhiyun 
398*4882a593Smuzhiyun 			dac_offset = nv04_dac_output_offset(rebind);
399*4882a593Smuzhiyun 			otherdac = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + dac_offset);
400*4882a593Smuzhiyun 			NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + dac_offset,
401*4882a593Smuzhiyun 				      (otherdac & ~0x0100) | (head ^ 1) << 8);
402*4882a593Smuzhiyun 		}
403*4882a593Smuzhiyun 	}
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun 	/* This could use refinement for flatpanels, but it should work this way */
406*4882a593Smuzhiyun 	if (drm->client.device.info.chipset < 0x44)
407*4882a593Smuzhiyun 		NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + nv04_dac_output_offset(encoder), 0xf0000000);
408*4882a593Smuzhiyun 	else
409*4882a593Smuzhiyun 		NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + nv04_dac_output_offset(encoder), 0x00100000);
410*4882a593Smuzhiyun }
411*4882a593Smuzhiyun 
nv04_dac_commit(struct drm_encoder * encoder)412*4882a593Smuzhiyun static void nv04_dac_commit(struct drm_encoder *encoder)
413*4882a593Smuzhiyun {
414*4882a593Smuzhiyun 	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
415*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(encoder->dev);
416*4882a593Smuzhiyun 	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
417*4882a593Smuzhiyun 	const struct drm_encoder_helper_funcs *helper = encoder->helper_private;
418*4882a593Smuzhiyun 
419*4882a593Smuzhiyun 	helper->dpms(encoder, DRM_MODE_DPMS_ON);
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	NV_DEBUG(drm, "Output %s is running on CRTC %d using output %c\n",
422*4882a593Smuzhiyun 		 nv04_encoder_get_connector(nv_encoder)->base.name,
423*4882a593Smuzhiyun 		 nv_crtc->index, '@' + ffs(nv_encoder->dcb->or));
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun 
nv04_dac_update_dacclk(struct drm_encoder * encoder,bool enable)426*4882a593Smuzhiyun void nv04_dac_update_dacclk(struct drm_encoder *encoder, bool enable)
427*4882a593Smuzhiyun {
428*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
429*4882a593Smuzhiyun 	struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	if (nv_gf4_disp_arch(dev)) {
432*4882a593Smuzhiyun 		uint32_t *dac_users = &nv04_display(dev)->dac_users[ffs(dcb->or) - 1];
433*4882a593Smuzhiyun 		int dacclk_off = NV_PRAMDAC_DACCLK + nv04_dac_output_offset(encoder);
434*4882a593Smuzhiyun 		uint32_t dacclk = NVReadRAMDAC(dev, 0, dacclk_off);
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 		if (enable) {
437*4882a593Smuzhiyun 			*dac_users |= 1 << dcb->index;
438*4882a593Smuzhiyun 			NVWriteRAMDAC(dev, 0, dacclk_off, dacclk | NV_PRAMDAC_DACCLK_SEL_DACCLK);
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 		} else {
441*4882a593Smuzhiyun 			*dac_users &= ~(1 << dcb->index);
442*4882a593Smuzhiyun 			if (!*dac_users)
443*4882a593Smuzhiyun 				NVWriteRAMDAC(dev, 0, dacclk_off,
444*4882a593Smuzhiyun 					dacclk & ~NV_PRAMDAC_DACCLK_SEL_DACCLK);
445*4882a593Smuzhiyun 		}
446*4882a593Smuzhiyun 	}
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun /* Check if the DAC corresponding to 'encoder' is being used by
450*4882a593Smuzhiyun  * someone else. */
nv04_dac_in_use(struct drm_encoder * encoder)451*4882a593Smuzhiyun bool nv04_dac_in_use(struct drm_encoder *encoder)
452*4882a593Smuzhiyun {
453*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
454*4882a593Smuzhiyun 	struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 	return nv_gf4_disp_arch(encoder->dev) &&
457*4882a593Smuzhiyun 		(nv04_display(dev)->dac_users[ffs(dcb->or) - 1] & ~(1 << dcb->index));
458*4882a593Smuzhiyun }
459*4882a593Smuzhiyun 
nv04_dac_dpms(struct drm_encoder * encoder,int mode)460*4882a593Smuzhiyun static void nv04_dac_dpms(struct drm_encoder *encoder, int mode)
461*4882a593Smuzhiyun {
462*4882a593Smuzhiyun 	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
463*4882a593Smuzhiyun 	struct nouveau_drm *drm = nouveau_drm(encoder->dev);
464*4882a593Smuzhiyun 
465*4882a593Smuzhiyun 	if (nv_encoder->last_dpms == mode)
466*4882a593Smuzhiyun 		return;
467*4882a593Smuzhiyun 	nv_encoder->last_dpms = mode;
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 	NV_DEBUG(drm, "Setting dpms mode %d on vga encoder (output %d)\n",
470*4882a593Smuzhiyun 		 mode, nv_encoder->dcb->index);
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun 	nv04_dac_update_dacclk(encoder, mode == DRM_MODE_DPMS_ON);
473*4882a593Smuzhiyun }
474*4882a593Smuzhiyun 
nv04_dac_save(struct drm_encoder * encoder)475*4882a593Smuzhiyun static void nv04_dac_save(struct drm_encoder *encoder)
476*4882a593Smuzhiyun {
477*4882a593Smuzhiyun 	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
478*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 	if (nv_gf4_disp_arch(dev))
481*4882a593Smuzhiyun 		nv_encoder->restore.output = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK +
482*4882a593Smuzhiyun 							  nv04_dac_output_offset(encoder));
483*4882a593Smuzhiyun }
484*4882a593Smuzhiyun 
nv04_dac_restore(struct drm_encoder * encoder)485*4882a593Smuzhiyun static void nv04_dac_restore(struct drm_encoder *encoder)
486*4882a593Smuzhiyun {
487*4882a593Smuzhiyun 	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
488*4882a593Smuzhiyun 	struct drm_device *dev = encoder->dev;
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	if (nv_gf4_disp_arch(dev))
491*4882a593Smuzhiyun 		NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + nv04_dac_output_offset(encoder),
492*4882a593Smuzhiyun 			      nv_encoder->restore.output);
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun 	nv_encoder->last_dpms = NV_DPMS_CLEARED;
495*4882a593Smuzhiyun }
496*4882a593Smuzhiyun 
nv04_dac_destroy(struct drm_encoder * encoder)497*4882a593Smuzhiyun static void nv04_dac_destroy(struct drm_encoder *encoder)
498*4882a593Smuzhiyun {
499*4882a593Smuzhiyun 	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	drm_encoder_cleanup(encoder);
502*4882a593Smuzhiyun 	kfree(nv_encoder);
503*4882a593Smuzhiyun }
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun static const struct drm_encoder_helper_funcs nv04_dac_helper_funcs = {
506*4882a593Smuzhiyun 	.dpms = nv04_dac_dpms,
507*4882a593Smuzhiyun 	.mode_fixup = nv04_dac_mode_fixup,
508*4882a593Smuzhiyun 	.prepare = nv04_dac_prepare,
509*4882a593Smuzhiyun 	.commit = nv04_dac_commit,
510*4882a593Smuzhiyun 	.mode_set = nv04_dac_mode_set,
511*4882a593Smuzhiyun 	.detect = nv04_dac_detect
512*4882a593Smuzhiyun };
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun static const struct drm_encoder_helper_funcs nv17_dac_helper_funcs = {
515*4882a593Smuzhiyun 	.dpms = nv04_dac_dpms,
516*4882a593Smuzhiyun 	.mode_fixup = nv04_dac_mode_fixup,
517*4882a593Smuzhiyun 	.prepare = nv04_dac_prepare,
518*4882a593Smuzhiyun 	.commit = nv04_dac_commit,
519*4882a593Smuzhiyun 	.mode_set = nv04_dac_mode_set,
520*4882a593Smuzhiyun 	.detect = nv17_dac_detect
521*4882a593Smuzhiyun };
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun static const struct drm_encoder_funcs nv04_dac_funcs = {
524*4882a593Smuzhiyun 	.destroy = nv04_dac_destroy,
525*4882a593Smuzhiyun };
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun int
nv04_dac_create(struct drm_connector * connector,struct dcb_output * entry)528*4882a593Smuzhiyun nv04_dac_create(struct drm_connector *connector, struct dcb_output *entry)
529*4882a593Smuzhiyun {
530*4882a593Smuzhiyun 	const struct drm_encoder_helper_funcs *helper;
531*4882a593Smuzhiyun 	struct nouveau_encoder *nv_encoder = NULL;
532*4882a593Smuzhiyun 	struct drm_device *dev = connector->dev;
533*4882a593Smuzhiyun 	struct drm_encoder *encoder;
534*4882a593Smuzhiyun 
535*4882a593Smuzhiyun 	nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL);
536*4882a593Smuzhiyun 	if (!nv_encoder)
537*4882a593Smuzhiyun 		return -ENOMEM;
538*4882a593Smuzhiyun 
539*4882a593Smuzhiyun 	encoder = to_drm_encoder(nv_encoder);
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	nv_encoder->dcb = entry;
542*4882a593Smuzhiyun 	nv_encoder->or = ffs(entry->or) - 1;
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun 	nv_encoder->enc_save = nv04_dac_save;
545*4882a593Smuzhiyun 	nv_encoder->enc_restore = nv04_dac_restore;
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	if (nv_gf4_disp_arch(dev))
548*4882a593Smuzhiyun 		helper = &nv17_dac_helper_funcs;
549*4882a593Smuzhiyun 	else
550*4882a593Smuzhiyun 		helper = &nv04_dac_helper_funcs;
551*4882a593Smuzhiyun 
552*4882a593Smuzhiyun 	drm_encoder_init(dev, encoder, &nv04_dac_funcs, DRM_MODE_ENCODER_DAC,
553*4882a593Smuzhiyun 			 NULL);
554*4882a593Smuzhiyun 	drm_encoder_helper_add(encoder, helper);
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	encoder->possible_crtcs = entry->heads;
557*4882a593Smuzhiyun 	encoder->possible_clones = 0;
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	drm_connector_attach_encoder(connector, encoder);
560*4882a593Smuzhiyun 	return 0;
561*4882a593Smuzhiyun }
562