nv50_display.c 70.0 KB
Newer Older
1
/*
2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
 * Copyright 2011 Red Hat Inc.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 * OTHER DEALINGS IN THE SOFTWARE.
 *
 * Authors: Ben Skeggs
 */

25
#include <linux/dma-mapping.h>
26

27 28
#include <drm/drmP.h>
#include <drm/drm_crtc_helper.h>
29
#include <drm/drm_plane_helper.h>
30
#include <drm/drm_dp_helper.h>
31

32 33
#include <nvif/class.h>

34 35 36
#include "nouveau_drm.h"
#include "nouveau_dma.h"
#include "nouveau_gem.h"
37 38 39
#include "nouveau_connector.h"
#include "nouveau_encoder.h"
#include "nouveau_crtc.h"
40
#include "nouveau_fence.h"
41
#include "nv50_display.h"
42

43 44
#define EVO_DMA_NR 9

45
#define EVO_MASTER  (0x00)
46
#define EVO_FLIP(c) (0x01 + (c))
47 48
#define EVO_OVLY(c) (0x05 + (c))
#define EVO_OIMM(c) (0x09 + (c))
49 50
#define EVO_CURS(c) (0x0d + (c))

51 52
/* offsets in shared sync bo of various structures */
#define EVO_SYNC(c, o) ((c) * 0x0100 + (o))
53 54 55
#define EVO_MAST_NTFY     EVO_SYNC(      0, 0x00)
#define EVO_FLIP_SEM0(c)  EVO_SYNC((c) + 1, 0x00)
#define EVO_FLIP_SEM1(c)  EVO_SYNC((c) + 1, 0x10)
56

57 58 59 60
/******************************************************************************
 * EVO channel
 *****************************************************************************/

61
struct nv50_chan {
62
	struct nvif_object user;
63
	struct nvif_device *device;
64 65 66
};

static int
67 68 69
nv50_chan_create(struct nvif_device *device, struct nvif_object *disp,
		 const u32 *oclass, u8 head, void *data, u32 size,
		 struct nv50_chan *chan)
70
{
71 72 73 74
	const u32 handle = (oclass[0] << 16) | head;
	u32 sclass[8];
	int ret, i;

75 76
	chan->device = device;

77 78 79 80 81
	ret = nvif_object_sclass(disp, sclass, ARRAY_SIZE(sclass));
	WARN_ON(ret > ARRAY_SIZE(sclass));
	if (ret < 0)
		return ret;

82
	while (oclass[0]) {
83 84
		for (i = 0; i < ARRAY_SIZE(sclass); i++) {
			if (sclass[i] == oclass[0]) {
85 86
				ret = nvif_object_init(disp, handle, oclass[0],
						       data, size, &chan->user);
87 88 89 90
				if (ret == 0)
					nvif_object_map(&chan->user);
				return ret;
			}
91
		}
92
		oclass++;
93
	}
94

95
	return -ENOSYS;
96 97 98
}

static void
99
nv50_chan_destroy(struct nv50_chan *chan)
100
{
101
	nvif_object_fini(&chan->user);
102 103 104 105 106 107
}

/******************************************************************************
 * PIO EVO channel
 *****************************************************************************/

108 109
struct nv50_pioc {
	struct nv50_chan base;
110 111 112
};

static void
113
nv50_pioc_destroy(struct nv50_pioc *pioc)
114
{
115
	nv50_chan_destroy(&pioc->base);
116 117 118
}

static int
119 120 121
nv50_pioc_create(struct nvif_device *device, struct nvif_object *disp,
		 const u32 *oclass, u8 head, void *data, u32 size,
		 struct nv50_pioc *pioc)
122
{
123 124
	return nv50_chan_create(device, disp, oclass, head, data, size,
				&pioc->base);
125 126 127 128 129 130 131 132 133 134 135
}

/******************************************************************************
 * Cursor Immediate
 *****************************************************************************/

struct nv50_curs {
	struct nv50_pioc base;
};

static int
136 137
nv50_curs_create(struct nvif_device *device, struct nvif_object *disp,
		 int head, struct nv50_curs *curs)
138
{
139
	struct nv50_disp_cursor_v0 args = {
140 141 142
		.head = head,
	};
	static const u32 oclass[] = {
143 144 145 146 147
		GK104_DISP_CURSOR,
		GF110_DISP_CURSOR,
		GT214_DISP_CURSOR,
		G82_DISP_CURSOR,
		NV50_DISP_CURSOR,
148 149 150
		0
	};

151 152
	return nv50_pioc_create(device, disp, oclass, head, &args, sizeof(args),
				&curs->base);
153 154 155 156 157 158 159 160 161 162 163
}

/******************************************************************************
 * Overlay Immediate
 *****************************************************************************/

struct nv50_oimm {
	struct nv50_pioc base;
};

static int
164 165
nv50_oimm_create(struct nvif_device *device, struct nvif_object *disp,
		 int head, struct nv50_oimm *oimm)
166
{
167
	struct nv50_disp_cursor_v0 args = {
168 169 170
		.head = head,
	};
	static const u32 oclass[] = {
171 172 173 174 175
		GK104_DISP_OVERLAY,
		GF110_DISP_OVERLAY,
		GT214_DISP_OVERLAY,
		G82_DISP_OVERLAY,
		NV50_DISP_OVERLAY,
176 177 178
		0
	};

179 180
	return nv50_pioc_create(device, disp, oclass, head, &args, sizeof(args),
				&oimm->base);
181 182 183 184 185 186
}

/******************************************************************************
 * DMA EVO channel
 *****************************************************************************/

187 188
struct nv50_dmac {
	struct nv50_chan base;
189 190
	dma_addr_t handle;
	u32 *ptr;
191

192 193 194
	struct nvif_object sync;
	struct nvif_object vram;

195 196 197 198
	/* Protects against concurrent pushbuf access to this channel, lock is
	 * grabbed by evo_wait (if the pushbuf reservation is successful) and
	 * dropped again by evo_kick. */
	struct mutex lock;
199 200 201
};

static void
202
nv50_dmac_destroy(struct nv50_dmac *dmac, struct nvif_object *disp)
203
{
204 205
	struct nvif_device *device = dmac->base.device;

206 207 208 209 210
	nvif_object_fini(&dmac->vram);
	nvif_object_fini(&dmac->sync);

	nv50_chan_destroy(&dmac->base);

211
	if (dmac->ptr) {
212
		struct pci_dev *pdev = nvxx_device(device)->pdev;
213 214 215 216
		pci_free_consistent(pdev, PAGE_SIZE, dmac->ptr, dmac->handle);
	}
}

217
static int
218 219
nv50_dmac_create(struct nvif_device *device, struct nvif_object *disp,
		 const u32 *oclass, u8 head, void *data, u32 size, u64 syncbuf,
220
		 struct nv50_dmac *dmac)
221
{
222
	struct nv50_disp_core_channel_dma_v0 *args = data;
223
	struct nvif_object pushbuf;
224 225
	int ret;

226 227
	mutex_init(&dmac->lock);

228
	dmac->ptr = pci_alloc_consistent(nvxx_device(device)->pdev,
229
					 PAGE_SIZE, &dmac->handle);
230 231 232
	if (!dmac->ptr)
		return -ENOMEM;

233 234
	ret = nvif_object_init(&device->object, args->pushbuf,
			       NV_DMA_FROM_MEMORY, &(struct nv_dma_v0) {
235 236
					.target = NV_DMA_V0_TARGET_PCI_US,
					.access = NV_DMA_V0_ACCESS_RD,
237 238
					.start = dmac->handle + 0x0000,
					.limit = dmac->handle + 0x0fff,
239
			       }, sizeof(struct nv_dma_v0), &pushbuf);
240
	if (ret)
241
		return ret;
242

243 244
	ret = nv50_chan_create(device, disp, oclass, head, data, size,
			       &dmac->base);
245
	nvif_object_fini(&pushbuf);
246 247 248
	if (ret)
		return ret;

249
	ret = nvif_object_init(&dmac->base.user, 0xf0000000, NV_DMA_IN_MEMORY,
250 251 252
			       &(struct nv_dma_v0) {
					.target = NV_DMA_V0_TARGET_VRAM,
					.access = NV_DMA_V0_ACCESS_RDWR,
253 254
					.start = syncbuf + 0x0000,
					.limit = syncbuf + 0x0fff,
255
			       }, sizeof(struct nv_dma_v0),
256
			       &dmac->sync);
257 258 259
	if (ret)
		return ret;

260
	ret = nvif_object_init(&dmac->base.user, 0xf0000001, NV_DMA_IN_MEMORY,
261 262 263
			       &(struct nv_dma_v0) {
					.target = NV_DMA_V0_TARGET_VRAM,
					.access = NV_DMA_V0_ACCESS_RDWR,
264
					.start = 0,
265
					.limit = device->info.ram_user - 1,
266
			       }, sizeof(struct nv_dma_v0),
267
			       &dmac->vram);
268
	if (ret)
269 270
		return ret;

271 272 273
	return ret;
}

274 275 276 277
/******************************************************************************
 * Core
 *****************************************************************************/

278 279
struct nv50_mast {
	struct nv50_dmac base;
280 281
};

282
static int
283 284
nv50_core_create(struct nvif_device *device, struct nvif_object *disp,
		 u64 syncbuf, struct nv50_mast *core)
285
{
286 287
	struct nv50_disp_core_channel_dma_v0 args = {
		.pushbuf = 0xb0007d00,
288 289
	};
	static const u32 oclass[] = {
B
Ben Skeggs 已提交
290
		GM204_DISP_CORE_CHANNEL_DMA,
291 292 293 294 295 296 297 298 299
		GM107_DISP_CORE_CHANNEL_DMA,
		GK110_DISP_CORE_CHANNEL_DMA,
		GK104_DISP_CORE_CHANNEL_DMA,
		GF110_DISP_CORE_CHANNEL_DMA,
		GT214_DISP_CORE_CHANNEL_DMA,
		GT206_DISP_CORE_CHANNEL_DMA,
		GT200_DISP_CORE_CHANNEL_DMA,
		G82_DISP_CORE_CHANNEL_DMA,
		NV50_DISP_CORE_CHANNEL_DMA,
300 301 302
		0
	};

303 304
	return nv50_dmac_create(device, disp, oclass, 0, &args, sizeof(args),
				syncbuf, &core->base);
305 306 307 308 309
}

/******************************************************************************
 * Base
 *****************************************************************************/
310

311 312
struct nv50_sync {
	struct nv50_dmac base;
313 314
	u32 addr;
	u32 data;
315 316
};

317
static int
318 319
nv50_base_create(struct nvif_device *device, struct nvif_object *disp,
		 int head, u64 syncbuf, struct nv50_sync *base)
320
{
321 322
	struct nv50_disp_base_channel_dma_v0 args = {
		.pushbuf = 0xb0007c00 | head,
323 324 325
		.head = head,
	};
	static const u32 oclass[] = {
326 327 328 329 330 331 332
		GK110_DISP_BASE_CHANNEL_DMA,
		GK104_DISP_BASE_CHANNEL_DMA,
		GF110_DISP_BASE_CHANNEL_DMA,
		GT214_DISP_BASE_CHANNEL_DMA,
		GT200_DISP_BASE_CHANNEL_DMA,
		G82_DISP_BASE_CHANNEL_DMA,
		NV50_DISP_BASE_CHANNEL_DMA,
333 334 335
		0
	};

336
	return nv50_dmac_create(device, disp, oclass, head, &args, sizeof(args),
337 338 339 340 341 342 343
				syncbuf, &base->base);
}

/******************************************************************************
 * Overlay
 *****************************************************************************/

344 345
struct nv50_ovly {
	struct nv50_dmac base;
346
};
347

348
static int
349 350
nv50_ovly_create(struct nvif_device *device, struct nvif_object *disp,
		 int head, u64 syncbuf, struct nv50_ovly *ovly)
351
{
352 353
	struct nv50_disp_overlay_channel_dma_v0 args = {
		.pushbuf = 0xb0007e00 | head,
354 355 356
		.head = head,
	};
	static const u32 oclass[] = {
357 358 359 360 361 362
		GK104_DISP_OVERLAY_CONTROL_DMA,
		GF110_DISP_OVERLAY_CONTROL_DMA,
		GT214_DISP_OVERLAY_CHANNEL_DMA,
		GT200_DISP_OVERLAY_CHANNEL_DMA,
		G82_DISP_OVERLAY_CHANNEL_DMA,
		NV50_DISP_OVERLAY_CHANNEL_DMA,
363 364 365
		0
	};

366
	return nv50_dmac_create(device, disp, oclass, head, &args, sizeof(args),
367 368
				syncbuf, &ovly->base);
}
369

370
struct nv50_head {
371
	struct nouveau_crtc base;
B
Ben Skeggs 已提交
372
	struct nouveau_bo *image;
373 374 375 376
	struct nv50_curs curs;
	struct nv50_sync sync;
	struct nv50_ovly ovly;
	struct nv50_oimm oimm;
377 378
};

