nv50_display.c revision 04a39c577f4114a3f098ee8ef0e20f7778b5ddad
1/*
2 * Copyright (C) 2008 Maarten Maathuis.
3 * All Rights Reserved.
4 *
5 * Permission is hereby granted, free of charge, to any person obtaining
6 * a copy of this software and associated documentation files (the
7 * "Software"), to deal in the Software without restriction, including
8 * without limitation the rights to use, copy, modify, merge, publish,
9 * distribute, sublicense, and/or sell copies of the Software, and to
10 * permit persons to whom the Software is furnished to do so, subject to
11 * the following conditions:
12 *
13 * The above copyright notice and this permission notice (including the
14 * next paragraph) shall be included in all copies or substantial
15 * portions of the Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
18 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
20 * IN NO EVENT SHALL THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE
21 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
22 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
23 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
24 *
25 */
26
27#include "nv50_display.h"
28#include "nouveau_crtc.h"
29#include "nouveau_encoder.h"
30#include "nouveau_connector.h"
31#include "nouveau_fb.h"
32#include "drm_crtc_helper.h"
33
34static void
35nv50_evo_channel_del(struct nouveau_channel **pchan)
36{
37	struct nouveau_channel *chan = *pchan;
38
39	if (!chan)
40		return;
41	*pchan = NULL;
42
43	nouveau_gpuobj_channel_takedown(chan);
44	nouveau_bo_ref(NULL, &chan->pushbuf_bo);
45
46	if (chan->user)
47		iounmap(chan->user);
48
49	kfree(chan);
50}
51
52static int
53nv50_evo_dmaobj_new(struct nouveau_channel *evo, uint32_t class, uint32_t name,
54		    uint32_t tile_flags, uint32_t magic_flags,
55		    uint32_t offset, uint32_t limit)
56{
57	struct drm_nouveau_private *dev_priv = evo->dev->dev_private;
58	struct drm_device *dev = evo->dev;
59	struct nouveau_gpuobj *obj = NULL;
60	int ret;
61
62	ret = nouveau_gpuobj_new(dev, evo, 6*4, 32, 0, &obj);
63	if (ret)
64		return ret;
65	obj->engine = NVOBJ_ENGINE_DISPLAY;
66
67	ret = nouveau_gpuobj_ref_add(dev, evo, name, obj, NULL);
68	if (ret) {
69		nouveau_gpuobj_del(dev, &obj);
70		return ret;
71	}
72
73	dev_priv->engine.instmem.prepare_access(dev, true);
74	nv_wo32(dev, obj, 0, (tile_flags << 22) | (magic_flags << 16) | class);
75	nv_wo32(dev, obj, 1, limit);
76	nv_wo32(dev, obj, 2, offset);
77	nv_wo32(dev, obj, 3, 0x00000000);
78	nv_wo32(dev, obj, 4, 0x00000000);
79	nv_wo32(dev, obj, 5, 0x00010000);
80	dev_priv->engine.instmem.finish_access(dev);
81
82	return 0;
83}
84
85static int
86nv50_evo_channel_new(struct drm_device *dev, struct nouveau_channel **pchan)
87{
88	struct drm_nouveau_private *dev_priv = dev->dev_private;
89	struct nouveau_channel *chan;
90	int ret;
91
92	chan = kzalloc(sizeof(struct nouveau_channel), GFP_KERNEL);
93	if (!chan)
94		return -ENOMEM;
95	*pchan = chan;
96
97	chan->id = -1;
98	chan->dev = dev;
99	chan->user_get = 4;
100	chan->user_put = 0;
101
102	INIT_LIST_HEAD(&chan->ramht_refs);
103
104	ret = nouveau_gpuobj_new_ref(dev, NULL, NULL, 0, 32768, 0x1000,
105				     NVOBJ_FLAG_ZERO_ALLOC, &chan->ramin);
106	if (ret) {
107		NV_ERROR(dev, "Error allocating EVO channel memory: %d\n", ret);
108		nv50_evo_channel_del(pchan);
109		return ret;
110	}
111
112	ret = nouveau_mem_init_heap(&chan->ramin_heap, chan->ramin->gpuobj->
113				    im_pramin->start, 32768);
114	if (ret) {
115		NV_ERROR(dev, "Error initialising EVO PRAMIN heap: %d\n", ret);
116		nv50_evo_channel_del(pchan);
117		return ret;
118	}
119
120	ret = nouveau_gpuobj_new_ref(dev, chan, chan, 0, 4096, 16,
121				     0, &chan->ramht);
122	if (ret) {
123		NV_ERROR(dev, "Unable to allocate EVO RAMHT: %d\n", ret);
124		nv50_evo_channel_del(pchan);
125		return ret;
126	}
127
128	if (dev_priv->chipset != 0x50) {
129		ret = nv50_evo_dmaobj_new(chan, 0x3d, NvEvoFB16, 0x70, 0x19,
130					  0, 0xffffffff);
131		if (ret) {
132			nv50_evo_channel_del(pchan);
133			return ret;
134		}
135
136
137		ret = nv50_evo_dmaobj_new(chan, 0x3d, NvEvoFB32, 0x7a, 0x19,
138					  0, 0xffffffff);
139		if (ret) {
140			nv50_evo_channel_del(pchan);
141			return ret;
142		}
143	}
144
145	ret = nv50_evo_dmaobj_new(chan, 0x3d, NvEvoVRAM, 0, 0x19,
146				  0, nouveau_mem_fb_amount(dev));
147	if (ret) {
148		nv50_evo_channel_del(pchan);
149		return ret;
150	}
151
152	ret = nouveau_bo_new(dev, NULL, 4096, 0, TTM_PL_FLAG_VRAM, 0, 0,
153			     false, true, &chan->pushbuf_bo);
154	if (ret == 0)
155		ret = nouveau_bo_pin(chan->pushbuf_bo, TTM_PL_FLAG_VRAM);
156	if (ret) {
157		NV_ERROR(dev, "Error creating EVO DMA push buffer: %d\n", ret);
158		nv50_evo_channel_del(pchan);
159		return ret;
160	}
161
162	ret = nouveau_bo_map(chan->pushbuf_bo);
163	if (ret) {
164		NV_ERROR(dev, "Error mapping EVO DMA push buffer: %d\n", ret);
165		nv50_evo_channel_del(pchan);
166		return ret;
167	}
168
169	chan->user = ioremap(pci_resource_start(dev->pdev, 0) +
170					NV50_PDISPLAY_USER(0), PAGE_SIZE);
171	if (!chan->user) {
172		NV_ERROR(dev, "Error mapping EVO control regs.\n");
173		nv50_evo_channel_del(pchan);
174		return -ENOMEM;
175	}
176
177	return 0;
178}
179
180int
181nv50_display_init(struct drm_device *dev)
182{
183	struct drm_nouveau_private *dev_priv = dev->dev_private;
184	struct nouveau_timer_engine *ptimer = &dev_priv->engine.timer;
185	struct nouveau_channel *evo = dev_priv->evo;
186	struct drm_connector *connector;
187	uint32_t val, ram_amount, hpd_en[2];
188	uint64_t start;
189	int ret, i;
190
191	NV_DEBUG_KMS(dev, "\n");
192
193	nv_wr32(dev, 0x00610184, nv_rd32(dev, 0x00614004));
194	/*
195	 * I think the 0x006101XX range is some kind of main control area
196	 * that enables things.
197	 */
198	/* CRTC? */
199	for (i = 0; i < 2; i++) {
200		val = nv_rd32(dev, 0x00616100 + (i * 0x800));
201		nv_wr32(dev, 0x00610190 + (i * 0x10), val);
202		val = nv_rd32(dev, 0x00616104 + (i * 0x800));
203		nv_wr32(dev, 0x00610194 + (i * 0x10), val);
204		val = nv_rd32(dev, 0x00616108 + (i * 0x800));
205		nv_wr32(dev, 0x00610198 + (i * 0x10), val);
206		val = nv_rd32(dev, 0x0061610c + (i * 0x800));
207		nv_wr32(dev, 0x0061019c + (i * 0x10), val);
208	}
209	/* DAC */
210	for (i = 0; i < 3; i++) {
211		val = nv_rd32(dev, 0x0061a000 + (i * 0x800));
212		nv_wr32(dev, 0x006101d0 + (i * 0x04), val);
213	}
214	/* SOR */
215	for (i = 0; i < 4; i++) {
216		val = nv_rd32(dev, 0x0061c000 + (i * 0x800));
217		nv_wr32(dev, 0x006101e0 + (i * 0x04), val);
218	}
219	/* Something not yet in use, tv-out maybe. */
220	for (i = 0; i < 3; i++) {
221		val = nv_rd32(dev, 0x0061e000 + (i * 0x800));
222		nv_wr32(dev, 0x006101f0 + (i * 0x04), val);
223	}
224
225	for (i = 0; i < 3; i++) {
226		nv_wr32(dev, NV50_PDISPLAY_DAC_DPMS_CTRL(i), 0x00550000 |
227			NV50_PDISPLAY_DAC_DPMS_CTRL_PENDING);
228		nv_wr32(dev, NV50_PDISPLAY_DAC_CLK_CTRL1(i), 0x00000001);
229	}
230
231	/* This used to be in crtc unblank, but seems out of place there. */
232	nv_wr32(dev, NV50_PDISPLAY_UNK_380, 0);
233	/* RAM is clamped to 256 MiB. */
234	ram_amount = nouveau_mem_fb_amount(dev);
235	NV_DEBUG_KMS(dev, "ram_amount %d\n", ram_amount);
236	if (ram_amount > 256*1024*1024)
237		ram_amount = 256*1024*1024;
238	nv_wr32(dev, NV50_PDISPLAY_RAM_AMOUNT, ram_amount - 1);
239	nv_wr32(dev, NV50_PDISPLAY_UNK_388, 0x150000);
240	nv_wr32(dev, NV50_PDISPLAY_UNK_38C, 0);
241
242	/* The precise purpose is unknown, i suspect it has something to do
243	 * with text mode.
244	 */
245	if (nv_rd32(dev, NV50_PDISPLAY_INTR_1) & 0x100) {
246		nv_wr32(dev, NV50_PDISPLAY_INTR_1, 0x100);
247		nv_wr32(dev, 0x006194e8, nv_rd32(dev, 0x006194e8) & ~1);
248		if (!nv_wait(0x006194e8, 2, 0)) {
249			NV_ERROR(dev, "timeout: (0x6194e8 & 2) != 0\n");
250			NV_ERROR(dev, "0x6194e8 = 0x%08x\n",
251						nv_rd32(dev, 0x6194e8));
252			return -EBUSY;
253		}
254	}
255
256	/* taken from nv bug #12637, attempts to un-wedge the hw if it's
257	 * stuck in some unspecified state
258	 */
259	start = ptimer->read(dev);
260	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0), 0x2b00);
261	while ((val = nv_rd32(dev, NV50_PDISPLAY_CHANNEL_STAT(0))) & 0x1e0000) {
262		if ((val & 0x9f0000) == 0x20000)
263			nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0),
264							val | 0x800000);
265
266		if ((val & 0x3f0000) == 0x30000)
267			nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0),
268							val | 0x200000);
269
270		if (ptimer->read(dev) - start > 1000000000ULL) {
271			NV_ERROR(dev, "timeout: (0x610200 & 0x1e0000) != 0\n");
272			NV_ERROR(dev, "0x610200 = 0x%08x\n", val);
273			return -EBUSY;
274		}
275	}
276
277	nv_wr32(dev, NV50_PDISPLAY_CTRL_STATE, NV50_PDISPLAY_CTRL_STATE_ENABLE);
278	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0), 0x1000b03);
279	if (!nv_wait(NV50_PDISPLAY_CHANNEL_STAT(0), 0x40000000, 0x40000000)) {
280		NV_ERROR(dev, "timeout: (0x610200 & 0x40000000) == 0x40000000\n");
281		NV_ERROR(dev, "0x610200 = 0x%08x\n",
282			  nv_rd32(dev, NV50_PDISPLAY_CHANNEL_STAT(0)));
283		return -EBUSY;
284	}
285
286	for (i = 0; i < 2; i++) {
287		nv_wr32(dev, NV50_PDISPLAY_CURSOR_CURSOR_CTRL2(i), 0x2000);
288		if (!nv_wait(NV50_PDISPLAY_CURSOR_CURSOR_CTRL2(i),
289			     NV50_PDISPLAY_CURSOR_CURSOR_CTRL2_STATUS, 0)) {
290			NV_ERROR(dev, "timeout: CURSOR_CTRL2_STATUS == 0\n");
291			NV_ERROR(dev, "CURSOR_CTRL2 = 0x%08x\n",
292				 nv_rd32(dev, NV50_PDISPLAY_CURSOR_CURSOR_CTRL2(i)));
293			return -EBUSY;
294		}
295
296		nv_wr32(dev, NV50_PDISPLAY_CURSOR_CURSOR_CTRL2(i),
297			NV50_PDISPLAY_CURSOR_CURSOR_CTRL2_ON);
298		if (!nv_wait(NV50_PDISPLAY_CURSOR_CURSOR_CTRL2(i),
299			     NV50_PDISPLAY_CURSOR_CURSOR_CTRL2_STATUS,
300			     NV50_PDISPLAY_CURSOR_CURSOR_CTRL2_STATUS_ACTIVE)) {
301			NV_ERROR(dev, "timeout: "
302				      "CURSOR_CTRL2_STATUS_ACTIVE(%d)\n", i);
303			NV_ERROR(dev, "CURSOR_CTRL2(%d) = 0x%08x\n", i,
304				 nv_rd32(dev, NV50_PDISPLAY_CURSOR_CURSOR_CTRL2(i)));
305			return -EBUSY;
306		}
307	}
308
309	nv_wr32(dev, NV50_PDISPLAY_OBJECTS, (evo->ramin->instance >> 8) | 9);
310
311	/* initialise fifo */
312	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_DMA_CB(0),
313		((evo->pushbuf_bo->bo.mem.mm_node->start << PAGE_SHIFT) >> 8) |
314		NV50_PDISPLAY_CHANNEL_DMA_CB_LOCATION_VRAM |
315		NV50_PDISPLAY_CHANNEL_DMA_CB_VALID);
316	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_UNK2(0), 0x00010000);
317	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_UNK3(0), 0x00000002);
318	if (!nv_wait(0x610200, 0x80000000, 0x00000000)) {
319		NV_ERROR(dev, "timeout: (0x610200 & 0x80000000) == 0\n");
320		NV_ERROR(dev, "0x610200 = 0x%08x\n", nv_rd32(dev, 0x610200));
321		return -EBUSY;
322	}
323	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0),
324		(nv_rd32(dev, NV50_PDISPLAY_CHANNEL_STAT(0)) & ~0x00000003) |
325		 NV50_PDISPLAY_CHANNEL_STAT_DMA_ENABLED);
326	nv_wr32(dev, NV50_PDISPLAY_USER_PUT(0), 0);
327	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0), 0x01000003 |
328		NV50_PDISPLAY_CHANNEL_STAT_DMA_ENABLED);
329	nv_wr32(dev, 0x610300, nv_rd32(dev, 0x610300) & ~1);
330
331	evo->dma.max = (4096/4) - 2;
332	evo->dma.put = 0;
333	evo->dma.cur = evo->dma.put;
334	evo->dma.free = evo->dma.max - evo->dma.cur;
335
336	ret = RING_SPACE(evo, NOUVEAU_DMA_SKIPS);
337	if (ret)
338		return ret;
339
340	for (i = 0; i < NOUVEAU_DMA_SKIPS; i++)
341		OUT_RING(evo, 0);
342
343	ret = RING_SPACE(evo, 11);
344	if (ret)
345		return ret;
346	BEGIN_RING(evo, 0, NV50_EVO_UNK84, 2);
347	OUT_RING(evo, NV50_EVO_UNK84_NOTIFY_DISABLED);
348	OUT_RING(evo, NV50_EVO_DMA_NOTIFY_HANDLE_NONE);
349	BEGIN_RING(evo, 0, NV50_EVO_CRTC(0, FB_DMA), 1);
350	OUT_RING(evo, NV50_EVO_CRTC_FB_DMA_HANDLE_NONE);
351	BEGIN_RING(evo, 0, NV50_EVO_CRTC(0, UNK0800), 1);
352	OUT_RING(evo, 0);
353	BEGIN_RING(evo, 0, NV50_EVO_CRTC(0, DISPLAY_START), 1);
354	OUT_RING(evo, 0);
355	BEGIN_RING(evo, 0, NV50_EVO_CRTC(0, UNK082C), 1);
356	OUT_RING(evo, 0);
357	FIRE_RING(evo);
358	if (!nv_wait(0x640004, 0xffffffff, evo->dma.put << 2))
359		NV_ERROR(dev, "evo pushbuf stalled\n");
360
361	/* enable clock change interrupts. */
362	nv_wr32(dev, 0x610028, 0x00010001);
363	nv_wr32(dev, NV50_PDISPLAY_INTR_EN, (NV50_PDISPLAY_INTR_EN_CLK_UNK10 |
364					     NV50_PDISPLAY_INTR_EN_CLK_UNK20 |
365					     NV50_PDISPLAY_INTR_EN_CLK_UNK40));
366
367	/* enable hotplug interrupts */
368	hpd_en[0] = hpd_en[1] = 0;
369	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
370		struct nouveau_connector *conn = nouveau_connector(connector);
371		struct dcb_gpio_entry *gpio;
372
373		if (connector->connector_type != DRM_MODE_CONNECTOR_DVII &&
374		    connector->connector_type != DRM_MODE_CONNECTOR_DVID &&
375		    connector->connector_type != DRM_MODE_CONNECTOR_DisplayPort)
376			continue;
377
378		gpio = nouveau_bios_gpio_entry(dev, conn->dcb->gpio_tag);
379		if (!gpio)
380			continue;
381
382		hpd_en[gpio->line >> 4] |= (0x00010001 << (gpio->line & 0xf));
383	}
384
385	nv_wr32(dev, 0xe054, 0xffffffff);
386	nv_wr32(dev, 0xe050, hpd_en[0]);
387	if (dev_priv->chipset >= 0x90) {
388		nv_wr32(dev, 0xe074, 0xffffffff);
389		nv_wr32(dev, 0xe070, hpd_en[1]);
390	}
391
392	return 0;
393}
394
395static int nv50_display_disable(struct drm_device *dev)
396{
397	struct drm_nouveau_private *dev_priv = dev->dev_private;
398	struct drm_crtc *drm_crtc;
399	int ret, i;
400
401	NV_DEBUG_KMS(dev, "\n");
402
403	list_for_each_entry(drm_crtc, &dev->mode_config.crtc_list, head) {
404		struct nouveau_crtc *crtc = nouveau_crtc(drm_crtc);
405
406		nv50_crtc_blank(crtc, true);
407	}
408
409	ret = RING_SPACE(dev_priv->evo, 2);
410	if (ret == 0) {
411		BEGIN_RING(dev_priv->evo, 0, NV50_EVO_UPDATE, 1);
412		OUT_RING(dev_priv->evo, 0);
413	}
414	FIRE_RING(dev_priv->evo);
415
416	/* Almost like ack'ing a vblank interrupt, maybe in the spirit of
417	 * cleaning up?
418	 */
419	list_for_each_entry(drm_crtc, &dev->mode_config.crtc_list, head) {
420		struct nouveau_crtc *crtc = nouveau_crtc(drm_crtc);
421		uint32_t mask = NV50_PDISPLAY_INTR_1_VBLANK_CRTC_(crtc->index);
422
423		if (!crtc->base.enabled)
424			continue;
425
426		nv_wr32(dev, NV50_PDISPLAY_INTR_1, mask);
427		if (!nv_wait(NV50_PDISPLAY_INTR_1, mask, mask)) {
428			NV_ERROR(dev, "timeout: (0x610024 & 0x%08x) == "
429				      "0x%08x\n", mask, mask);
430			NV_ERROR(dev, "0x610024 = 0x%08x\n",
431				 nv_rd32(dev, NV50_PDISPLAY_INTR_1));
432		}
433	}
434
435	nv_wr32(dev, NV50_PDISPLAY_CHANNEL_STAT(0), 0);
436	nv_wr32(dev, NV50_PDISPLAY_CTRL_STATE, 0);
437	if (!nv_wait(NV50_PDISPLAY_CHANNEL_STAT(0), 0x1e0000, 0)) {
438		NV_ERROR(dev, "timeout: (0x610200 & 0x1e0000) == 0\n");
439		NV_ERROR(dev, "0x610200 = 0x%08x\n",
440			  nv_rd32(dev, NV50_PDISPLAY_CHANNEL_STAT(0)));
441	}
442
443	for (i = 0; i < 3; i++) {
444		if (!nv_wait(NV50_PDISPLAY_SOR_DPMS_STATE(i),
445			     NV50_PDISPLAY_SOR_DPMS_STATE_WAIT, 0)) {
446			NV_ERROR(dev, "timeout: SOR_DPMS_STATE_WAIT(%d) == 0\n", i);
447			NV_ERROR(dev, "SOR_DPMS_STATE(%d) = 0x%08x\n", i,
448				  nv_rd32(dev, NV50_PDISPLAY_SOR_DPMS_STATE(i)));
449		}
450	}
451
452	/* disable interrupts. */
453	nv_wr32(dev, NV50_PDISPLAY_INTR_EN, 0x00000000);
454
455	/* disable hotplug interrupts */
456	nv_wr32(dev, 0xe054, 0xffffffff);
457	nv_wr32(dev, 0xe050, 0x00000000);
458	if (dev_priv->chipset >= 0x90) {
459		nv_wr32(dev, 0xe074, 0xffffffff);
460		nv_wr32(dev, 0xe070, 0x00000000);
461	}
462	return 0;
463}
464
465int nv50_display_create(struct drm_device *dev)
466{
467	struct drm_nouveau_private *dev_priv = dev->dev_private;
468	struct dcb_table *dcb = &dev_priv->vbios.dcb;
469	uint32_t connector[16] = {};
470	int ret, i;
471
472	NV_DEBUG_KMS(dev, "\n");
473
474	/* init basic kernel modesetting */
475	drm_mode_config_init(dev);
476
477	/* Initialise some optional connector properties. */
478	drm_mode_create_scaling_mode_property(dev);
479	drm_mode_create_dithering_property(dev);
480
481	dev->mode_config.min_width = 0;
482	dev->mode_config.min_height = 0;
483
484	dev->mode_config.funcs = (void *)&nouveau_mode_config_funcs;
485
486	dev->mode_config.max_width = 8192;
487	dev->mode_config.max_height = 8192;
488
489	dev->mode_config.fb_base = dev_priv->fb_phys;
490
491	/* Create EVO channel */
492	ret = nv50_evo_channel_new(dev, &dev_priv->evo);
493	if (ret) {
494		NV_ERROR(dev, "Error creating EVO channel: %d\n", ret);
495		return ret;
496	}
497
498	/* Create CRTC objects */
499	for (i = 0; i < 2; i++)
500		nv50_crtc_create(dev, i);
501
502	/* We setup the encoders from the BIOS table */
503	for (i = 0 ; i < dcb->entries; i++) {
504		struct dcb_entry *entry = &dcb->entry[i];
505
506		if (entry->location != DCB_LOC_ON_CHIP) {
507			NV_WARN(dev, "Off-chip encoder %d/%d unsupported\n",
508				entry->type, ffs(entry->or) - 1);
509			continue;
510		}
511
512		switch (entry->type) {
513		case OUTPUT_TMDS:
514		case OUTPUT_LVDS:
515		case OUTPUT_DP:
516			nv50_sor_create(dev, entry);
517			break;
518		case OUTPUT_ANALOG:
519			nv50_dac_create(dev, entry);
520			break;
521		default:
522			NV_WARN(dev, "DCB encoder %d unknown\n", entry->type);
523			continue;
524		}
525
526		connector[entry->connector] |= (1 << entry->type);
527	}
528
529	/* It appears that DCB 3.0+ vbios has a connector table, however,
530	 * I'm not 100% certain how to decode it correctly yet so just
531	 * look at what encoders are present on each connector index and
532	 * attempt to derive the connector type from that.
533	 */
534	for (i = 0 ; i < dcb->entries; i++) {
535		struct dcb_entry *entry = &dcb->entry[i];
536		uint16_t encoders;
537		int type;
538
539		encoders = connector[entry->connector];
540		if (!(encoders & (1 << entry->type)))
541			continue;
542		connector[entry->connector] = 0;
543
544		if (encoders & (1 << OUTPUT_DP)) {
545			type = DRM_MODE_CONNECTOR_DisplayPort;
546		} else if (encoders & (1 << OUTPUT_TMDS)) {
547			if (encoders & (1 << OUTPUT_ANALOG))
548				type = DRM_MODE_CONNECTOR_DVII;
549			else
550				type = DRM_MODE_CONNECTOR_DVID;
551		} else if (encoders & (1 << OUTPUT_ANALOG)) {
552			type = DRM_MODE_CONNECTOR_VGA;
553		} else if (encoders & (1 << OUTPUT_LVDS)) {
554			type = DRM_MODE_CONNECTOR_LVDS;
555		} else {
556			type = DRM_MODE_CONNECTOR_Unknown;
557		}
558
559		if (type == DRM_MODE_CONNECTOR_Unknown)
560			continue;
561
562		nouveau_connector_create(dev, entry->connector, type);
563	}
564
565	ret = nv50_display_init(dev);
566	if (ret)
567		return ret;
568
569	return 0;
570}
571
572int nv50_display_destroy(struct drm_device *dev)
573{
574	struct drm_nouveau_private *dev_priv = dev->dev_private;
575
576	NV_DEBUG_KMS(dev, "\n");
577
578	drm_mode_config_cleanup(dev);
579
580	nv50_display_disable(dev);
581	nv50_evo_channel_del(&dev_priv->evo);
582
583	return 0;
584}
585
586static inline uint32_t
587nv50_display_mode_ctrl(struct drm_device *dev, bool sor, int or)
588{
589	struct drm_nouveau_private *dev_priv = dev->dev_private;
590	uint32_t mc;
591
592	if (sor) {
593		if (dev_priv->chipset < 0x90 ||
594		    dev_priv->chipset == 0x92 || dev_priv->chipset == 0xa0)
595			mc = nv_rd32(dev, NV50_PDISPLAY_SOR_MODE_CTRL_P(or));
596		else
597			mc = nv_rd32(dev, NV90_PDISPLAY_SOR_MODE_CTRL_P(or));
598	} else {
599		mc = nv_rd32(dev, NV50_PDISPLAY_DAC_MODE_CTRL_P(or));
600	}
601
602	return mc;
603}
604
605static int
606nv50_display_irq_head(struct drm_device *dev, int *phead,
607		      struct dcb_entry **pdcbent)
608{
609	struct drm_nouveau_private *dev_priv = dev->dev_private;
610	uint32_t unk30 = nv_rd32(dev, NV50_PDISPLAY_UNK30_CTRL);
611	uint32_t dac = 0, sor = 0;
612	int head, i, or = 0, type = OUTPUT_ANY;
613
614	/* We're assuming that head 0 *or* head 1 will be active here,
615	 * and not both.  I'm not sure if the hw will even signal both
616	 * ever, but it definitely shouldn't for us as we commit each
617	 * CRTC separately, and submission will be blocked by the GPU
618	 * until we handle each in turn.
619	 */
620	NV_DEBUG_KMS(dev, "0x610030: 0x%08x\n", unk30);
621	head = ffs((unk30 >> 9) & 3) - 1;
622	if (head < 0)
623		return -EINVAL;
624
625	/* This assumes CRTCs are never bound to multiple encoders, which
626	 * should be the case.
627	 */
628	for (i = 0; i < 3 && type == OUTPUT_ANY; i++) {
629		uint32_t mc = nv50_display_mode_ctrl(dev, false, i);
630		if (!(mc & (1 << head)))
631			continue;
632
633		switch ((mc >> 8) & 0xf) {
634		case 0: type = OUTPUT_ANALOG; break;
635		case 1: type = OUTPUT_TV; break;
636		default:
637			NV_ERROR(dev, "unknown dac mode_ctrl: 0x%08x\n", dac);
638			return -1;
639		}
640
641		or = i;
642	}
643
644	for (i = 0; i < 4 && type == OUTPUT_ANY; i++) {
645		uint32_t mc = nv50_display_mode_ctrl(dev, true, i);
646		if (!(mc & (1 << head)))
647			continue;
648
649		switch ((mc >> 8) & 0xf) {
650		case 0: type = OUTPUT_LVDS; break;
651		case 1: type = OUTPUT_TMDS; break;
652		case 2: type = OUTPUT_TMDS; break;
653		case 5: type = OUTPUT_TMDS; break;
654		case 8: type = OUTPUT_DP; break;
655		case 9: type = OUTPUT_DP; break;
656		default:
657			NV_ERROR(dev, "unknown sor mode_ctrl: 0x%08x\n", sor);
658			return -1;
659		}
660
661		or = i;
662	}
663
664	NV_DEBUG_KMS(dev, "type %d, or %d\n", type, or);
665	if (type == OUTPUT_ANY) {
666		NV_ERROR(dev, "unknown encoder!!\n");
667		return -1;
668	}
669
670	for (i = 0; i < dev_priv->vbios.dcb.entries; i++) {
671		struct dcb_entry *dcbent = &dev_priv->vbios.dcb.entry[i];
672
673		if (dcbent->type != type)
674			continue;
675
676		if (!(dcbent->or & (1 << or)))
677			continue;
678
679		*phead = head;
680		*pdcbent = dcbent;
681		return 0;
682	}
683
684	NV_ERROR(dev, "no DCB entry for %d %d\n", dac != 0, or);
685	return 0;
686}
687
688static uint32_t
689nv50_display_script_select(struct drm_device *dev, struct dcb_entry *dcbent,
690			   int pxclk)
691{
692	struct drm_nouveau_private *dev_priv = dev->dev_private;
693	struct nouveau_connector *nv_connector = NULL;
694	struct drm_encoder *encoder;
695	struct nvbios *bios = &dev_priv->vbios;
696	uint32_t mc, script = 0, or;
697
698	list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
699		struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
700
701		if (nv_encoder->dcb != dcbent)
702			continue;
703
704		nv_connector = nouveau_encoder_connector_get(nv_encoder);
705		break;
706	}
707
708	or = ffs(dcbent->or) - 1;
709	mc = nv50_display_mode_ctrl(dev, dcbent->type != OUTPUT_ANALOG, or);
710	switch (dcbent->type) {
711	case OUTPUT_LVDS:
712		script = (mc >> 8) & 0xf;
713		if (bios->fp_no_ddc) {
714			if (bios->fp.dual_link)
715				script |= 0x0100;
716			if (bios->fp.if_is_24bit)
717				script |= 0x0200;
718		} else {
719			if (pxclk >= bios->fp.duallink_transition_clk) {
720				script |= 0x0100;
721				if (bios->fp.strapless_is_24bit & 2)
722					script |= 0x0200;
723			} else
724			if (bios->fp.strapless_is_24bit & 1)
725				script |= 0x0200;
726
727			if (nv_connector && nv_connector->edid &&
728			    (nv_connector->edid->revision >= 4) &&
729			    (nv_connector->edid->input & 0x70) >= 0x20)
730				script |= 0x0200;
731		}
732
733		if (nouveau_uscript_lvds >= 0) {
734			NV_INFO(dev, "override script 0x%04x with 0x%04x "
735				     "for output LVDS-%d\n", script,
736				     nouveau_uscript_lvds, or);
737			script = nouveau_uscript_lvds;
738		}
739		break;
740	case OUTPUT_TMDS:
741		script = (mc >> 8) & 0xf;
742		if (pxclk >= 165000)
743			script |= 0x0100;
744
745		if (nouveau_uscript_tmds >= 0) {
746			NV_INFO(dev, "override script 0x%04x with 0x%04x "
747				     "for output TMDS-%d\n", script,
748				     nouveau_uscript_tmds, or);
749			script = nouveau_uscript_tmds;
750		}
751		break;
752	case OUTPUT_DP:
753		script = (mc >> 8) & 0xf;
754		break;
755	case OUTPUT_ANALOG:
756		script = 0xff;
757		break;
758	default:
759		NV_ERROR(dev, "modeset on unsupported output type!\n");
760		break;
761	}
762
763	return script;
764}
765
766static void
767nv50_display_vblank_crtc_handler(struct drm_device *dev, int crtc)
768{
769	struct drm_nouveau_private *dev_priv = dev->dev_private;
770	struct nouveau_channel *chan;
771	struct list_head *entry, *tmp;
772
773	list_for_each_safe(entry, tmp, &dev_priv->vbl_waiting) {
774		chan = list_entry(entry, struct nouveau_channel, nvsw.vbl_wait);
775
776		nouveau_bo_wr32(chan->notifier_bo, chan->nvsw.vblsem_offset,
777						chan->nvsw.vblsem_rval);
778		list_del(&chan->nvsw.vbl_wait);
779	}
780}
781
782static void
783nv50_display_vblank_handler(struct drm_device *dev, uint32_t intr)
784{
785	intr &= NV50_PDISPLAY_INTR_1_VBLANK_CRTC;
786
787	if (intr & NV50_PDISPLAY_INTR_1_VBLANK_CRTC_0)
788		nv50_display_vblank_crtc_handler(dev, 0);
789
790	if (intr & NV50_PDISPLAY_INTR_1_VBLANK_CRTC_1)
791		nv50_display_vblank_crtc_handler(dev, 1);
792
793	nv_wr32(dev, NV50_PDISPLAY_INTR_EN, nv_rd32(dev,
794		     NV50_PDISPLAY_INTR_EN) & ~intr);
795	nv_wr32(dev, NV50_PDISPLAY_INTR_1, intr);
796}
797
798static void
799nv50_display_unk10_handler(struct drm_device *dev)
800{
801	struct dcb_entry *dcbent;
802	int head, ret;
803
804	ret = nv50_display_irq_head(dev, &head, &dcbent);
805	if (ret)
806		goto ack;
807
808	nv_wr32(dev, 0x619494, nv_rd32(dev, 0x619494) & ~8);
809
810	nouveau_bios_run_display_table(dev, dcbent, 0, -1);
811
812ack:
813	nv_wr32(dev, NV50_PDISPLAY_INTR_1, NV50_PDISPLAY_INTR_1_CLK_UNK10);
814	nv_wr32(dev, 0x610030, 0x80000000);
815}
816
817static void
818nv50_display_unk20_handler(struct drm_device *dev)
819{
820	struct dcb_entry *dcbent;
821	uint32_t tmp, pclk, script;
822	int head, or, ret;
823
824	ret = nv50_display_irq_head(dev, &head, &dcbent);
825	if (ret)
826		goto ack;
827	or = ffs(dcbent->or) - 1;
828	pclk = nv_rd32(dev, NV50_PDISPLAY_CRTC_P(head, CLOCK)) & 0x3fffff;
829	script = nv50_display_script_select(dev, dcbent, pclk);
830
831	NV_DEBUG_KMS(dev, "head %d pxclk: %dKHz\n", head, pclk);
832
833	if (dcbent->type != OUTPUT_DP)
834		nouveau_bios_run_display_table(dev, dcbent, 0, -2);
835
836	nv50_crtc_set_clock(dev, head, pclk);
837
838	nouveau_bios_run_display_table(dev, dcbent, script, pclk);
839
840	tmp = nv_rd32(dev, NV50_PDISPLAY_CRTC_CLK_CTRL2(head));
841	tmp &= ~0x000000f;
842	nv_wr32(dev, NV50_PDISPLAY_CRTC_CLK_CTRL2(head), tmp);
843
844	if (dcbent->type != OUTPUT_ANALOG) {
845		tmp = nv_rd32(dev, NV50_PDISPLAY_SOR_CLK_CTRL2(or));
846		tmp &= ~0x00000f0f;
847		if (script & 0x0100)
848			tmp |= 0x00000101;
849		nv_wr32(dev, NV50_PDISPLAY_SOR_CLK_CTRL2(or), tmp);
850	} else {
851		nv_wr32(dev, NV50_PDISPLAY_DAC_CLK_CTRL2(or), 0);
852	}
853
854ack:
855	nv_wr32(dev, NV50_PDISPLAY_INTR_1, NV50_PDISPLAY_INTR_1_CLK_UNK20);
856	nv_wr32(dev, 0x610030, 0x80000000);
857}
858
859static void
860nv50_display_unk40_handler(struct drm_device *dev)
861{
862	struct dcb_entry *dcbent;
863	int head, pclk, script, ret;
864
865	ret = nv50_display_irq_head(dev, &head, &dcbent);
866	if (ret)
867		goto ack;
868	pclk = nv_rd32(dev, NV50_PDISPLAY_CRTC_P(head, CLOCK)) & 0x3fffff;
869	script = nv50_display_script_select(dev, dcbent, pclk);
870
871	nouveau_bios_run_display_table(dev, dcbent, script, -pclk);
872
873ack:
874	nv_wr32(dev, NV50_PDISPLAY_INTR_1, NV50_PDISPLAY_INTR_1_CLK_UNK40);
875	nv_wr32(dev, 0x610030, 0x80000000);
876	nv_wr32(dev, 0x619494, nv_rd32(dev, 0x619494) | 8);
877}
878
879void
880nv50_display_irq_handler_bh(struct work_struct *work)
881{
882	struct drm_nouveau_private *dev_priv =
883		container_of(work, struct drm_nouveau_private, irq_work);
884	struct drm_device *dev = dev_priv->dev;
885
886	for (;;) {
887		uint32_t intr0 = nv_rd32(dev, NV50_PDISPLAY_INTR_0);
888		uint32_t intr1 = nv_rd32(dev, NV50_PDISPLAY_INTR_1);
889
890		NV_DEBUG_KMS(dev, "PDISPLAY_INTR_BH 0x%08x 0x%08x\n", intr0, intr1);
891
892		if (intr1 & NV50_PDISPLAY_INTR_1_CLK_UNK10)
893			nv50_display_unk10_handler(dev);
894		else
895		if (intr1 & NV50_PDISPLAY_INTR_1_CLK_UNK20)
896			nv50_display_unk20_handler(dev);
897		else
898		if (intr1 & NV50_PDISPLAY_INTR_1_CLK_UNK40)
899			nv50_display_unk40_handler(dev);
900		else
901			break;
902	}
903
904	nv_wr32(dev, NV03_PMC_INTR_EN_0, 1);
905}
906
907static void
908nv50_display_error_handler(struct drm_device *dev)
909{
910	uint32_t addr, data;
911
912	nv_wr32(dev, NV50_PDISPLAY_INTR_0, 0x00010000);
913	addr = nv_rd32(dev, NV50_PDISPLAY_TRAPPED_ADDR);
914	data = nv_rd32(dev, NV50_PDISPLAY_TRAPPED_DATA);
915
916	NV_ERROR(dev, "EvoCh %d Mthd 0x%04x Data 0x%08x (0x%04x 0x%02x)\n",
917		 0, addr & 0xffc, data, addr >> 16, (addr >> 12) & 0xf);
918
919	nv_wr32(dev, NV50_PDISPLAY_TRAPPED_ADDR, 0x90000000);
920}
921
922static void
923nv50_display_irq_hotplug(struct drm_device *dev)
924{
925	struct drm_nouveau_private *dev_priv = dev->dev_private;
926	struct drm_connector *connector;
927	const uint32_t gpio_reg[4] = { 0xe104, 0xe108, 0xe280, 0xe284 };
928	uint32_t unplug_mask, plug_mask, change_mask;
929	uint32_t hpd0, hpd1 = 0;
930
931	hpd0 = nv_rd32(dev, 0xe054) & nv_rd32(dev, 0xe050);
932	if (dev_priv->chipset >= 0x90)
933		hpd1 = nv_rd32(dev, 0xe074) & nv_rd32(dev, 0xe070);
934
935	plug_mask   = (hpd0 & 0x0000ffff) | (hpd1 << 16);
936	unplug_mask = (hpd0 >> 16) | (hpd1 & 0xffff0000);
937	change_mask = plug_mask | unplug_mask;
938
939	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
940		struct drm_encoder_helper_funcs *helper;
941		struct nouveau_connector *nv_connector =
942			nouveau_connector(connector);
943		struct nouveau_encoder *nv_encoder;
944		struct dcb_gpio_entry *gpio;
945		uint32_t reg;
946		bool plugged;
947
948		if (!nv_connector->dcb)
949			continue;
950
951		gpio = nouveau_bios_gpio_entry(dev, nv_connector->dcb->gpio_tag);
952		if (!gpio || !(change_mask & (1 << gpio->line)))
953			continue;
954
955		reg = nv_rd32(dev, gpio_reg[gpio->line >> 3]);
956		plugged = !!(reg & (4 << ((gpio->line & 7) << 2)));
957		NV_INFO(dev, "%splugged %s\n", plugged ? "" : "un",
958			drm_get_connector_name(connector)) ;
959
960		if (!connector->encoder || !connector->encoder->crtc ||
961		    !connector->encoder->crtc->enabled)
962			continue;
963		nv_encoder = nouveau_encoder(connector->encoder);
964		helper = connector->encoder->helper_private;
965
966		if (nv_encoder->dcb->type != OUTPUT_DP)
967			continue;
968
969		if (plugged)
970			helper->dpms(connector->encoder, DRM_MODE_DPMS_ON);
971		else
972			helper->dpms(connector->encoder, DRM_MODE_DPMS_OFF);
973	}
974
975	nv_wr32(dev, 0xe054, nv_rd32(dev, 0xe054));
976	if (dev_priv->chipset >= 0x90)
977		nv_wr32(dev, 0xe074, nv_rd32(dev, 0xe074));
978}
979
980void
981nv50_display_irq_handler(struct drm_device *dev)
982{
983	struct drm_nouveau_private *dev_priv = dev->dev_private;
984	uint32_t delayed = 0;
985
986	while (nv_rd32(dev, NV50_PMC_INTR_0) & NV50_PMC_INTR_0_HOTPLUG)
987		nv50_display_irq_hotplug(dev);
988
989	while (nv_rd32(dev, NV50_PMC_INTR_0) & NV50_PMC_INTR_0_DISPLAY) {
990		uint32_t intr0 = nv_rd32(dev, NV50_PDISPLAY_INTR_0);
991		uint32_t intr1 = nv_rd32(dev, NV50_PDISPLAY_INTR_1);
992		uint32_t clock;
993
994		NV_DEBUG_KMS(dev, "PDISPLAY_INTR 0x%08x 0x%08x\n", intr0, intr1);
995
996		if (!intr0 && !(intr1 & ~delayed))
997			break;
998
999		if (intr0 & 0x00010000) {
1000			nv50_display_error_handler(dev);
1001			intr0 &= ~0x00010000;
1002		}
1003
1004		if (intr1 & NV50_PDISPLAY_INTR_1_VBLANK_CRTC) {
1005			nv50_display_vblank_handler(dev, intr1);
1006			intr1 &= ~NV50_PDISPLAY_INTR_1_VBLANK_CRTC;
1007		}
1008
1009		clock = (intr1 & (NV50_PDISPLAY_INTR_1_CLK_UNK10 |
1010				  NV50_PDISPLAY_INTR_1_CLK_UNK20 |
1011				  NV50_PDISPLAY_INTR_1_CLK_UNK40));
1012		if (clock) {
1013			nv_wr32(dev, NV03_PMC_INTR_EN_0, 0);
1014			if (!work_pending(&dev_priv->irq_work))
1015				queue_work(dev_priv->wq, &dev_priv->irq_work);
1016			delayed |= clock;
1017			intr1 &= ~clock;
1018		}
1019
1020		if (intr0) {
1021			NV_ERROR(dev, "unknown PDISPLAY_INTR_0: 0x%08x\n", intr0);
1022			nv_wr32(dev, NV50_PDISPLAY_INTR_0, intr0);
1023		}
1024
1025		if (intr1) {
1026			NV_ERROR(dev,
1027				 "unknown PDISPLAY_INTR_1: 0x%08x\n", intr1);
1028			nv_wr32(dev, NV50_PDISPLAY_INTR_1, intr1);
1029		}
1030	}
1031}
1032
1033