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