379 380 381 382 383 384
#define nv50_head(c) ((struct nv50_head *)nouveau_crtc(c))
#define nv50_curs(c) (&nv50_head(c)->curs)
#define nv50_sync(c) (&nv50_head(c)->sync)
#define nv50_ovly(c) (&nv50_head(c)->ovly)
#define nv50_oimm(c) (&nv50_head(c)->oimm)
#define nv50_chan(c) (&(c)->base.base)
385 386 387 388 389 390 391
#define nv50_vers(c) nv50_chan(c)->user.oclass

struct nv50_fbdma {
	struct list_head head;
	struct nvif_object core;
	struct nvif_object base[4];
};
392

393
struct nv50_disp {
394
	struct nvif_object *disp;
395
	struct nv50_mast mast;
396

397
	struct list_head fbdma;
398 399

	struct nouveau_bo *sync;
400 401
};

402 403
static struct nv50_disp *
nv50_disp(struct drm_device *dev)
404
{
405
	return nouveau_display(dev)->priv;
406 407
}

408
#define nv50_mast(d) (&nv50_disp(d)->mast)
409

410
static struct drm_crtc *
411
nv50_display_crtc_get(struct drm_encoder *encoder)
412 413 414 415 416 417 418
{
	return nouveau_encoder(encoder)->crtc;
}

/******************************************************************************
 * EVO channel helpers
 *****************************************************************************/
419
static u32 *
420
evo_wait(void *evoc, int nr)
421
{
422
	struct nv50_dmac *dmac = evoc;
423
	struct nvif_device *device = dmac->base.device;
424
	u32 put = nvif_rd32(&dmac->base.user, 0x0000) / 4;
425

426
	mutex_lock(&dmac->lock);
427
	if (put + nr >= (PAGE_SIZE / 4) - 8) {
428
		dmac->ptr[put] = 0x20000000;
429

430
		nvif_wr32(&dmac->base.user, 0x0000, 0x00000000);
431 432 433 434
		if (nvif_msec(device, 2000,
			if (!nvif_rd32(&dmac->base.user, 0x0004))
				break;
		) < 0) {
435
			mutex_unlock(&dmac->lock);
B
Ben Skeggs 已提交
436
			printk(KERN_ERR "nouveau: evo channel stalled\n");
437 438 439 440 441 442
			return NULL;
		}

		put = 0;
	}

443
	return dmac->ptr + put;
444 445 446
}

static void
447
evo_kick(u32 *push, void *evoc)
448
{
449
	struct nv50_dmac *dmac = evoc;
450
	nvif_wr32(&dmac->base.user, 0x0000, (push - dmac->ptr) << 2);
451
	mutex_unlock(&dmac->lock);
452 453
}

454
#if 1
455 456
#define evo_mthd(p,m,s) *((p)++) = (((s) << 18) | (m))
#define evo_data(p,d)   *((p)++) = (d)
457 458 459 460 461 462 463 464 465 466 467 468
#else
#define evo_mthd(p,m,s) do {                                                   \
	const u32 _m = (m), _s = (s);                                          \
	printk(KERN_ERR "%04x %d %s\n", _m, _s, __func__);                     \
	*((p)++) = ((_s << 18) | _m);                                          \
} while(0)
#define evo_data(p,d) do {                                                     \
	const u32 _d = (d);                                                    \
	printk(KERN_ERR "\t%08x\n", _d);                                       \
	*((p)++) = _d;                                                         \
} while(0)
#endif
469

470 471 472
static bool
evo_sync_wait(void *data)
{
473 474 475 476
	if (nouveau_bo_rd32(data, EVO_MAST_NTFY) != 0x00000000)
		return true;
	usleep_range(1, 2);
	return false;
477 478 479
}

static int
480
evo_sync(struct drm_device *dev)
481
{
482
	struct nvif_device *device = &nouveau_drm(dev)->device;
483 484
	struct nv50_disp *disp = nv50_disp(dev);
	struct nv50_mast *mast = nv50_mast(dev);
485
	u32 *push = evo_wait(mast, 8);
486
	if (push) {
487
		nouveau_bo_wr32(disp->sync, EVO_MAST_NTFY, 0x00000000);
488
		evo_mthd(push, 0x0084, 1);
489
		evo_data(push, 0x80000000 | EVO_MAST_NTFY);
490 491 492
		evo_mthd(push, 0x0080, 2);
		evo_data(push, 0x00000000);
		evo_data(push, 0x00000000);
493
		evo_kick(push, mast);
494 495 496 497
		if (nvif_msec(device, 2000,
			if (evo_sync_wait(disp->sync))
				break;
		) >= 0)
498 499 500 501 502 503 504
			return 0;
	}

	return -EBUSY;
}

/******************************************************************************
505
 * Page flipping channel
506 507
 *****************************************************************************/
struct nouveau_bo *
508
nv50_display_crtc_sema(struct drm_device *dev, int crtc)
509
{
510
	return nv50_disp(dev)->sync;
511 512
}

513 514 515 516 517 518 519 520 521 522
struct nv50_display_flip {
	struct nv50_disp *disp;
	struct nv50_sync *chan;
};

static bool
nv50_display_flip_wait(void *data)
{
	struct nv50_display_flip *flip = data;
	if (nouveau_bo_rd32(flip->disp->sync, flip->chan->addr / 4) ==
523
					      flip->chan->data)
524 525 526 527 528
		return true;
	usleep_range(1, 2);
	return false;
}

529
void
530
nv50_display_flip_stop(struct drm_crtc *crtc)
531
{
532
	struct nvif_device *device = &nouveau_drm(crtc->dev)->device;
533 534 535 536
	struct nv50_display_flip flip = {
		.disp = nv50_disp(crtc->dev),
		.chan = nv50_sync(crtc),
	};
537 538
	u32 *push;

539
	push = evo_wait(flip.chan, 8);
540 541 542 543 544 545 546 547 548
	if (push) {
		evo_mthd(push, 0x0084, 1);
		evo_data(push, 0x00000000);
		evo_mthd(push, 0x0094, 1);
		evo_data(push, 0x00000000);
		evo_mthd(push, 0x00c0, 1);
		evo_data(push, 0x00000000);
		evo_mthd(push, 0x0080, 1);
		evo_data(push, 0x00000000);
549
		evo_kick(push, flip.chan);
550
	}
551

552 553 554 555
	nvif_msec(device, 2000,
		if (nv50_display_flip_wait(&flip))
			break;
	);
556 557 558
}

int
559
nv50_display_flip_next(struct drm_crtc *crtc, struct drm_framebuffer *fb,
560 561 562 563
		       struct nouveau_channel *chan, u32 swap_interval)
{
	struct nouveau_framebuffer *nv_fb = nouveau_framebuffer(fb);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
B
Ben Skeggs 已提交
564
	struct nv50_head *head = nv50_head(crtc);
565
	struct nv50_sync *sync = nv50_sync(crtc);
566
	u32 *push;
B
Ben Skeggs 已提交
567
	int ret;
568

569 570 571 572
	if (crtc->primary->fb->width != fb->width ||
	    crtc->primary->fb->height != fb->height)
		return -EINVAL;

573 574 575
	swap_interval <<= 4;
	if (swap_interval == 0)
		swap_interval |= 0x100;
576 577
	if (chan == NULL)
		evo_sync(crtc->dev);
578

579
	push = evo_wait(sync, 128);
580 581 582
	if (unlikely(push == NULL))
		return -EBUSY;

583
	if (chan && chan->user.oclass < G82_CHANNEL_GPFIFO) {
584 585 586 587 588
		ret = RING_SPACE(chan, 8);
		if (ret)
			return ret;

		BEGIN_NV04(chan, 0, NV11_SUBCHAN_DMA_SEMAPHORE, 2);
B
Ben Skeggs 已提交
589
		OUT_RING  (chan, NvEvoSema0 + nv_crtc->index);
590 591 592 593 594 595 596
		OUT_RING  (chan, sync->addr ^ 0x10);
		BEGIN_NV04(chan, 0, NV11_SUBCHAN_SEMAPHORE_RELEASE, 1);
		OUT_RING  (chan, sync->data + 1);
		BEGIN_NV04(chan, 0, NV11_SUBCHAN_SEMAPHORE_OFFSET, 2);
		OUT_RING  (chan, sync->addr);
		OUT_RING  (chan, sync->data);
	} else
597
	if (chan && chan->user.oclass < FERMI_CHANNEL_GPFIFO) {
B
Ben Skeggs 已提交
598
		u64 addr = nv84_fence_crtc(chan, nv_crtc->index) + sync->addr;
599 600 601 602 603
		ret = RING_SPACE(chan, 12);
		if (ret)
			return ret;

		BEGIN_NV04(chan, 0, NV11_SUBCHAN_DMA_SEMAPHORE, 1);
604
		OUT_RING  (chan, chan->vram.handle);
605 606 607 608 609 610 611 612 613 614 615 616
		BEGIN_NV04(chan, 0, NV84_SUBCHAN_SEMAPHORE_ADDRESS_HIGH, 4);
		OUT_RING  (chan, upper_32_bits(addr ^ 0x10));
		OUT_RING  (chan, lower_32_bits(addr ^ 0x10));
		OUT_RING  (chan, sync->data + 1);
		OUT_RING  (chan, NV84_SUBCHAN_SEMAPHORE_TRIGGER_WRITE_LONG);
		BEGIN_NV04(chan, 0, NV84_SUBCHAN_SEMAPHORE_ADDRESS_HIGH, 4);
		OUT_RING  (chan, upper_32_bits(addr));
		OUT_RING  (chan, lower_32_bits(addr));
		OUT_RING  (chan, sync->data);
		OUT_RING  (chan, NV84_SUBCHAN_SEMAPHORE_TRIGGER_ACQUIRE_EQUAL);
	} else
	if (chan) {
B
Ben Skeggs 已提交
617
		u64 addr = nv84_fence_crtc(chan, nv_crtc->index) + sync->addr;
618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634
		ret = RING_SPACE(chan, 10);
		if (ret)
			return ret;

		BEGIN_NVC0(chan, 0, NV84_SUBCHAN_SEMAPHORE_ADDRESS_HIGH, 4);
		OUT_RING  (chan, upper_32_bits(addr ^ 0x10));
		OUT_RING  (chan, lower_32_bits(addr ^ 0x10));
		OUT_RING  (chan, sync->data + 1);
		OUT_RING  (chan, NV84_SUBCHAN_SEMAPHORE_TRIGGER_WRITE_LONG |
				 NVC0_SUBCHAN_SEMAPHORE_TRIGGER_YIELD);
		BEGIN_NVC0(chan, 0, NV84_SUBCHAN_SEMAPHORE_ADDRESS_HIGH, 4);
		OUT_RING  (chan, upper_32_bits(addr));
		OUT_RING  (chan, lower_32_bits(addr));
		OUT_RING  (chan, sync->data);
		OUT_RING  (chan, NV84_SUBCHAN_SEMAPHORE_TRIGGER_ACQUIRE_EQUAL |
				 NVC0_SUBCHAN_SEMAPHORE_TRIGGER_YIELD);
	}
635

636 637 638
	if (chan) {
		sync->addr ^= 0x10;
		sync->data++;
639 640 641 642 643 644 645 646 647 648 649 650 651
		FIRE_RING (chan);
	}

	/* queue the flip */
	evo_mthd(push, 0x0100, 1);
	evo_data(push, 0xfffe0000);
	evo_mthd(push, 0x0084, 1);
	evo_data(push, swap_interval);
	if (!(swap_interval & 0x00000100)) {
		evo_mthd(push, 0x00e0, 1);
		evo_data(push, 0x40000000);
	}
	evo_mthd(push, 0x0088, 4);
652 653 654
	evo_data(push, sync->addr);
	evo_data(push, sync->data++);
	evo_data(push, sync->data);
655
	evo_data(push, sync->base.sync.handle);
656 657 658 659
	evo_mthd(push, 0x00a0, 2);
	evo_data(push, 0x00000000);
	evo_data(push, 0x00000000);
	evo_mthd(push, 0x00c0, 1);
660
	evo_data(push, nv_fb->r_handle);
661 662 663
	evo_mthd(push, 0x0110, 2);
	evo_data(push, 0x00000000);
	evo_data(push, 0x00000000);
664
	if (nv50_vers(sync) < GF110_DISP_BASE_CHANNEL_DMA) {
665 666 667 668 669 670 671 672 673 674 675 676 677 678
		evo_mthd(push, 0x0800, 5);
		evo_data(push, nv_fb->nvbo->bo.offset >> 8);
		evo_data(push, 0);
		evo_data(push, (fb->height << 16) | fb->width);
		evo_data(push, nv_fb->r_pitch);
		evo_data(push, nv_fb->r_format);
	} else {
		evo_mthd(push, 0x0400, 5);
		evo_data(push, nv_fb->nvbo->bo.offset >> 8);
		evo_data(push, 0);
		evo_data(push, (fb->height << 16) | fb->width);
		evo_data(push, nv_fb->r_pitch);
		evo_data(push, nv_fb->r_format);
	}
679 680
	evo_mthd(push, 0x0080, 1);
	evo_data(push, 0x00000000);
681
	evo_kick(push, sync);
B
Ben Skeggs 已提交
682 683

