This source file includes following definitions.
- nv04_dac_output_offset
- sample_load_twice
- nv04_dac_detect
- nv17_dac_sample_load
- nv17_dac_detect
- nv04_dac_mode_fixup
- nv04_dac_prepare
- nv04_dac_mode_set
- nv04_dac_commit
- nv04_dac_update_dacclk
- nv04_dac_in_use
- nv04_dac_dpms
- nv04_dac_save
- nv04_dac_restore
- nv04_dac_destroy
- nv04_dac_create
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27 #include <drm/drm_crtc_helper.h>
28
29 #include "nouveau_drv.h"
30 #include "nouveau_encoder.h"
31 #include "nouveau_connector.h"
32 #include "nouveau_crtc.h"
33 #include "hw.h"
34 #include "nvreg.h"
35
36 #include <subdev/bios/gpio.h>
37 #include <subdev/gpio.h>
38 #include <subdev/timer.h>
39
40 int nv04_dac_output_offset(struct drm_encoder *encoder)
41 {
42 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
43 int offset = 0;
44
45 if (dcb->or & (8 | DCB_OUTPUT_C))
46 offset += 0x68;
47 if (dcb->or & (8 | DCB_OUTPUT_B))
48 offset += 0x2000;
49
50 return offset;
51 }
52
53
54
55
56
57 #define MAX_HBLANK_OSC 20
58
59
60
61
62
63 #define MAX_SAMPLE_PAIRS 10
64
65 static int sample_load_twice(struct drm_device *dev, bool sense[2])
66 {
67 struct nouveau_drm *drm = nouveau_drm(dev);
68 struct nvif_object *device = &drm->client.device.object;
69 int i;
70
71 for (i = 0; i < 2; i++) {
72 bool sense_a, sense_b, sense_b_prime;
73 int j = 0;
74
75
76
77
78
79
80
81
82 if (nvif_msec(&drm->client.device, 10,
83 if (!(nvif_rd32(device, NV_PRMCIO_INP0__COLOR) & 1))
84 break;
85 ) < 0)
86 return -EBUSY;
87
88 if (nvif_msec(&drm->client.device, 10,
89 if ( (nvif_rd32(device, NV_PRMCIO_INP0__COLOR) & 1))
90 break;
91 ) < 0)
92 return -EBUSY;
93
94 if (nvif_msec(&drm->client.device, 10,
95 if (!(nvif_rd32(device, NV_PRMCIO_INP0__COLOR) & 1))
96 break;
97 ) < 0)
98 return -EBUSY;
99
100 udelay(100);
101
102 sense_a = nvif_rd08(device, NV_PRMCIO_INP0) & 0x10;
103
104
105 do {
106 udelay(100);
107 sense_b = nvif_rd08(device, NV_PRMCIO_INP0) & 0x10;
108 if (sense_a != sense_b) {
109 sense_b_prime =
110 nvif_rd08(device, NV_PRMCIO_INP0) & 0x10;
111 if (sense_b == sense_b_prime) {
112
113
114 sense_a = sense_b;
115
116 sense_b = !sense_a;
117 }
118 }
119 } while ((sense_a != sense_b) && ++j < MAX_HBLANK_OSC);
120
121 if (j == MAX_HBLANK_OSC)
122
123 sense[i] = false;
124 else
125 sense[i] = sense_a;
126 }
127
128 return 0;
129 }
130
131 static enum drm_connector_status nv04_dac_detect(struct drm_encoder *encoder,
132 struct drm_connector *connector)
133 {
134 struct drm_device *dev = encoder->dev;
135 struct nvif_object *device = &nouveau_drm(dev)->client.device.object;
136 struct nouveau_drm *drm = nouveau_drm(dev);
137 uint8_t saved_seq1, saved_pi, saved_rpc1, saved_cr_mode;
138 uint8_t saved_palette0[3], saved_palette_mask;
139 uint32_t saved_rtest_ctrl, saved_rgen_ctrl;
140 int i;
141 uint8_t blue;
142 bool sense = true;
143
144
145
146
147
148
149 if (nv_two_heads(dev))
150
151 NVSetOwner(dev, 0);
152
153 saved_cr_mode = NVReadVgaCrtc(dev, 0, NV_CIO_CR_MODE_INDEX);
154 NVWriteVgaCrtc(dev, 0, NV_CIO_CR_MODE_INDEX, saved_cr_mode | 0x80);
155
156 saved_seq1 = NVReadVgaSeq(dev, 0, NV_VIO_SR_CLOCK_INDEX);
157 NVWriteVgaSeq(dev, 0, NV_VIO_SR_CLOCK_INDEX, saved_seq1 & ~0x20);
158
159 saved_rtest_ctrl = NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL);
160 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL,
161 saved_rtest_ctrl & ~NV_PRAMDAC_TEST_CONTROL_PWRDWN_DAC_OFF);
162
163 msleep(10);
164
165 saved_pi = NVReadVgaCrtc(dev, 0, NV_CIO_CRE_PIXEL_INDEX);
166 NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_PIXEL_INDEX,
167 saved_pi & ~(0x80 | MASK(NV_CIO_CRE_PIXEL_FORMAT)));
168 saved_rpc1 = NVReadVgaCrtc(dev, 0, NV_CIO_CRE_RPC1_INDEX);
169 NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_RPC1_INDEX, saved_rpc1 & ~0xc0);
170
171 nvif_wr08(device, NV_PRMDIO_READ_MODE_ADDRESS, 0x0);
172 for (i = 0; i < 3; i++)
173 saved_palette0[i] = nvif_rd08(device, NV_PRMDIO_PALETTE_DATA);
174 saved_palette_mask = nvif_rd08(device, NV_PRMDIO_PIXEL_MASK);
175 nvif_wr08(device, NV_PRMDIO_PIXEL_MASK, 0);
176
177 saved_rgen_ctrl = NVReadRAMDAC(dev, 0, NV_PRAMDAC_GENERAL_CONTROL);
178 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_GENERAL_CONTROL,
179 (saved_rgen_ctrl & ~(NV_PRAMDAC_GENERAL_CONTROL_BPC_8BITS |
180 NV_PRAMDAC_GENERAL_CONTROL_TERMINATION_75OHM)) |
181 NV_PRAMDAC_GENERAL_CONTROL_PIXMIX_ON);
182
183 blue = 8;
184
185 do {
186 bool sense_pair[2];
187
188 nvif_wr08(device, NV_PRMDIO_WRITE_MODE_ADDRESS, 0);
189 nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, 0);
190 nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, 0);
191
192 nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, blue);
193
194 i = 0;
195
196 do {
197 if (sample_load_twice(dev, sense_pair))
198 goto out;
199 } while ((sense_pair[0] != sense_pair[1]) &&
200 ++i < MAX_SAMPLE_PAIRS);
201
202 if (i == MAX_SAMPLE_PAIRS)
203
204 sense = false;
205 else
206 sense = sense_pair[0];
207
208
209
210
211
212 } while (++blue < 0x18 && sense);
213
214 out:
215 nvif_wr08(device, NV_PRMDIO_PIXEL_MASK, saved_palette_mask);
216 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_GENERAL_CONTROL, saved_rgen_ctrl);
217 nvif_wr08(device, NV_PRMDIO_WRITE_MODE_ADDRESS, 0);
218 for (i = 0; i < 3; i++)
219 nvif_wr08(device, NV_PRMDIO_PALETTE_DATA, saved_palette0[i]);
220 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL, saved_rtest_ctrl);
221 NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_PIXEL_INDEX, saved_pi);
222 NVWriteVgaCrtc(dev, 0, NV_CIO_CRE_RPC1_INDEX, saved_rpc1);
223 NVWriteVgaSeq(dev, 0, NV_VIO_SR_CLOCK_INDEX, saved_seq1);
224 NVWriteVgaCrtc(dev, 0, NV_CIO_CR_MODE_INDEX, saved_cr_mode);
225
226 if (blue == 0x18) {
227 NV_DEBUG(drm, "Load detected on head A\n");
228 return connector_status_connected;
229 }
230
231 return connector_status_disconnected;
232 }
233
234 uint32_t nv17_dac_sample_load(struct drm_encoder *encoder)
235 {
236 struct drm_device *dev = encoder->dev;
237 struct nouveau_drm *drm = nouveau_drm(dev);
238 struct nvif_object *device = &nouveau_drm(dev)->client.device.object;
239 struct nvkm_gpio *gpio = nvxx_gpio(&drm->client.device);
240 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
241 uint32_t sample, testval, regoffset = nv04_dac_output_offset(encoder);
242 uint32_t saved_powerctrl_2 = 0, saved_powerctrl_4 = 0, saved_routput,
243 saved_rtest_ctrl, saved_gpio0 = 0, saved_gpio1 = 0, temp, routput;
244 int head;
245
246 #define RGB_TEST_DATA(r, g, b) (r << 0 | g << 10 | b << 20)
247 if (dcb->type == DCB_OUTPUT_TV) {
248 testval = RGB_TEST_DATA(0xa0, 0xa0, 0xa0);
249
250 if (drm->vbios.tvdactestval)
251 testval = drm->vbios.tvdactestval;
252 } else {
253 testval = RGB_TEST_DATA(0x140, 0x140, 0x140);
254
255 if (drm->vbios.dactestval)
256 testval = drm->vbios.dactestval;
257 }
258
259 saved_rtest_ctrl = NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset);
260 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset,
261 saved_rtest_ctrl & ~NV_PRAMDAC_TEST_CONTROL_PWRDWN_DAC_OFF);
262
263 saved_powerctrl_2 = nvif_rd32(device, NV_PBUS_POWERCTRL_2);
264
265 nvif_wr32(device, NV_PBUS_POWERCTRL_2, saved_powerctrl_2 & 0xd7ffffff);
266 if (regoffset == 0x68) {
267 saved_powerctrl_4 = nvif_rd32(device, NV_PBUS_POWERCTRL_4);
268 nvif_wr32(device, NV_PBUS_POWERCTRL_4, saved_powerctrl_4 & 0xffffffcf);
269 }
270
271 if (gpio) {
272 saved_gpio1 = nvkm_gpio_get(gpio, 0, DCB_GPIO_TVDAC1, 0xff);
273 saved_gpio0 = nvkm_gpio_get(gpio, 0, DCB_GPIO_TVDAC0, 0xff);
274 nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC1, 0xff, dcb->type == DCB_OUTPUT_TV);
275 nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC0, 0xff, dcb->type == DCB_OUTPUT_TV);
276 }
277
278 msleep(4);
279
280 saved_routput = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset);
281 head = (saved_routput & 0x100) >> 8;
282
283
284 if (!(NVReadVgaCrtc(dev, head, NV_CIO_CRE_RPC1_INDEX) & 0xC0))
285 head ^= 1;
286
287
288 routput = (saved_routput & 0xfffffece) | head << 8;
289
290 if (drm->client.device.info.family >= NV_DEVICE_INFO_V0_CURIE) {
291 if (dcb->type == DCB_OUTPUT_TV)
292 routput |= 0x1a << 16;
293 else
294 routput &= ~(0x1a << 16);
295 }
296
297 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset, routput);
298 msleep(1);
299
300 temp = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset);
301 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset, temp | 1);
302
303 NVWriteRAMDAC(dev, head, NV_PRAMDAC_TESTPOINT_DATA,
304 NV_PRAMDAC_TESTPOINT_DATA_NOTBLANK | testval);
305 temp = NVReadRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL);
306 NVWriteRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL,
307 temp | NV_PRAMDAC_TEST_CONTROL_TP_INS_EN_ASSERTED);
308 msleep(5);
309
310 sample = NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset);
311
312 sample &= NVReadRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset);
313
314 temp = NVReadRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL);
315 NVWriteRAMDAC(dev, head, NV_PRAMDAC_TEST_CONTROL,
316 temp & ~NV_PRAMDAC_TEST_CONTROL_TP_INS_EN_ASSERTED);
317 NVWriteRAMDAC(dev, head, NV_PRAMDAC_TESTPOINT_DATA, 0);
318
319
320 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + regoffset, saved_routput);
321 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + regoffset, saved_rtest_ctrl);
322 if (regoffset == 0x68)
323 nvif_wr32(device, NV_PBUS_POWERCTRL_4, saved_powerctrl_4);
324 nvif_wr32(device, NV_PBUS_POWERCTRL_2, saved_powerctrl_2);
325
326 if (gpio) {
327 nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC1, 0xff, saved_gpio1);
328 nvkm_gpio_set(gpio, 0, DCB_GPIO_TVDAC0, 0xff, saved_gpio0);
329 }
330
331 return sample;
332 }
333
334 static enum drm_connector_status
335 nv17_dac_detect(struct drm_encoder *encoder, struct drm_connector *connector)
336 {
337 struct nouveau_drm *drm = nouveau_drm(encoder->dev);
338 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
339
340 if (nv04_dac_in_use(encoder))
341 return connector_status_disconnected;
342
343 if (nv17_dac_sample_load(encoder) &
344 NV_PRAMDAC_TEST_CONTROL_SENSEB_ALLHI) {
345 NV_DEBUG(drm, "Load detected on output %c\n",
346 '@' + ffs(dcb->or));
347 return connector_status_connected;
348 } else {
349 return connector_status_disconnected;
350 }
351 }
352
353 static bool nv04_dac_mode_fixup(struct drm_encoder *encoder,
354 const struct drm_display_mode *mode,
355 struct drm_display_mode *adjusted_mode)
356 {
357 if (nv04_dac_in_use(encoder))
358 return false;
359
360 return true;
361 }
362
363 static void nv04_dac_prepare(struct drm_encoder *encoder)
364 {
365 const struct drm_encoder_helper_funcs *helper = encoder->helper_private;
366 struct drm_device *dev = encoder->dev;
367 int head = nouveau_crtc(encoder->crtc)->index;
368
369 helper->dpms(encoder, DRM_MODE_DPMS_OFF);
370
371 nv04_dfp_disable(dev, head);
372 }
373
374 static void nv04_dac_mode_set(struct drm_encoder *encoder,
375 struct drm_display_mode *mode,
376 struct drm_display_mode *adjusted_mode)
377 {
378 struct drm_device *dev = encoder->dev;
379 struct nouveau_drm *drm = nouveau_drm(dev);
380 int head = nouveau_crtc(encoder->crtc)->index;
381
382 if (nv_gf4_disp_arch(dev)) {
383 struct drm_encoder *rebind;
384 uint32_t dac_offset = nv04_dac_output_offset(encoder);
385 uint32_t otherdac;
386
387
388
389 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + dac_offset,
390 head << 8 | NV_PRAMDAC_DACCLK_SEL_DACCLK);
391
392 list_for_each_entry(rebind, &dev->mode_config.encoder_list, head) {
393 if (rebind == encoder
394 || nouveau_encoder(rebind)->dcb->type != DCB_OUTPUT_ANALOG)
395 continue;
396
397 dac_offset = nv04_dac_output_offset(rebind);
398 otherdac = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + dac_offset);
399 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + dac_offset,
400 (otherdac & ~0x0100) | (head ^ 1) << 8);
401 }
402 }
403
404
405 if (drm->client.device.info.chipset < 0x44)
406 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + nv04_dac_output_offset(encoder), 0xf0000000);
407 else
408 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + nv04_dac_output_offset(encoder), 0x00100000);
409 }
410
411 static void nv04_dac_commit(struct drm_encoder *encoder)
412 {
413 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
414 struct nouveau_drm *drm = nouveau_drm(encoder->dev);
415 struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
416 const struct drm_encoder_helper_funcs *helper = encoder->helper_private;
417
418 helper->dpms(encoder, DRM_MODE_DPMS_ON);
419
420 NV_DEBUG(drm, "Output %s is running on CRTC %d using output %c\n",
421 nouveau_encoder_connector_get(nv_encoder)->base.name,
422 nv_crtc->index, '@' + ffs(nv_encoder->dcb->or));
423 }
424
425 void nv04_dac_update_dacclk(struct drm_encoder *encoder, bool enable)
426 {
427 struct drm_device *dev = encoder->dev;
428 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
429
430 if (nv_gf4_disp_arch(dev)) {
431 uint32_t *dac_users = &nv04_display(dev)->dac_users[ffs(dcb->or) - 1];
432 int dacclk_off = NV_PRAMDAC_DACCLK + nv04_dac_output_offset(encoder);
433 uint32_t dacclk = NVReadRAMDAC(dev, 0, dacclk_off);
434
435 if (enable) {
436 *dac_users |= 1 << dcb->index;
437 NVWriteRAMDAC(dev, 0, dacclk_off, dacclk | NV_PRAMDAC_DACCLK_SEL_DACCLK);
438
439 } else {
440 *dac_users &= ~(1 << dcb->index);
441 if (!*dac_users)
442 NVWriteRAMDAC(dev, 0, dacclk_off,
443 dacclk & ~NV_PRAMDAC_DACCLK_SEL_DACCLK);
444 }
445 }
446 }
447
448
449
450 bool nv04_dac_in_use(struct drm_encoder *encoder)
451 {
452 struct drm_device *dev = encoder->dev;
453 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb;
454
455 return nv_gf4_disp_arch(encoder->dev) &&
456 (nv04_display(dev)->dac_users[ffs(dcb->or) - 1] & ~(1 << dcb->index));
457 }
458
459 static void nv04_dac_dpms(struct drm_encoder *encoder, int mode)
460 {
461 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
462 struct nouveau_drm *drm = nouveau_drm(encoder->dev);
463
464 if (nv_encoder->last_dpms == mode)
465 return;
466 nv_encoder->last_dpms = mode;
467
468 NV_DEBUG(drm, "Setting dpms mode %d on vga encoder (output %d)\n",
469 mode, nv_encoder->dcb->index);
470
471 nv04_dac_update_dacclk(encoder, mode == DRM_MODE_DPMS_ON);
472 }
473
474 static void nv04_dac_save(struct drm_encoder *encoder)
475 {
476 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
477 struct drm_device *dev = encoder->dev;
478
479 if (nv_gf4_disp_arch(dev))
480 nv_encoder->restore.output = NVReadRAMDAC(dev, 0, NV_PRAMDAC_DACCLK +
481 nv04_dac_output_offset(encoder));
482 }
483
484 static void nv04_dac_restore(struct drm_encoder *encoder)
485 {
486 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
487 struct drm_device *dev = encoder->dev;
488
489 if (nv_gf4_disp_arch(dev))
490 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_DACCLK + nv04_dac_output_offset(encoder),
491 nv_encoder->restore.output);
492
493 nv_encoder->last_dpms = NV_DPMS_CLEARED;
494 }
495
496 static void nv04_dac_destroy(struct drm_encoder *encoder)
497 {
498 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
499
500 drm_encoder_cleanup(encoder);
501 kfree(nv_encoder);
502 }
503
504 static const struct drm_encoder_helper_funcs nv04_dac_helper_funcs = {
505 .dpms = nv04_dac_dpms,
506 .mode_fixup = nv04_dac_mode_fixup,
507 .prepare = nv04_dac_prepare,
508 .commit = nv04_dac_commit,
509 .mode_set = nv04_dac_mode_set,
510 .detect = nv04_dac_detect
511 };
512
513 static const struct drm_encoder_helper_funcs nv17_dac_helper_funcs = {
514 .dpms = nv04_dac_dpms,
515 .mode_fixup = nv04_dac_mode_fixup,
516 .prepare = nv04_dac_prepare,
517 .commit = nv04_dac_commit,
518 .mode_set = nv04_dac_mode_set,
519 .detect = nv17_dac_detect
520 };
521
522 static const struct drm_encoder_funcs nv04_dac_funcs = {
523 .destroy = nv04_dac_destroy,
524 };
525
526 int
527 nv04_dac_create(struct drm_connector *connector, struct dcb_output *entry)
528 {
529 const struct drm_encoder_helper_funcs *helper;
530 struct nouveau_encoder *nv_encoder = NULL;
531 struct drm_device *dev = connector->dev;
532 struct drm_encoder *encoder;
533
534 nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL);
535 if (!nv_encoder)
536 return -ENOMEM;
537
538 encoder = to_drm_encoder(nv_encoder);
539
540 nv_encoder->dcb = entry;
541 nv_encoder->or = ffs(entry->or) - 1;
542
543 nv_encoder->enc_save = nv04_dac_save;
544 nv_encoder->enc_restore = nv04_dac_restore;
545
546 if (nv_gf4_disp_arch(dev))
547 helper = &nv17_dac_helper_funcs;
548 else
549 helper = &nv04_dac_helper_funcs;
550
551 drm_encoder_init(dev, encoder, &nv04_dac_funcs, DRM_MODE_ENCODER_DAC,
552 NULL);
553 drm_encoder_helper_add(encoder, helper);
554
555 encoder->possible_crtcs = entry->heads;
556 encoder->possible_clones = 0;
557
558 drm_connector_attach_encoder(connector, encoder);
559 return 0;
560 }