	nouveau_bo_ref(nv_fb->nvbo, &head->image);
684 685 686
	return 0;
}

687 688 689 690
/******************************************************************************
 * CRTC
 *****************************************************************************/
static int
691
nv50_crtc_set_dither(struct nouveau_crtc *nv_crtc, bool update)
692
{
693
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
694 695 696
	struct nouveau_connector *nv_connector;
	struct drm_connector *connector;
	u32 *push, mode = 0x00;
697

698
	nv_connector = nouveau_crtc_connector_get(nv_crtc);
699 700
	connector = &nv_connector->base;
	if (nv_connector->dithering_mode == DITHERING_MODE_AUTO) {
701
		if (nv_crtc->base.primary->fb->depth > connector->display_info.bpc * 3)
702 703 704 705 706 707 708 709 710 711
			mode = DITHERING_MODE_DYNAMIC2X2;
	} else {
		mode = nv_connector->dithering_mode;
	}

	if (nv_connector->dithering_depth == DITHERING_DEPTH_AUTO) {
		if (connector->display_info.bpc >= 8)
			mode |= DITHERING_DEPTH_8BPC;
	} else {
		mode |= nv_connector->dithering_depth;
712 713
	}

714
	push = evo_wait(mast, 4);
715
	if (push) {
716
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
717 718 719
			evo_mthd(push, 0x08a0 + (nv_crtc->index * 0x0400), 1);
			evo_data(push, mode);
		} else
720
		if (nv50_vers(mast) < GK104_DISP_CORE_CHANNEL_DMA) {
721 722 723 724 725 726 727
			evo_mthd(push, 0x0490 + (nv_crtc->index * 0x0300), 1);
			evo_data(push, mode);
		} else {
			evo_mthd(push, 0x04a0 + (nv_crtc->index * 0x0300), 1);
			evo_data(push, mode);
		}

728 729 730 731
		if (update) {
			evo_mthd(push, 0x0080, 1);
			evo_data(push, 0x00000000);
		}
732
		evo_kick(push, mast);
733 734 735 736 737 738
	}

	return 0;
}

static int
739
nv50_crtc_set_scale(struct nouveau_crtc *nv_crtc, bool update)
740
{
741
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
742
	struct drm_display_mode *omode, *umode = &nv_crtc->base.mode;
743
	struct drm_crtc *crtc = &nv_crtc->base;
B
Ben Skeggs 已提交
744
	struct nouveau_connector *nv_connector;
745 746
	int mode = DRM_MODE_SCALE_NONE;
	u32 oX, oY, *push;
B
Ben Skeggs 已提交
747

748 749 750
	/* start off at the resolution we programmed the crtc for, this
	 * effectively handles NONE/FULL scaling
	 */
B
Ben Skeggs 已提交
751
	nv_connector = nouveau_crtc_connector_get(nv_crtc);
752
	if (nv_connector && nv_connector->native_mode) {
753
		mode = nv_connector->scaling_mode;
754 755 756
		if (nv_connector->scaling_full) /* non-EDID LVDS/eDP mode */
			mode = DRM_MODE_SCALE_FULLSCREEN;
	}
757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805

	if (mode != DRM_MODE_SCALE_NONE)
		omode = nv_connector->native_mode;
	else
		omode = umode;

	oX = omode->hdisplay;
	oY = omode->vdisplay;
	if (omode->flags & DRM_MODE_FLAG_DBLSCAN)
		oY *= 2;

	/* add overscan compensation if necessary, will keep the aspect
	 * ratio the same as the backend mode unless overridden by the
	 * user setting both hborder and vborder properties.
	 */
	if (nv_connector && ( nv_connector->underscan == UNDERSCAN_ON ||
			     (nv_connector->underscan == UNDERSCAN_AUTO &&
			      nv_connector->edid &&
			      drm_detect_hdmi_monitor(nv_connector->edid)))) {
		u32 bX = nv_connector->underscan_hborder;
		u32 bY = nv_connector->underscan_vborder;
		u32 aspect = (oY << 19) / oX;

		if (bX) {
			oX -= (bX * 2);
			if (bY) oY -= (bY * 2);
			else    oY  = ((oX * aspect) + (aspect / 2)) >> 19;
		} else {
			oX -= (oX >> 4) + 32;
			if (bY) oY -= (bY * 2);
			else    oY  = ((oX * aspect) + (aspect / 2)) >> 19;
		}
	}

	/* handle CENTER/ASPECT scaling, taking into account the areas
	 * removed already for overscan compensation
	 */
	switch (mode) {
	case DRM_MODE_SCALE_CENTER:
		oX = min((u32)umode->hdisplay, oX);
		oY = min((u32)umode->vdisplay, oY);
		/* fall-through */
	case DRM_MODE_SCALE_ASPECT:
		if (oY < oX) {
			u32 aspect = (umode->hdisplay << 19) / umode->vdisplay;
			oX = ((oY * aspect) + (aspect / 2)) >> 19;
		} else {
			u32 aspect = (umode->vdisplay << 19) / umode->hdisplay;
			oY = ((oX * aspect) + (aspect / 2)) >> 19;
B
Ben Skeggs 已提交
806
		}
807 808 809
		break;
	default:
		break;
B
Ben Skeggs 已提交
810
	}
811

812
	push = evo_wait(mast, 8);
813
	if (push) {
814
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835
			/*XXX: SCALE_CTRL_ACTIVE??? */
			evo_mthd(push, 0x08d8 + (nv_crtc->index * 0x400), 2);
			evo_data(push, (oY << 16) | oX);
			evo_data(push, (oY << 16) | oX);
			evo_mthd(push, 0x08a4 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x08c8 + (nv_crtc->index * 0x400), 1);
			evo_data(push, umode->vdisplay << 16 | umode->hdisplay);
		} else {
			evo_mthd(push, 0x04c0 + (nv_crtc->index * 0x300), 3);
			evo_data(push, (oY << 16) | oX);
			evo_data(push, (oY << 16) | oX);
			evo_data(push, (oY << 16) | oX);
			evo_mthd(push, 0x0494 + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x04b8 + (nv_crtc->index * 0x300), 1);
			evo_data(push, umode->vdisplay << 16 | umode->hdisplay);
		}

		evo_kick(push, mast);

836
		if (update) {
837
			nv50_display_flip_stop(crtc);
838 839
			nv50_display_flip_next(crtc, crtc->primary->fb,
					       NULL, 1);
840 841 842 843 844 845
		}
	}

	return 0;
}

846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861
static int
nv50_crtc_set_raster_vblank_dmi(struct nouveau_crtc *nv_crtc, u32 usec)
{
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
	u32 *push;

	push = evo_wait(mast, 8);
	if (!push)
		return -ENOMEM;

	evo_mthd(push, 0x0828 + (nv_crtc->index * 0x400), 1);
	evo_data(push, usec);
	evo_kick(push, mast);
	return 0;
}

862
static int
863
nv50_crtc_set_color_vibrance(struct nouveau_crtc *nv_crtc, bool update)
864
{
865
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
866 867 868 869 870 871 872 873 874
	u32 *push, hue, vib;
	int adj;

	adj = (nv_crtc->color_vibrance > 0) ? 50 : 0;
	vib = ((nv_crtc->color_vibrance * 2047 + adj) / 100) & 0xfff;
	hue = ((nv_crtc->vibrant_hue * 2047) / 100) & 0xfff;

	push = evo_wait(mast, 16);
	if (push) {
875
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892
			evo_mthd(push, 0x08a8 + (nv_crtc->index * 0x400), 1);
			evo_data(push, (hue << 20) | (vib << 8));
		} else {
			evo_mthd(push, 0x0498 + (nv_crtc->index * 0x300), 1);
			evo_data(push, (hue << 20) | (vib << 8));
		}

		if (update) {
			evo_mthd(push, 0x0080, 1);
			evo_data(push, 0x00000000);
		}
		evo_kick(push, mast);
	}

	return 0;
}

893
static int
894
nv50_crtc_set_image(struct nouveau_crtc *nv_crtc, struct drm_framebuffer *fb,
895 896 897
		    int x, int y, bool update)
{
	struct nouveau_framebuffer *nvfb = nouveau_framebuffer(fb);
898
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
899 900
	u32 *push;

901
	push = evo_wait(mast, 16);
902
	if (push) {
903
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
904 905 906 907 908 909 910 911
			evo_mthd(push, 0x0860 + (nv_crtc->index * 0x400), 1);
			evo_data(push, nvfb->nvbo->bo.offset >> 8);
			evo_mthd(push, 0x0868 + (nv_crtc->index * 0x400), 3);
			evo_data(push, (fb->height << 16) | fb->width);
			evo_data(push, nvfb->r_pitch);
			evo_data(push, nvfb->r_format);
			evo_mthd(push, 0x08c0 + (nv_crtc->index * 0x400), 1);
			evo_data(push, (y << 16) | x);
912
			if (nv50_vers(mast) > NV50_DISP_CORE_CHANNEL_DMA) {
913
				evo_mthd(push, 0x0874 + (nv_crtc->index * 0x400), 1);
914
				evo_data(push, nvfb->r_handle);
915 916 917 918 919 920 921 922
			}
		} else {
			evo_mthd(push, 0x0460 + (nv_crtc->index * 0x300), 1);
			evo_data(push, nvfb->nvbo->bo.offset >> 8);
			evo_mthd(push, 0x0468 + (nv_crtc->index * 0x300), 4);
			evo_data(push, (fb->height << 16) | fb->width);
			evo_data(push, nvfb->r_pitch);
			evo_data(push, nvfb->r_format);
923
			evo_data(push, nvfb->r_handle);
924 925 926 927
			evo_mthd(push, 0x04b0 + (nv_crtc->index * 0x300), 1);
			evo_data(push, (y << 16) | x);
		}

928 929 930 931
		if (update) {
			evo_mthd(push, 0x0080, 1);
			evo_data(push, 0x00000000);
		}
932
		evo_kick(push, mast);
933 934
	}

935
	nv_crtc->fb.handle = nvfb->r_handle;
936 937 938 939
	return 0;
}

static void
940
nv50_crtc_cursor_show(struct nouveau_crtc *nv_crtc)
941
{
942
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
943
	u32 *push = evo_wait(mast, 16);
944
	if (push) {
945
		if (nv50_vers(mast) < G82_DISP_CORE_CHANNEL_DMA) {
946 947
			evo_mthd(push, 0x0880 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0x85000000);
948
			evo_data(push, nv_crtc->cursor.nvbo->bo.offset >> 8);
949
		} else
950
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
951 952
			evo_mthd(push, 0x0880 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0x85000000);
953
			evo_data(push, nv_crtc->cursor.nvbo->bo.offset >> 8);
954
			evo_mthd(push, 0x089c + (nv_crtc->index * 0x400), 1);
955
			evo_data(push, mast->base.vram.handle);
956
		} else {
957 958
			evo_mthd(push, 0x0480 + (nv_crtc->index * 0x300), 2);
			evo_data(push, 0x85000000);
959
			evo_data(push, nv_crtc->cursor.nvbo->bo.offset >> 8);
960
			evo_mthd(push, 0x048c + (nv_crtc->index * 0x300), 1);
961
			evo_data(push, mast->base.vram.handle);
962 963 964
		}
		evo_kick(push, mast);
	}
965
	nv_crtc->cursor.visible = true;
966 967 968
}

static void
969
nv50_crtc_cursor_hide(struct nouveau_crtc *nv_crtc)
970
{
971
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
972 973
	u32 *push = evo_wait(mast, 16);
	if (push) {
974
		if (nv50_vers(mast) < G82_DISP_CORE_CHANNEL_DMA) {
975 976 977
			evo_mthd(push, 0x0880 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x05000000);
		} else
978
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
979 980 981 982
			evo_mthd(push, 0x0880 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x05000000);
			evo_mthd(push, 0x089c + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x00000000);
983 984 985 986 987 988
		} else {
			evo_mthd(push, 0x0480 + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x05000000);
			evo_mthd(push, 0x048c + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x00000000);
		}
989 990
		evo_kick(push, mast);
	}
991
	nv_crtc->cursor.visible = false;
992
}
993

994
static void
995
nv50_crtc_cursor_show_hide(struct nouveau_crtc *nv_crtc, bool show, bool update)
996
{
997
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
998

999
	if (show && nv_crtc->cursor.nvbo && nv_crtc->base.enabled)
1000
		nv50_crtc_cursor_show(nv_crtc);
1001
	else
1002
		nv50_crtc_cursor_hide(nv_crtc);
1003 1004 1005 1006

	if (update) {
		u32 *push = evo_wait(mast, 2);
		if (push) {
1007 1008
			evo_mthd(push, 0x0080, 1);
			evo_data(push, 0x00000000);
1009
			evo_kick(push, mast);
1010 1011 1012 1013 1014
		}
	}
}

static void
1015
nv50_crtc_dpms(struct drm_crtc *crtc, int mode)
1016 1017 1018 1019
{
}

static void
1020
nv50_crtc_prepare(struct drm_crtc *crtc)
1021 1022
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1023
	struct nv50_mast *mast = nv50_mast(crtc->dev);
1024 1025
	u32 *push;

1026
	nv50_display_flip_stop(crtc);
1027

1028
	push = evo_wait(mast, 6);
1029
	if (push) {
1030
		if (nv50_vers(mast) < G82_DISP_CORE_CHANNEL_DMA) {
1031 1032 1033 1034 1035
			evo_mthd(push, 0x0874 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x0840 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x40000000);
		} else
1036
		if (nv50_vers(mast) <  GF110_DISP_CORE_CHANNEL_DMA) {
1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052
			evo_mthd(push, 0x0874 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x0840 + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x40000000);
			evo_mthd(push, 0x085c + (nv_crtc->index * 0x400), 1);
			evo_data(push, 0x00000000);
		} else {
			evo_mthd(push, 0x0474 + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x0440 + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x03000000);
			evo_mthd(push, 0x045c + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x00000000);
		}

		evo_kick(push, mast);
1053 1054
	}

1055
	nv50_crtc_cursor_show_hide(nv_crtc, false, false);
1056 1057 1058
}

static void
1059
nv50_crtc_commit(struct drm_crtc *crtc)
1060 1061
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1062
	struct nv50_mast *mast = nv50_mast(crtc->dev);
1063 1064
	u32 *push;

1065
	push = evo_wait(mast, 32);
1066
	if (push) {
1067
		if (nv50_vers(mast) < G82_DISP_CORE_CHANNEL_DMA) {
1068
			evo_mthd(push, 0x0874 + (nv_crtc->index * 0x400), 1);
1069
			evo_data(push, nv_crtc->fb.handle);
1070 1071 1072 1073
			evo_mthd(push, 0x0840 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0xc0000000);
			evo_data(push, nv_crtc->lut.nvbo->bo.offset >> 8);
		} else
1074
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1075
			evo_mthd(push, 0x0874 + (nv_crtc->index * 0x400), 1);
1076
			evo_data(push, nv_crtc->fb.handle);
1077 1078 1079 1080
			evo_mthd(push, 0x0840 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0xc0000000);
			evo_data(push, nv_crtc->lut.nvbo->bo.offset >> 8);
			evo_mthd(push, 0x085c + (nv_crtc->index * 0x400), 1);
1081
			evo_data(push, mast->base.vram.handle);
1082 1083
		} else {
			evo_mthd(push, 0x0474 + (nv_crtc->index * 0x300), 1);
1084
			evo_data(push, nv_crtc->fb.handle);
1085 1086 1087 1088 1089 1090
			evo_mthd(push, 0x0440 + (nv_crtc->index * 0x300), 4);
			evo_data(push, 0x83000000);
			evo_data(push, nv_crtc->lut.nvbo->bo.offset >> 8);
			evo_data(push, 0x00000000);
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x045c + (nv_crtc->index * 0x300), 1);
1091
			evo_data(push, mast->base.vram.handle);
1092 1093 1094 1095 1096
			evo_mthd(push, 0x0430 + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0xffffff00);
		}

		evo_kick(push, mast);
1097 1098
	}

1099
	nv50_crtc_cursor_show_hide(nv_crtc, true, true);
1100
	nv50_display_flip_next(crtc, crtc->primary->fb, NULL, 1);
1101 1102 1103
}

static bool
1104
nv50_crtc_mode_fixup(struct drm_crtc *crtc, const struct drm_display_mode *mode,
1105 1106
		     struct drm_display_mode *adjusted_mode)
{
1107
	drm_mode_set_crtcinfo(adjusted_mode, CRTC_INTERLACE_HALVE_V);
1108 1109 1110 1111
	return true;
}

static int
1112
nv50_crtc_swap_fbs(struct drm_crtc *crtc, struct drm_framebuffer *old_fb)
1113
{
1114
	struct nouveau_framebuffer *nvfb = nouveau_framebuffer(crtc->primary->fb);
B
Ben Skeggs 已提交
1115
	struct nv50_head *head = nv50_head(crtc);
1116 1117
	int ret;

1118
	ret = nouveau_bo_pin(nvfb->nvbo, TTM_PL_FLAG_VRAM, true);
B
Ben Skeggs 已提交
1119 1120 1121 1122
	if (ret == 0) {
		if (head->image)
			nouveau_bo_unpin(head->image);
		nouveau_bo_ref(nvfb->nvbo, &head->image);
1123 1124
	}

B
Ben Skeggs 已提交
1125
	return ret;
1126 1127 1128
}

static int
1129
nv50_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *umode,
1130 1131 1132
		   struct drm_display_mode *mode, int x, int y,
		   struct drm_framebuffer *old_fb)
{
1133
	struct nv50_mast *mast = nv50_mast(crtc->dev);
1134 1135
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
	struct nouveau_connector *nv_connector;
1136 1137 1138 1139
	u32 ilace = (mode->flags & DRM_MODE_FLAG_INTERLACE) ? 2 : 1;
	u32 vscan = (mode->flags & DRM_MODE_FLAG_DBLSCAN) ? 2 : 1;
	u32 hactive, hsynce, hbackp, hfrontp, hblanke, hblanks;
	u32 vactive, vsynce, vbackp, vfrontp, vblanke, vblanks;
1140
	u32 vblan2e = 0, vblan2s = 1, vblankus = 0;
1141
	u32 *push;
1142 1143
	int ret;

1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156
	hactive = mode->htotal;
	hsynce  = mode->hsync_end - mode->hsync_start - 1;
	hbackp  = mode->htotal - mode->hsync_end;
	hblanke = hsynce + hbackp;
	hfrontp = mode->hsync_start - mode->hdisplay;
	hblanks = mode->htotal - hfrontp - 1;

	vactive = mode->vtotal * vscan / ilace;
	vsynce  = ((mode->vsync_end - mode->vsync_start) * vscan / ilace) - 1;
	vbackp  = (mode->vtotal - mode->vsync_end) * vscan / ilace;
	vblanke = vsynce + vbackp;
	vfrontp = (mode->vsync_start - mode->vdisplay) * vscan / ilace;
	vblanks = vactive - vfrontp - 1;
1157 1158 1159 1160 1161
	/* XXX: Safe underestimate, even "0" works */
	vblankus = (vactive - mode->vdisplay - 2) * hactive;
	vblankus *= 1000;
	vblankus /= mode->clock;

1162 1163 1164 1165 1166 1167
	if (mode->flags & DRM_MODE_FLAG_INTERLACE) {
		vblan2e = vactive + vsynce + vbackp;
		vblan2s = vblan2e + (mode->vdisplay * vscan / ilace);
		vactive = (vactive * 2) + 1;
	}

1168
	ret = nv50_crtc_swap_fbs(crtc, old_fb);
1169 1170 1171
	if (ret)
		return ret;

1172
	push = evo_wait(mast, 64);
1173
	if (push) {
1174
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1175 1176 1177
			evo_mthd(push, 0x0804 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0x00800000 | mode->clock);
			evo_data(push, (ilace == 2) ? 2 : 0);
1178
			evo_mthd(push, 0x0810 + (nv_crtc->index * 0x400), 6);
1179 1180 1181 1182 1183 1184
			evo_data(push, 0x00000000);
			evo_data(push, (vactive << 16) | hactive);
			evo_data(push, ( vsynce << 16) | hsynce);
			evo_data(push, (vblanke << 16) | hblanke);
			evo_data(push, (vblanks << 16) | hblanks);
			evo_data(push, (vblan2e << 16) | vblan2s);
1185
			evo_mthd(push, 0x082c + (nv_crtc->index * 0x400), 1);
1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209
			evo_data(push, 0x00000000);
			evo_mthd(push, 0x0900 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0x00000311);
			evo_data(push, 0x00000100);
		} else {
			evo_mthd(push, 0x0410 + (nv_crtc->index * 0x300), 6);
			evo_data(push, 0x00000000);
			evo_data(push, (vactive << 16) | hactive);
			evo_data(push, ( vsynce << 16) | hsynce);
			evo_data(push, (vblanke << 16) | hblanke);
			evo_data(push, (vblanks << 16) | hblanks);
			evo_data(push, (vblan2e << 16) | vblan2s);
			evo_mthd(push, 0x042c + (nv_crtc->index * 0x300), 1);
			evo_data(push, 0x00000000); /* ??? */
			evo_mthd(push, 0x0450 + (nv_crtc->index * 0x300), 3);
			evo_data(push, mode->clock * 1000);
			evo_data(push, 0x00200000); /* ??? */
			evo_data(push, mode->clock * 1000);
			evo_mthd(push, 0x04d0 + (nv_crtc->index * 0x300), 2);
			evo_data(push, 0x00000311);
			evo_data(push, 0x00000100);
		}

		evo_kick(push, mast);
1210 1211 1212
	}

	nv_connector = nouveau_crtc_connector_get(nv_crtc);
1213 1214
	nv50_crtc_set_dither(nv_crtc, false);
	nv50_crtc_set_scale(nv_crtc, false);
1215 1216 1217 1218 1219

	/* G94 only accepts this after setting scale */
	if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA)
		nv50_crtc_set_raster_vblank_dmi(nv_crtc, vblankus);

1220
	nv50_crtc_set_color_vibrance(nv_crtc, false);
1221
	nv50_crtc_set_image(nv_crtc, crtc->primary->fb, x, y, false);
1222 1223 1224 1225
	return 0;
}

static int
1226
nv50_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
1227 1228
			struct drm_framebuffer *old_fb)
{
1229
	struct nouveau_drm *drm = nouveau_drm(crtc->dev);
1230 1231 1232
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
	int ret;

1233
	if (!crtc->primary->fb) {
1234
		NV_DEBUG(drm, "No FB bound\n");
1235 1236 1237
		return 0;
	}

1238
	ret = nv50_crtc_swap_fbs(crtc, old_fb);
1239 1240 1241
	if (ret)
		return ret;

1242
	nv50_display_flip_stop(crtc);
1243 1244
	nv50_crtc_set_image(nv_crtc, crtc->primary->fb, x, y, true);
	nv50_display_flip_next(crtc, crtc->primary->fb, NULL, 1);
1245 1246 1247 1248
	return 0;
}

static int
1249
nv50_crtc_mode_set_base_atomic(struct drm_crtc *crtc,
1250 1251 1252 1253
			       struct drm_framebuffer *fb, int x, int y,
			       enum mode_set_atomic state)
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1254 1255
	nv50_display_flip_stop(crtc);
	nv50_crtc_set_image(nv_crtc, fb, x, y, true);
1256 1257 1258 1259
	return 0;
}

static void
1260
nv50_crtc_lut_load(struct drm_crtc *crtc)
1261
{
1262
	struct nv50_disp *disp = nv50_disp(crtc->dev);
1263 1264 1265 1266 1267
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
	void __iomem *lut = nvbo_kmap_obj_iovirtual(nv_crtc->lut.nvbo);
	int i;

	for (i = 0; i < 256; i++) {
1268 1269 1270 1271
		u16 r = nv_crtc->lut.r[i] >> 2;
		u16 g = nv_crtc->lut.g[i] >> 2;
		u16 b = nv_crtc->lut.b[i] >> 2;

1272
		if (disp->disp->oclass < GF110_DISP) {
1273 1274 1275 1276 1277 1278 1279 1280
			writew(r + 0x0000, lut + (i * 0x08) + 0);
			writew(g + 0x0000, lut + (i * 0x08) + 2);
			writew(b + 0x0000, lut + (i * 0x08) + 4);
		} else {
			writew(r + 0x6000, lut + (i * 0x20) + 0);
			writew(g + 0x6000, lut + (i * 0x20) + 2);
			writew(b + 0x6000, lut + (i * 0x20) + 4);
		}
1281 1282 1283
	}
}

B
Ben Skeggs 已提交
1284 1285 1286 1287
static void
nv50_crtc_disable(struct drm_crtc *crtc)
{
	struct nv50_head *head = nv50_head(crtc);
1288
	evo_sync(crtc->dev);
B
Ben Skeggs 已提交
1289 1290 1291 1292 1293
	if (head->image)
		nouveau_bo_unpin(head->image);
	nouveau_bo_ref(NULL, &head->image);
}

1294
static int
1295
nv50_crtc_cursor_set(struct drm_crtc *crtc, struct drm_file *file_priv,
1296 1297 1298 1299
		     uint32_t handle, uint32_t width, uint32_t height)
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
	struct drm_device *dev = crtc->dev;
1300 1301 1302
	struct drm_gem_object *gem = NULL;
	struct nouveau_bo *nvbo = NULL;
	int ret = 0;
1303

1304
	if (handle) {
1305 1306 1307 1308 1309 1310 1311 1312
		if (width != 64 || height != 64)
			return -EINVAL;

		gem = drm_gem_object_lookup(dev, file_priv, handle);
		if (unlikely(!gem))
			return -ENOENT;
		nvbo = nouveau_gem_object(gem);

1313
		ret = nouveau_bo_pin(nvbo, TTM_PL_FLAG_VRAM, true);
1314 1315
	}

1316
	if (ret == 0) {
1317 1318 1319
		if (nv_crtc->cursor.nvbo)
			nouveau_bo_unpin(nv_crtc->cursor.nvbo);
		nouveau_bo_ref(nvbo, &nv_crtc->cursor.nvbo);
1320
	}
1321
	drm_gem_object_unreference_unlocked(gem);
1322

1323
	nv50_crtc_cursor_show_hide(nv_crtc, true, true);
1324 1325 1326 1327
	return ret;
}

static int
1328
nv50_crtc_cursor_move(struct drm_crtc *crtc, int x, int y)
1329
{
1330
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1331 1332
	struct nv50_curs *curs = nv50_curs(crtc);
	struct nv50_chan *chan = nv50_chan(curs);
1333 1334
	nvif_wr32(&chan->user, 0x0084, (y << 16) | (x & 0xffff));
	nvif_wr32(&chan->user, 0x0080, 0x00000000);
1335 1336 1337

	nv_crtc->cursor_saved_x = x;
	nv_crtc->cursor_saved_y = y;
1338 1339 1340 1341
	return 0;
}

static void
1342
nv50_crtc_gamma_set(struct drm_crtc *crtc, u16 *r, u16 *g, u16 *b,
1343 1344 1345
		    uint32_t start, uint32_t size)
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1346
	u32 end = min_t(u32, start + size, 256);
1347 1348 1349 1350 1351 1352 1353 1354
	u32 i;

	for (i = start; i < end; i++) {
		nv_crtc->lut.r[i] = r[i];
		nv_crtc->lut.g[i] = g[i];
		nv_crtc->lut.b[i] = b[i];
	}

1355
	nv50_crtc_lut_load(crtc);
1356 1357
}

1358 1359 1360 1361 1362 1363 1364 1365
static void
nv50_crtc_cursor_restore(struct nouveau_crtc *nv_crtc, int x, int y)
{
	nv50_crtc_cursor_move(&nv_crtc->base, x, y);

	nv50_crtc_cursor_show_hide(nv_crtc, true, true);
}

1366
static void
1367
nv50_crtc_destroy(struct drm_crtc *crtc)
1368 1369
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1370 1371
	struct nv50_disp *disp = nv50_disp(crtc->dev);
	struct nv50_head *head = nv50_head(crtc);
1372
	struct nv50_fbdma *fbdma;
B
Ben Skeggs 已提交
1373

1374 1375 1376 1377 1378 1379 1380 1381
	list_for_each_entry(fbdma, &disp->fbdma, head) {
		nvif_object_fini(&fbdma->base[nv_crtc->index]);
	}

	nv50_dmac_destroy(&head->ovly.base, disp->disp);
	nv50_pioc_destroy(&head->oimm.base);
	nv50_dmac_destroy(&head->sync.base, disp->disp);
	nv50_pioc_destroy(&head->curs.base);
B
Ben Skeggs 已提交
1382 1383 1384 1385 1386 1387 1388 1389

	/*XXX: this shouldn't be necessary, but the core doesn't call
	 *     disconnect() during the cleanup paths
	 */
	if (head->image)
		nouveau_bo_unpin(head->image);
	nouveau_bo_ref(NULL, &head->image);

1390
	/*XXX: ditto */
1391 1392 1393
	if (nv_crtc->cursor.nvbo)
		nouveau_bo_unpin(nv_crtc->cursor.nvbo);
	nouveau_bo_ref(NULL, &nv_crtc->cursor.nvbo);
B
Ben Skeggs 已提交
1394

1395
	nouveau_bo_unmap(nv_crtc->lut.nvbo);
1396 1397
	if (nv_crtc->lut.nvbo)
		nouveau_bo_unpin(nv_crtc->lut.nvbo);
1398
	nouveau_bo_ref(NULL, &nv_crtc->lut.nvbo);
B
Ben Skeggs 已提交
1399

1400 1401 1402 1403
	drm_crtc_cleanup(crtc);
	kfree(crtc);
}

1404 1405 1406 1407 1408 1409 1410 1411 1412
static const struct drm_crtc_helper_funcs nv50_crtc_hfunc = {
	.dpms = nv50_crtc_dpms,
	.prepare = nv50_crtc_prepare,
	.commit = nv50_crtc_commit,
	.mode_fixup = nv50_crtc_mode_fixup,
	.mode_set = nv50_crtc_mode_set,
	.mode_set_base = nv50_crtc_mode_set_base,
	.mode_set_base_atomic = nv50_crtc_mode_set_base_atomic,
	.load_lut = nv50_crtc_lut_load,
B
Ben Skeggs 已提交
1413
	.disable = nv50_crtc_disable,
1414 1415
};

1416 1417 1418 1419
static const struct drm_crtc_funcs nv50_crtc_func = {
	.cursor_set = nv50_crtc_cursor_set,
	.cursor_move = nv50_crtc_cursor_move,
	.gamma_set = nv50_crtc_gamma_set,
1420
	.set_config = nouveau_crtc_set_config,
1421
	.destroy = nv50_crtc_destroy,
1422
	.page_flip = nouveau_crtc_page_flip,
1423 1424 1425
};

static int
1426
nv50_crtc_create(struct drm_device *dev, int index)
1427
{
1428 1429
	struct nouveau_drm *drm = nouveau_drm(dev);
	struct nvif_device *device = &drm->device;
1430 1431
	struct nv50_disp *disp = nv50_disp(dev);
	struct nv50_head *head;
1432 1433 1434
	struct drm_crtc *crtc;
	int ret, i;

1435 1436
	head = kzalloc(sizeof(*head), GFP_KERNEL);
	if (!head)
1437 1438
		return -ENOMEM;

1439
	head->base.index = index;
1440 1441 1442
	head->base.set_dither = nv50_crtc_set_dither;
	head->base.set_scale = nv50_crtc_set_scale;
	head->base.set_color_vibrance = nv50_crtc_set_color_vibrance;
1443 1444
	head->base.color_vibrance = 50;
	head->base.vibrant_hue = 0;
1445
	head->base.cursor.set_pos = nv50_crtc_cursor_restore;
1446
	for (i = 0; i < 256; i++) {
1447 1448 1449
		head->base.lut.r[i] = i << 8;
		head->base.lut.g[i] = i << 8;
		head->base.lut.b[i] = i << 8;
1450 1451
	}

1452
	crtc = &head->base.base;
1453 1454
	drm_crtc_init(dev, crtc, &nv50_crtc_func);
	drm_crtc_helper_add(crtc, &nv50_crtc_hfunc);
1455 1456
	drm_mode_crtc_set_gamma_size(crtc, 256);

1457
	ret = nouveau_bo_new(dev, 8192, 0x100, TTM_PL_FLAG_VRAM,
1458
			     0, 0x0000, NULL, NULL, &head->base.lut.nvbo);
1459
	if (!ret) {
1460
		ret = nouveau_bo_pin(head->base.lut.nvbo, TTM_PL_FLAG_VRAM, true);
1461
		if (!ret) {
1462
			ret = nouveau_bo_map(head->base.lut.nvbo);
1463 1464 1465
			if (ret)
				nouveau_bo_unpin(head->base.lut.nvbo);
		}
1466 1467 1468 1469 1470 1471 1472 1473
		if (ret)
			nouveau_bo_ref(NULL, &head->base.lut.nvbo);
	}

	if (ret)
		goto out;

	/* allocate cursor resources */
1474
	ret = nv50_curs_create(device, disp->disp, index, &head->curs);
1475 1476 1477
	if (ret)
		goto out;

1478
	/* allocate page flip / sync resources */
1479 1480
	ret = nv50_base_create(device, disp->disp, index, disp->sync->bo.offset,
			       &head->sync);
1481 1482 1483
	if (ret)
		goto out;

1484 1485
	head->sync.addr = EVO_FLIP_SEM0(index);
	head->sync.data = 0x00000000;
1486

1487
	/* allocate overlay resources */
1488
	ret = nv50_oimm_create(device, disp->disp, index, &head->oimm);
1489 1490 1491
	if (ret)
		goto out;

1492 1493
	ret = nv50_ovly_create(device, disp->disp, index, disp->sync->bo.offset,
			       &head->ovly);
1494 1495
	if (ret)
		goto out;
1496 1497 1498

out:
	if (ret)
1499
		nv50_crtc_destroy(crtc);
1500 1501 1502
	return ret;
}

1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515
/******************************************************************************
 * Encoder helpers
 *****************************************************************************/
static bool
nv50_encoder_mode_fixup(struct drm_encoder *encoder,
			const struct drm_display_mode *mode,
			struct drm_display_mode *adjusted_mode)
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_connector *nv_connector;

	nv_connector = nouveau_encoder_connector_get(nv_encoder);
	if (nv_connector && nv_connector->native_mode) {
1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532
		nv_connector->scaling_full = false;
		if (nv_connector->scaling_mode == DRM_MODE_SCALE_NONE) {
			switch (nv_connector->type) {
			case DCB_CONNECTOR_LVDS:
			case DCB_CONNECTOR_LVDS_SPWG:
			case DCB_CONNECTOR_eDP:
				/* force use of scaler for non-edid modes */
				if (adjusted_mode->type & DRM_MODE_TYPE_DRIVER)
					return true;
				nv_connector->scaling_full = true;
				break;
			default:
				return true;
			}
		}

		drm_mode_copy(adjusted_mode, nv_connector->native_mode);
1533 1534 1535 1536 1537
	}

	return true;
}

1538 1539 1540
/******************************************************************************
 * DAC
 *****************************************************************************/
B
Ben Skeggs 已提交
1541
static void
1542
nv50_dac_dpms(struct drm_encoder *encoder, int mode)
B
Ben Skeggs 已提交
1543 1544
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1545
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_dac_pwr_v0 pwr;
	} args = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_DAC_PWR,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = nv_encoder->dcb->hashm,
		.pwr.state = 1,
		.pwr.data  = 1,
		.pwr.vsync = (mode != DRM_MODE_DPMS_SUSPEND &&
			      mode != DRM_MODE_DPMS_OFF),
		.pwr.hsync = (mode != DRM_MODE_DPMS_STANDBY &&
			      mode != DRM_MODE_DPMS_OFF),
	};
B
Ben Skeggs 已提交
1561

1562
	nvif_mthd(disp->disp, 0, &args, sizeof(args));
B
Ben Skeggs 已提交
1563 1564 1565
}

static void
1566
nv50_dac_commit(struct drm_encoder *encoder)
B
Ben Skeggs 已提交
1567 1568 1569 1570
{
}

static void
1571
nv50_dac_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
B
Ben Skeggs 已提交
1572 1573
		  struct drm_display_mode *adjusted_mode)
{
1574
	struct nv50_mast *mast = nv50_mast(encoder->dev);
B
Ben Skeggs 已提交
1575 1576
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
1577
	u32 *push;
B
Ben Skeggs 已提交
1578

1579
	nv50_dac_dpms(encoder, DRM_MODE_DPMS_ON);
B
Ben Skeggs 已提交
1580

1581
	push = evo_wait(mast, 8);
B
Ben Skeggs 已提交
1582
	if (push) {
1583
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613
			u32 syncs = 0x00000000;

			if (mode->flags & DRM_MODE_FLAG_NHSYNC)
				syncs |= 0x00000001;
			if (mode->flags & DRM_MODE_FLAG_NVSYNC)
				syncs |= 0x00000002;

			evo_mthd(push, 0x0400 + (nv_encoder->or * 0x080), 2);
			evo_data(push, 1 << nv_crtc->index);
			evo_data(push, syncs);
		} else {
			u32 magic = 0x31ec6000 | (nv_crtc->index << 25);
			u32 syncs = 0x00000001;

			if (mode->flags & DRM_MODE_FLAG_NHSYNC)
				syncs |= 0x00000008;
			if (mode->flags & DRM_MODE_FLAG_NVSYNC)
				syncs |= 0x00000010;

			if (mode->flags & DRM_MODE_FLAG_INTERLACE)
				magic |= 0x00000001;

			evo_mthd(push, 0x0404 + (nv_crtc->index * 0x300), 2);
			evo_data(push, syncs);
			evo_data(push, magic);
			evo_mthd(push, 0x0180 + (nv_encoder->or * 0x020), 1);
			evo_data(push, 1 << nv_crtc->index);
		}

		evo_kick(push, mast);
B
Ben Skeggs 已提交
1614 1615 1616 1617 1618 1619
	}

	nv_encoder->crtc = encoder->crtc;
}

static void
1620
nv50_dac_disconnect(struct drm_encoder *encoder)
B
Ben Skeggs 已提交
1621 1622
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1623
	struct nv50_mast *mast = nv50_mast(encoder->dev);
1624
	const int or = nv_encoder->or;
B
Ben Skeggs 已提交
1625 1626 1627
	u32 *push;

	if (nv_encoder->crtc) {
1628
		nv50_crtc_prepare(nv_encoder->crtc);
B
Ben Skeggs 已提交
1629

1630
		push = evo_wait(mast, 4);
B
Ben Skeggs 已提交
1631
		if (push) {
1632
			if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1633 1634 1635 1636 1637 1638 1639
				evo_mthd(push, 0x0400 + (or * 0x080), 1);
				evo_data(push, 0x00000000);
			} else {
				evo_mthd(push, 0x0180 + (or * 0x020), 1);
				evo_data(push, 0x00000000);
			}
			evo_kick(push, mast);
B
Ben Skeggs 已提交
1640 1641
		}
	}
1642 1643

	nv_encoder->crtc = NULL;
B
Ben Skeggs 已提交
1644 1645
}

1646
static enum drm_connector_status
1647
nv50_dac_detect(struct drm_encoder *encoder, struct drm_connector *connector)
1648
{
1649
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1650
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_dac_load_v0 load;
	} args = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_DAC_LOAD,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = nv_encoder->dcb->hashm,
	};
	int ret;

	args.load.data = nouveau_drm(encoder->dev)->vbios.dactestval;
	if (args.load.data == 0)
		args.load.data = 340;
B
Ben Skeggs 已提交
1665

1666 1667
	ret = nvif_mthd(disp->disp, 0, &args, sizeof(args));
	if (ret || !args.load.load)
1668
		return connector_status_disconnected;
B
Ben Skeggs 已提交
1669

1670
	return connector_status_connected;
1671 1672
}

B
Ben Skeggs 已提交
1673
static void
1674
nv50_dac_destroy(struct drm_encoder *encoder)
B
Ben Skeggs 已提交
1675 1676 1677 1678 1679
{
	drm_encoder_cleanup(encoder);
	kfree(encoder);
}

1680 1681
static const struct drm_encoder_helper_funcs nv50_dac_hfunc = {
	.dpms = nv50_dac_dpms,
1682
	.mode_fixup = nv50_encoder_mode_fixup,
1683 1684 1685 1686 1687 1688
	.prepare = nv50_dac_disconnect,
	.commit = nv50_dac_commit,
	.mode_set = nv50_dac_mode_set,
	.disable = nv50_dac_disconnect,
	.get_crtc = nv50_display_crtc_get,
	.detect = nv50_dac_detect
B
Ben Skeggs 已提交
1689 1690
};

1691 1692
static const struct drm_encoder_funcs nv50_dac_func = {
	.destroy = nv50_dac_destroy,
B
Ben Skeggs 已提交
1693 1694 1695
};

static int
1696
nv50_dac_create(struct drm_connector *connector, struct dcb_output *dcbe)
B
Ben Skeggs 已提交
1697
{
1698
	struct nouveau_drm *drm = nouveau_drm(connector->dev);
1699
	struct nvkm_i2c *i2c = nvxx_i2c(&drm->device);
1700
	struct nvkm_i2c_bus *bus;
B
Ben Skeggs 已提交
1701 1702
	struct nouveau_encoder *nv_encoder;
	struct drm_encoder *encoder;
1703
	int type = DRM_MODE_ENCODER_DAC;
B
Ben Skeggs 已提交
1704 1705 1706 1707 1708 1709

	nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL);
	if (!nv_encoder)
		return -ENOMEM;
	nv_encoder->dcb = dcbe;
	nv_encoder->or = ffs(dcbe->or) - 1;
1710 1711 1712 1713

	bus = nvkm_i2c_bus_find(i2c, dcbe->i2c_index);
	if (bus)
		nv_encoder->i2c = &bus->i2c;
B
Ben Skeggs 已提交
1714 1715 1716 1717

	encoder = to_drm_encoder(nv_encoder);
	encoder->possible_crtcs = dcbe->heads;
	encoder->possible_clones = 0;
1718
	drm_encoder_init(connector->dev, encoder, &nv50_dac_func, type);
1719
	drm_encoder_helper_add(encoder, &nv50_dac_hfunc);
B
Ben Skeggs 已提交
1720 1721 1722 1723

	drm_mode_connector_attach_encoder(connector, encoder);
	return 0;
}
1724

1725 1726 1727 1728
/******************************************************************************
 * Audio
 *****************************************************************************/
static void
1729
nv50_audio_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode)
1730 1731
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
B
Ben Skeggs 已提交
1732
	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
1733
	struct nouveau_connector *nv_connector;
1734
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1735 1736 1737 1738 1739
	struct __packed {
		struct {
			struct nv50_disp_mthd_v1 mthd;
			struct nv50_disp_sor_hda_eld_v0 eld;
		} base;
1740 1741
		u8 data[sizeof(nv_connector->base.eld)];
	} args = {
1742 1743 1744
		.base.mthd.version = 1,
		.base.mthd.method  = NV50_DISP_MTHD_V1_SOR_HDA_ELD,
		.base.mthd.hasht   = nv_encoder->dcb->hasht,
B
Ben Skeggs 已提交
1745 1746
		.base.mthd.hashm   = (0xf0ff & nv_encoder->dcb->hashm) |
				     (0x0100 << nv_crtc->index),
1747
	};
1748 1749 1750 1751 1752 1753

	nv_connector = nouveau_encoder_connector_get(nv_encoder);
	if (!drm_detect_monitor_audio(nv_connector->edid))
		return;

	drm_edid_to_eld(&nv_connector->base, nv_connector->edid);
1754
	memcpy(args.data, nv_connector->base.eld, sizeof(args.data));
1755

1756 1757
	nvif_mthd(disp->disp, 0, &args,
		  sizeof(args.base) + drm_eld_size(args.data));
1758 1759 1760
}

static void
B
Ben Skeggs 已提交
1761
nv50_audio_disconnect(struct drm_encoder *encoder, struct nouveau_crtc *nv_crtc)
1762 1763
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1764
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1765 1766 1767 1768 1769 1770 1771
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_sor_hda_eld_v0 eld;
	} args = {
		.base.version = 1,
		.base.method  = NV50_DISP_MTHD_V1_SOR_HDA_ELD,
		.base.hasht   = nv_encoder->dcb->hasht,
B
Ben Skeggs 已提交
1772 1773
		.base.hashm   = (0xf0ff & nv_encoder->dcb->hashm) |
				(0x0100 << nv_crtc->index),
1774
	};
1775

1776
	nvif_mthd(disp->disp, 0, &args, sizeof(args));
1777 1778 1779 1780 1781 1782
}

/******************************************************************************
 * HDMI
 *****************************************************************************/
static void
1783
nv50_hdmi_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode)
1784
{
1785 1786
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
1787
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_sor_hdmi_pwr_v0 pwr;
	} args = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_SOR_HDMI_PWR,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = (0xf0ff & nv_encoder->dcb->hashm) |
			       (0x0100 << nv_crtc->index),
		.pwr.state = 1,
		.pwr.rekey = 56, /* binary driver, and tegra, constant */
	};
	struct nouveau_connector *nv_connector;
1801 1802 1803 1804 1805 1806 1807
	u32 max_ac_packet;

	nv_connector = nouveau_encoder_connector_get(nv_encoder);
	if (!drm_detect_hdmi_monitor(nv_connector->edid))
		return;

	max_ac_packet  = mode->htotal - mode->hdisplay;
1808
	max_ac_packet -= args.pwr.rekey;
1809
	max_ac_packet -= 18; /* constant from tegra */
1810
	args.pwr.max_ac_packet = max_ac_packet / 32;
B
Ben Skeggs 已提交
1811

1812
	nvif_mthd(disp->disp, 0, &args, sizeof(args));
1813
	nv50_audio_mode_set(encoder, mode);
1814 1815 1816
}

static void
1817
nv50_hdmi_disconnect(struct drm_encoder *encoder, struct nouveau_crtc *nv_crtc)
1818
{
1819
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1820
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1821 1822 1823 1824 1825 1826 1827 1828 1829 1830
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_sor_hdmi_pwr_v0 pwr;
	} args = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_SOR_HDMI_PWR,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = (0xf0ff & nv_encoder->dcb->hashm) |
			       (0x0100 << nv_crtc->index),
	};
1831

1832
	nvif_mthd(disp->disp, 0, &args, sizeof(args));
1833 1834
}

1835 1836 1837
/******************************************************************************
 * SOR
 *****************************************************************************/
1838
static void
1839
nv50_sor_dpms(struct drm_encoder *encoder, int mode)
1840 1841
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852
	struct nv50_disp *disp = nv50_disp(encoder->dev);
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_sor_pwr_v0 pwr;
	} args = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_SOR_PWR,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = nv_encoder->dcb->hashm,
		.pwr.state = mode == DRM_MODE_DPMS_ON,
	};
1853 1854 1855 1856 1857 1858 1859 1860 1861 1862
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_sor_dp_pwr_v0 pwr;
	} link = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_SOR_DP_PWR,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = nv_encoder->dcb->hashm,
		.pwr.state = mode == DRM_MODE_DPMS_ON,
	};
1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874
	struct drm_device *dev = encoder->dev;
	struct drm_encoder *partner;

	nv_encoder->last_dpms = mode;

	list_for_each_entry(partner, &dev->mode_config.encoder_list, head) {
		struct nouveau_encoder *nv_partner = nouveau_encoder(partner);

		if (partner->encoder_type != DRM_MODE_ENCODER_TMDS)
			continue;

		if (nv_partner != nv_encoder &&
1875
		    nv_partner->dcb->or == nv_encoder->dcb->or) {
1876 1877 1878 1879 1880 1881
			if (nv_partner->last_dpms == DRM_MODE_DPMS_ON)
				return;
			break;
		}
	}

1882
	if (nv_encoder->dcb->type == DCB_OUTPUT_DP) {
1883 1884
		args.pwr.state = 1;
		nvif_mthd(disp->disp, 0, &args, sizeof(args));
1885
		nvif_mthd(disp->disp, 0, &link, sizeof(link));
1886
	} else {
1887
		nvif_mthd(disp->disp, 0, &args, sizeof(args));
1888
	}
1889 1890
}

1891
static void
1892
nv50_sor_ctrl(struct nouveau_encoder *nv_encoder, u32 mask, u32 data)
1893
{
1894 1895 1896
	struct nv50_mast *mast = nv50_mast(nv_encoder->base.base.dev);
	u32 temp = (nv_encoder->ctrl & ~mask) | (data & mask), *push;
	if (temp != nv_encoder->ctrl && (push = evo_wait(mast, 2))) {
1897
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1898 1899 1900 1901 1902
			evo_mthd(push, 0x0600 + (nv_encoder->or * 0x40), 1);
			evo_data(push, (nv_encoder->ctrl = temp));
		} else {
			evo_mthd(push, 0x0200 + (nv_encoder->or * 0x20), 1);
			evo_data(push, (nv_encoder->ctrl = temp));
1903
		}
1904
		evo_kick(push, mast);
1905
	}
1906 1907 1908 1909 1910 1911 1912
}

static void
nv50_sor_disconnect(struct drm_encoder *encoder)
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(nv_encoder->crtc);
1913 1914 1915

	nv_encoder->last_dpms = DRM_MODE_DPMS_OFF;
	nv_encoder->crtc = NULL;
1916 1917 1918 1919

	if (nv_crtc) {
		nv50_crtc_prepare(&nv_crtc->base);
		nv50_sor_ctrl(nv_encoder, 1 << nv_crtc->index, 0);
B
Ben Skeggs 已提交
1920
		nv50_audio_disconnect(encoder, nv_crtc);
1921 1922
		nv50_hdmi_disconnect(&nv_encoder->base.base, nv_crtc);
	}
1923 1924
}

1925
static void
1926
nv50_sor_commit(struct drm_encoder *encoder)
1927 1928 1929 1930
{
}

static void
1931
nv50_sor_mode_set(struct drm_encoder *encoder, struct drm_display_mode *umode,
1932
		  struct drm_display_mode *mode)
1933
{
1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_sor_lvds_script_v0 lvds;
	} lvds = {
		.base.version = 1,
		.base.method  = NV50_DISP_MTHD_V1_SOR_LVDS_SCRIPT,
		.base.hasht   = nv_encoder->dcb->hasht,
		.base.hashm   = nv_encoder->dcb->hashm,
	};
1945 1946
	struct nv50_disp *disp = nv50_disp(encoder->dev);
	struct nv50_mast *mast = nv50_mast(encoder->dev);
1947
	struct drm_device *dev = encoder->dev;
1948
	struct nouveau_drm *drm = nouveau_drm(dev);
1949
	struct nouveau_connector *nv_connector;
1950
	struct nvbios *bios = &drm->vbios;
1951
	u32 mask, ctrl;
1952 1953 1954
	u8 owner = 1 << nv_crtc->index;
	u8 proto = 0xf;
	u8 depth = 0x0;
1955

1956
	nv_connector = nouveau_encoder_connector_get(nv_encoder);
1957 1958
	nv_encoder->crtc = encoder->crtc;

1959
	switch (nv_encoder->dcb->type) {
1960
	case DCB_OUTPUT_TMDS:
1961 1962
		if (nv_encoder->dcb->sorconf.link & 1) {
			if (mode->clock < 165000)
1963
				proto = 0x1;
1964
			else
1965
				proto = 0x5;
1966
		} else {
1967
			proto = 0x2;
1968 1969
		}

1970
		nv50_hdmi_mode_set(&nv_encoder->base.base, mode);
1971
		break;
1972
	case DCB_OUTPUT_LVDS:
1973 1974
		proto = 0x0;

1975 1976
		if (bios->fp_no_ddc) {
			if (bios->fp.dual_link)
1977
				lvds.lvds.script |= 0x0100;
1978
			if (bios->fp.if_is_24bit)
1979
				lvds.lvds.script |= 0x0200;
1980
		} else {
1981
			if (nv_connector->type == DCB_CONNECTOR_LVDS_SPWG) {
1982
				if (((u8 *)nv_connector->edid)[121] == 2)
1983
					lvds.lvds.script |= 0x0100;
1984 1985
			} else
			if (mode->clock >= bios->fp.duallink_transition_clk) {
1986
				lvds.lvds.script |= 0x0100;
1987
			}
1988

1989
			if (lvds.lvds.script & 0x0100) {
1990
				if (bios->fp.strapless_is_24bit & 2)
1991
					lvds.lvds.script |= 0x0200;
1992 1993
			} else {
				if (bios->fp.strapless_is_24bit & 1)
1994
					lvds.lvds.script |= 0x0200;
1995 1996 1997
			}

			if (nv_connector->base.display_info.bpc == 8)
1998
				lvds.lvds.script |= 0x0200;
1999
		}
2000

2001
		nvif_mthd(disp->disp, 0, &lvds, sizeof(lvds));
2002
		break;
2003
	case DCB_OUTPUT_DP:
2004
		if (nv_connector->base.display_info.bpc == 6) {
2005
			nv_encoder->dp.datarate = mode->clock * 18 / 8;
2006
			depth = 0x2;
2007 2008
		} else
		if (nv_connector->base.display_info.bpc == 8) {
2009
			nv_encoder->dp.datarate = mode->clock * 24 / 8;
2010
			depth = 0x5;
2011 2012 2013
		} else {
			nv_encoder->dp.datarate = mode->clock * 30 / 8;
			depth = 0x6;
2014
		}
2015 2016

		if (nv_encoder->dcb->sorconf.link & 1)
2017
			proto = 0x8;
2018
		else
2019
			proto = 0x9;
2020
		nv50_audio_mode_set(encoder, mode);
2021
		break;
2022 2023 2024 2025
	default:
		BUG_ON(1);
		break;
	}
2026

2027
	nv50_sor_dpms(&nv_encoder->base.base, DRM_MODE_DPMS_ON);
2028

2029
	if (nv50_vers(mast) >= GF110_DISP) {
2030 2031
		u32 *push = evo_wait(mast, 3);
		if (push) {
2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045
			u32 magic = 0x31ec6000 | (nv_crtc->index << 25);
			u32 syncs = 0x00000001;

			if (mode->flags & DRM_MODE_FLAG_NHSYNC)
				syncs |= 0x00000008;
			if (mode->flags & DRM_MODE_FLAG_NVSYNC)
				syncs |= 0x00000010;

			if (mode->flags & DRM_MODE_FLAG_INTERLACE)
				magic |= 0x00000001;

			evo_mthd(push, 0x0404 + (nv_crtc->index * 0x300), 2);
			evo_data(push, syncs | (depth << 6));
			evo_data(push, magic);
2046
			evo_kick(push, mast);
2047 2048
		}

2049 2050 2051 2052 2053 2054 2055 2056 2057
		ctrl = proto << 8;
		mask = 0x00000f00;
	} else {
		ctrl = (depth << 16) | (proto << 8);
		if (mode->flags & DRM_MODE_FLAG_NHSYNC)
			ctrl |= 0x00001000;
		if (mode->flags & DRM_MODE_FLAG_NVSYNC)
			ctrl |= 0x00002000;
		mask = 0x000f3f00;
2058 2059
	}

2060
	nv50_sor_ctrl(nv_encoder, mask | owner, ctrl | owner);
2061 2062 2063
}

static void
2064
nv50_sor_destroy(struct drm_encoder *encoder)
2065 2066 2067 2068 2069
{
	drm_encoder_cleanup(encoder);
	kfree(encoder);
}

2070 2071
static const struct drm_encoder_helper_funcs nv50_sor_hfunc = {
	.dpms = nv50_sor_dpms,
2072
	.mode_fixup = nv50_encoder_mode_fixup,
2073
	.prepare = nv50_sor_disconnect,
2074 2075 2076 2077
	.commit = nv50_sor_commit,
	.mode_set = nv50_sor_mode_set,
	.disable = nv50_sor_disconnect,
	.get_crtc = nv50_display_crtc_get,
2078 2079
};

2080 2081
static const struct drm_encoder_funcs nv50_sor_func = {
	.destroy = nv50_sor_destroy,
2082 2083 2084
};

static int
2085
nv50_sor_create(struct drm_connector *connector, struct dcb_output *dcbe)
2086
{
2087
	struct nouveau_drm *drm = nouveau_drm(connector->dev);
2088
	struct nvkm_i2c *i2c = nvxx_i2c(&drm->device);
2089 2090
	struct nouveau_encoder *nv_encoder;
	struct drm_encoder *encoder;
2091 2092 2093 2094 2095 2096 2097 2098 2099 2100
	int type;

	switch (dcbe->type) {
	case DCB_OUTPUT_LVDS: type = DRM_MODE_ENCODER_LVDS; break;
	case DCB_OUTPUT_TMDS:
	case DCB_OUTPUT_DP:
	default:
		type = DRM_MODE_ENCODER_TMDS;
		break;
	}
2101 2102 2103 2104 2105 2106 2107 2108

	nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL);
	if (!nv_encoder)
		return -ENOMEM;
	nv_encoder->dcb = dcbe;
	nv_encoder->or = ffs(dcbe->or) - 1;
	nv_encoder->last_dpms = DRM_MODE_DPMS_OFF;

2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122
	if (dcbe->type == DCB_OUTPUT_DP) {
		struct nvkm_i2c_aux *aux =
			nvkm_i2c_aux_find(i2c, dcbe->i2c_index);
		if (aux) {
			nv_encoder->i2c = &aux->i2c;
			nv_encoder->aux = aux;
		}
	} else {
		struct nvkm_i2c_bus *bus =
			nvkm_i2c_bus_find(i2c, dcbe->i2c_index);
		if (bus)
			nv_encoder->i2c = &bus->i2c;
	}

2123 2124 2125
	encoder = to_drm_encoder(nv_encoder);
	encoder->possible_crtcs = dcbe->heads;
	encoder->possible_clones = 0;
2126
	drm_encoder_init(connector->dev, encoder, &nv50_sor_func, type);
2127
	drm_encoder_helper_add(encoder, &nv50_sor_hfunc);
2128 2129 2130 2131

	drm_mode_connector_attach_encoder(connector, encoder);
	return 0;
}
2132

2133 2134 2135 2136 2137 2138 2139 2140 2141
/******************************************************************************
 * PIOR
 *****************************************************************************/

static void
nv50_pior_dpms(struct drm_encoder *encoder, int mode)
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nv50_disp *disp = nv50_disp(encoder->dev);
2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154
	struct {
		struct nv50_disp_mthd_v1 base;
		struct nv50_disp_pior_pwr_v0 pwr;
	} args = {
		.base.version = 1,
		.base.method = NV50_DISP_MTHD_V1_PIOR_PWR,
		.base.hasht  = nv_encoder->dcb->hasht,
		.base.hashm  = nv_encoder->dcb->hashm,
		.pwr.state = mode == DRM_MODE_DPMS_ON,
		.pwr.type = nv_encoder->dcb->type,
	};

	nvif_mthd(disp->disp, 0, &args, sizeof(args));
2155 2156 2157 2158 2159 2160 2161
}

static bool
nv50_pior_mode_fixup(struct drm_encoder *encoder,
		     const struct drm_display_mode *mode,
		     struct drm_display_mode *adjusted_mode)
{
2162 2163
	if (!nv50_encoder_mode_fixup(encoder, mode, adjusted_mode))
		return false;
2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206
	adjusted_mode->clock *= 2;
	return true;
}

static void
nv50_pior_commit(struct drm_encoder *encoder)
{
}

static void
nv50_pior_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
		   struct drm_display_mode *adjusted_mode)
{
	struct nv50_mast *mast = nv50_mast(encoder->dev);
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
	struct nouveau_connector *nv_connector;
	u8 owner = 1 << nv_crtc->index;
	u8 proto, depth;
	u32 *push;

	nv_connector = nouveau_encoder_connector_get(nv_encoder);
	switch (nv_connector->base.display_info.bpc) {
	case 10: depth = 0x6; break;
	case  8: depth = 0x5; break;
	case  6: depth = 0x2; break;
	default: depth = 0x0; break;
	}

	switch (nv_encoder->dcb->type) {
	case DCB_OUTPUT_TMDS:
	case DCB_OUTPUT_DP:
		proto = 0x0;
		break;
	default:
		BUG_ON(1);
		break;
	}

	nv50_pior_dpms(encoder, DRM_MODE_DPMS_ON);

	push = evo_wait(mast, 8);
	if (push) {
2207
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235
			u32 ctrl = (depth << 16) | (proto << 8) | owner;
			if (mode->flags & DRM_MODE_FLAG_NHSYNC)
				ctrl |= 0x00001000;
			if (mode->flags & DRM_MODE_FLAG_NVSYNC)
				ctrl |= 0x00002000;
			evo_mthd(push, 0x0700 + (nv_encoder->or * 0x040), 1);
			evo_data(push, ctrl);
		}

		evo_kick(push, mast);
	}

	nv_encoder->crtc = encoder->crtc;
}

static void
nv50_pior_disconnect(struct drm_encoder *encoder)
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nv50_mast *mast = nv50_mast(encoder->dev);
	const int or = nv_encoder->or;
	u32 *push;

	if (nv_encoder->crtc) {
		nv50_crtc_prepare(nv_encoder->crtc);

		push = evo_wait(mast, 4);
		if (push) {
2236
			if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271
				evo_mthd(push, 0x0700 + (or * 0x040), 1);
				evo_data(push, 0x00000000);
			}
			evo_kick(push, mast);
		}
	}

	nv_encoder->crtc = NULL;
}

static void
nv50_pior_destroy(struct drm_encoder *encoder)
{
	drm_encoder_cleanup(encoder);
	kfree(encoder);
}

static const struct drm_encoder_helper_funcs nv50_pior_hfunc = {
	.dpms = nv50_pior_dpms,
	.mode_fixup = nv50_pior_mode_fixup,
	.prepare = nv50_pior_disconnect,
	.commit = nv50_pior_commit,
	.mode_set = nv50_pior_mode_set,
	.disable = nv50_pior_disconnect,
	.get_crtc = nv50_display_crtc_get,
};

static const struct drm_encoder_funcs nv50_pior_func = {
	.destroy = nv50_pior_destroy,
};

static int
nv50_pior_create(struct drm_connector *connector, struct dcb_output *dcbe)
{
	struct nouveau_drm *drm = nouveau_drm(connector->dev);
2272
	struct nvkm_i2c *i2c = nvxx_i2c(&drm->device);
2273 2274 2275
	struct nvkm_i2c_bus *bus = NULL;
	struct nvkm_i2c_aux *aux = NULL;
	struct i2c_adapter *ddc;
2276 2277 2278 2279 2280 2281
	struct nouveau_encoder *nv_encoder;
	struct drm_encoder *encoder;
	int type;

	switch (dcbe->type) {
	case DCB_OUTPUT_TMDS:
2282 2283
		bus  = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_EXT(dcbe->extdev));
		ddc  = bus ? &bus->i2c : NULL;
2284 2285 2286
		type = DRM_MODE_ENCODER_TMDS;
		break;
	case DCB_OUTPUT_DP:
2287 2288
		aux  = nvkm_i2c_aux_find(i2c, NVKM_I2C_AUX_EXT(dcbe->extdev));
		ddc  = aux ? &aux->i2c : NULL;
2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300
		type = DRM_MODE_ENCODER_TMDS;
		break;
	default:
		return -ENODEV;
	}

	nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL);
	if (!nv_encoder)
		return -ENOMEM;
	nv_encoder->dcb = dcbe;
	nv_encoder->or = ffs(dcbe->or) - 1;
	nv_encoder->i2c = ddc;
2301
	nv_encoder->aux = aux;
2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312

	encoder = to_drm_encoder(nv_encoder);
	encoder->possible_crtcs = dcbe->heads;
	encoder->possible_clones = 0;
	drm_encoder_init(connector->dev, encoder, &nv50_pior_func, type);
	drm_encoder_helper_add(encoder, &nv50_pior_hfunc);

	drm_mode_connector_attach_encoder(connector, encoder);
	return 0;
}

2313 2314 2315 2316
/******************************************************************************
 * Framebuffer
 *****************************************************************************/

2317
static void
2318
nv50_fbdma_fini(struct nv50_fbdma *fbdma)
2319
{
2320 2321 2322 2323
	int i;
	for (i = 0; i < ARRAY_SIZE(fbdma->base); i++)
		nvif_object_fini(&fbdma->base[i]);
	nvif_object_fini(&fbdma->core);
2324 2325 2326 2327 2328 2329 2330 2331 2332 2333
	list_del(&fbdma->head);
	kfree(fbdma);
}

static int
nv50_fbdma_init(struct drm_device *dev, u32 name, u64 offset, u64 length, u8 kind)
{
	struct nouveau_drm *drm = nouveau_drm(dev);
	struct nv50_disp *disp = nv50_disp(dev);
	struct nv50_mast *mast = nv50_mast(dev);
2334 2335 2336 2337 2338 2339 2340 2341
	struct __attribute__ ((packed)) {
		struct nv_dma_v0 base;
		union {
			struct nv50_dma_v0 nv50;
			struct gf100_dma_v0 gf100;
			struct gf110_dma_v0 gf110;
		};
	} args = {};
2342 2343
	struct nv50_fbdma *fbdma;
	struct drm_crtc *crtc;
2344
	u32 size = sizeof(args.base);
2345 2346 2347
	int ret;

	list_for_each_entry(fbdma, &disp->fbdma, head) {
2348
		if (fbdma->core.handle == name)
2349 2350 2351 2352 2353 2354 2355 2356
			return 0;
	}

	fbdma = kzalloc(sizeof(*fbdma), GFP_KERNEL);
	if (!fbdma)
		return -ENOMEM;
	list_add(&fbdma->head, &disp->fbdma);

2357 2358 2359 2360
	args.base.target = NV_DMA_V0_TARGET_VRAM;
	args.base.access = NV_DMA_V0_ACCESS_RDWR;
	args.base.start = offset;
	args.base.limit = offset + length - 1;
2361

2362
	if (drm->device.info.chipset < 0x80) {
2363 2364
		args.nv50.part = NV50_DMA_V0_PART_256;
		size += sizeof(args.nv50);
2365
	} else
2366
	if (drm->device.info.chipset < 0xc0) {
2367 2368 2369
		args.nv50.part = NV50_DMA_V0_PART_256;
		args.nv50.kind = kind;
		size += sizeof(args.nv50);
2370
	} else
2371
	if (drm->device.info.chipset < 0xd0) {
2372 2373
		args.gf100.kind = kind;
		size += sizeof(args.gf100);
2374
	} else {
2375 2376 2377
		args.gf110.page = GF110_DMA_V0_PAGE_LP;
		args.gf110.kind = kind;
		size += sizeof(args.gf110);
2378 2379 2380
	}

	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
2381
		struct nv50_head *head = nv50_head(crtc);
2382 2383
		int ret = nvif_object_init(&head->sync.base.base.user, name,
					   NV_DMA_IN_MEMORY, &args, size,
2384
					   &fbdma->base[head->base.index]);
2385
		if (ret) {
2386
			nv50_fbdma_fini(fbdma);
2387 2388 2389 2390
			return ret;
		}
	}

2391 2392
	ret = nvif_object_init(&mast->base.base.user, name, NV_DMA_IN_MEMORY,
			       &args, size, &fbdma->core);
2393
	if (ret) {
2394
		nv50_fbdma_fini(fbdma);
2395 2396 2397 2398 2399 2400
		return ret;
	}

	return 0;
}

2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411
static void
nv50_fb_dtor(struct drm_framebuffer *fb)
{
}

static int
nv50_fb_ctor(struct drm_framebuffer *fb)
{
	struct nouveau_framebuffer *nv_fb = nouveau_framebuffer(fb);
	struct nouveau_drm *drm = nouveau_drm(fb->dev);
	struct nouveau_bo *nvbo = nv_fb->nvbo;
2412 2413 2414
	struct nv50_disp *disp = nv50_disp(fb->dev);
	u8 kind = nouveau_bo_tile_layout(nvbo) >> 8;
	u8 tile = nvbo->tile_mode;
2415

2416
	if (drm->device.info.chipset >= 0xc0)
2417 2418
		tile >>= 4; /* yep.. */

2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430
	switch (fb->depth) {
	case  8: nv_fb->r_format = 0x1e00; break;
	case 15: nv_fb->r_format = 0xe900; break;
	case 16: nv_fb->r_format = 0xe800; break;
	case 24:
	case 32: nv_fb->r_format = 0xcf00; break;
	case 30: nv_fb->r_format = 0xd100; break;
	default:
		 NV_ERROR(drm, "unknown depth %d\n", fb->depth);
		 return -EINVAL;
	}

2431
	if (disp->disp->oclass < G82_DISP) {
2432 2433 2434 2435
		nv_fb->r_pitch   = kind ? (((fb->pitches[0] / 4) << 4) | tile) :
					    (fb->pitches[0] | 0x00100000);
		nv_fb->r_format |= kind << 16;
	} else
2436
	if (disp->disp->oclass < GF110_DISP) {
2437 2438
		nv_fb->r_pitch  = kind ? (((fb->pitches[0] / 4) << 4) | tile) :
					   (fb->pitches[0] | 0x00100000);
2439
	} else {
2440 2441
		nv_fb->r_pitch  = kind ? (((fb->pitches[0] / 4) << 4) | tile) :
					   (fb->pitches[0] | 0x01000000);
2442
	}
2443
	nv_fb->r_handle = 0xffff0000 | kind;
2444

2445 2446
	return nv50_fbdma_init(fb->dev, nv_fb->r_handle, 0,
			       drm->device.info.ram_user, kind);
2447 2448
}

2449 2450 2451
/******************************************************************************
 * Init
 *****************************************************************************/
2452

2453
void
2454
nv50_display_fini(struct drm_device *dev)
2455 2456 2457 2458
{
}

int
2459
nv50_display_init(struct drm_device *dev)
2460
{
2461 2462 2463 2464 2465 2466 2467 2468 2469 2470
	struct nv50_disp *disp = nv50_disp(dev);
	struct drm_crtc *crtc;
	u32 *push;

	push = evo_wait(nv50_mast(dev), 32);
	if (!push)
		return -EBUSY;

	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
		struct nv50_sync *sync = nv50_sync(crtc);
2471 2472

		nv50_crtc_lut_load(crtc);
2473
		nouveau_bo_wr32(disp->sync, sync->addr / 4, sync->data);
2474
	}
2475

2476
	evo_mthd(push, 0x0088, 1);
2477
	evo_data(push, nv50_mast(dev)->base.sync.handle);
2478 2479
	evo_kick(push, nv50_mast(dev));
	return 0;
2480 2481 2482
}

void
2483
nv50_display_destroy(struct drm_device *dev)
2484
{
2485
	struct nv50_disp *disp = nv50_disp(dev);
2486 2487 2488
	struct nv50_fbdma *fbdma, *fbtmp;

	list_for_each_entry_safe(fbdma, fbtmp, &disp->fbdma, head) {
2489
		nv50_fbdma_fini(fbdma);
2490
	}
2491

2492
	nv50_dmac_destroy(&disp->mast.base, disp->disp);
2493

2494
	nouveau_bo_unmap(disp->sync);
2495 2496
	if (disp->sync)
		nouveau_bo_unpin(disp->sync);
2497
	nouveau_bo_ref(NULL, &disp->sync);
2498

2499
	nouveau_display(dev)->priv = NULL;
2500 2501 2502 2503
	kfree(disp);
}

int
2504
nv50_display_create(struct drm_device *dev)
2505
{
2506
	struct nvif_device *device = &nouveau_drm(dev)->device;
2507 2508
	struct nouveau_drm *drm = nouveau_drm(dev);
	struct dcb_table *dcb = &drm->vbios.dcb;
2509
	struct drm_connector *connector, *tmp;
2510
	struct nv50_disp *disp;
2511
	struct dcb_output *dcbe;
2512
	int crtcs, ret, i;
2513 2514 2515 2516

	disp = kzalloc(sizeof(*disp), GFP_KERNEL);
	if (!disp)
		return -ENOMEM;
2517
	INIT_LIST_HEAD(&disp->fbdma);
2518 2519

	nouveau_display(dev)->priv = disp;
2520 2521 2522
	nouveau_display(dev)->dtor = nv50_display_destroy;
	nouveau_display(dev)->init = nv50_display_init;
	nouveau_display(dev)->fini = nv50_display_fini;
2523 2524
	nouveau_display(dev)->fb_ctor = nv50_fb_ctor;
	nouveau_display(dev)->fb_dtor = nv50_fb_dtor;
2525
	disp->disp = &nouveau_display(dev)->disp;
2526

2527 2528
	/* small shared memory area we use for notifiers and semaphores */
	ret = nouveau_bo_new(dev, 4096, 0x1000, TTM_PL_FLAG_VRAM,
2529
			     0, 0x0000, NULL, NULL, &disp->sync);
2530
	if (!ret) {
2531
		ret = nouveau_bo_pin(disp->sync, TTM_PL_FLAG_VRAM, true);
2532
		if (!ret) {
2533
			ret = nouveau_bo_map(disp->sync);
2534 2535 2536
			if (ret)
				nouveau_bo_unpin(disp->sync);
		}
2537 2538 2539 2540 2541 2542 2543 2544
		if (ret)
			nouveau_bo_ref(NULL, &disp->sync);
	}

	if (ret)
		goto out;

	/* allocate master evo channel */
2545
	ret = nv50_core_create(device, disp->disp, disp->sync->bo.offset,
2546
			      &disp->mast);
2547 2548 2549
	if (ret)
		goto out;

2550
	/* create crtc objects to represent the hw heads */
2551
	if (disp->disp->oclass >= GF110_DISP)
2552
		crtcs = nvif_rd32(&device->object, 0x022448);
2553 2554 2555
	else
		crtcs = 2;

2556
	for (i = 0; i < crtcs; i++) {
2557
		ret = nv50_crtc_create(dev, i);
2558 2559 2560 2561
		if (ret)
			goto out;
	}

2562 2563 2564 2565 2566 2567
	/* create encoder/connector objects based on VBIOS DCB table */
	for (i = 0, dcbe = &dcb->entry[0]; i < dcb->entries; i++, dcbe++) {
		connector = nouveau_connector_create(dev, dcbe->connector);
		if (IS_ERR(connector))
			continue;

2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583
		if (dcbe->location == DCB_LOC_ON_CHIP) {
			switch (dcbe->type) {
			case DCB_OUTPUT_TMDS:
			case DCB_OUTPUT_LVDS:
			case DCB_OUTPUT_DP:
				ret = nv50_sor_create(connector, dcbe);
				break;
			case DCB_OUTPUT_ANALOG:
				ret = nv50_dac_create(connector, dcbe);
				break;
			default:
				ret = -ENODEV;
				break;
			}
		} else {
			ret = nv50_pior_create(connector, dcbe);
2584 2585
		}

2586 2587 2588 2589
		if (ret) {
			NV_WARN(drm, "failed to create encoder %d/%d/%d: %d\n",
				     dcbe->location, dcbe->type,
				     ffs(dcbe->or) - 1, ret);
2590
			ret = 0;
2591 2592 2593 2594 2595 2596 2597 2598
		}
	}

	/* cull any connectors we created that don't have an encoder */
	list_for_each_entry_safe(connector, tmp, &dev->mode_config.connector_list, head) {
		if (connector->encoder_ids[0])
			continue;

2599
		NV_WARN(drm, "%s has no encoders, removing\n",
2600
			connector->name);
2601 2602 2603
		connector->funcs->destroy(connector);
	}

2604 2605
out:
	if (ret)
2606
		nv50_display_destroy(dev);
2607 2608
	return ret;
}