nv50_display.c 70.3 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
#include <drm/drm_fb_helper.h>
32

33 34
#include <nvif/class.h>

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

44 45
#define EVO_DMA_NR 9

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

52 53
/* offsets in shared sync bo of various structures */
#define EVO_SYNC(c, o) ((c) * 0x0100 + (o))
54 55 56
#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)
57

58 59 60 61
/******************************************************************************
 * EVO channel
 *****************************************************************************/

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

static int
68
nv50_chan_create(struct nvif_device *device, struct nvif_object *disp,
69
		 const s32 *oclass, u8 head, void *data, u32 size,
70
		 struct nv50_chan *chan)
71
{
72 73
	struct nvif_sclass *sclass;
	int ret, i, n;
74

75 76
	chan->device = device;

77
	ret = n = nvif_object_sclass_get(disp, &sclass);
78 79 80
	if (ret < 0)
		return ret;

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

95
	nvif_object_sclass_put(&sclass);
96
	return -ENOSYS;
97 98 99
}

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

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

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

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

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

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

struct nv50_curs {
	struct nv50_pioc base;
};

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

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

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

struct nv50_oimm {
	struct nv50_pioc base;
};

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

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

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

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

193 194 195
	struct nvif_object sync;
	struct nvif_object vram;

196 197 198 199
	/* 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;
200 201 202
};

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

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

	nv50_chan_destroy(&dmac->base);

212
	if (dmac->ptr) {
213 214
		struct device *dev = nvxx_device(device)->dev;
		dma_free_coherent(dev, PAGE_SIZE, dmac->ptr, dmac->handle);
215 216 217
	}
}

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

227 228
	mutex_init(&dmac->lock);

229 230
	dmac->ptr = dma_alloc_coherent(nvxx_device(device)->dev, PAGE_SIZE,
				       &dmac->handle, GFP_KERNEL);
231 232 233
	if (!dmac->ptr)
		return -ENOMEM;

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

244 245
	args->pushbuf = nvif_handle(&pushbuf);

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

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

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

274 275 276
	return ret;
}

277 278 279 280
/******************************************************************************
 * Core
 *****************************************************************************/

281 282
struct nv50_mast {
	struct nv50_dmac base;
283 284
};

285
static int
286 287
nv50_core_create(struct nvif_device *device, struct nvif_object *disp,
		 u64 syncbuf, struct nv50_mast *core)
288
{
289 290
	struct nv50_disp_core_channel_dma_v0 args = {
		.pushbuf = 0xb0007d00,
291
	};
292
	static const s32 oclass[] = {
B
Ben Skeggs 已提交
293
		GM204_DISP_CORE_CHANNEL_DMA,
294 295 296 297 298 299 300 301 302
		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,
303 304 305
		0
	};

306 307
	return nv50_dmac_create(device, disp, oclass, 0, &args, sizeof(args),
				syncbuf, &core->base);
308 309 310 311 312
}

/******************************************************************************
 * Base
 *****************************************************************************/
313

314 315
struct nv50_sync {
	struct nv50_dmac base;
316 317
	u32 addr;
	u32 data;
318 319
};

320
static int
321 322
nv50_base_create(struct nvif_device *device, struct nvif_object *disp,
		 int head, u64 syncbuf, struct nv50_sync *base)
323
{
324 325
	struct nv50_disp_base_channel_dma_v0 args = {
		.pushbuf = 0xb0007c00 | head,
326 327
		.head = head,
	};
328
	static const s32 oclass[] = {
329 330 331 332 333 334 335
		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,
336 337 338
		0
	};

339
	return nv50_dmac_create(device, disp, oclass, head, &args, sizeof(args),
340 341 342 343 344 345 346
				syncbuf, &base->base);
}

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

347 348
struct nv50_ovly {
	struct nv50_dmac base;
349
};
350

351
static int
352 353
nv50_ovly_create(struct nvif_device *device, struct nvif_object *disp,
		 int head, u64 syncbuf, struct nv50_ovly *ovly)
354
{
355 356
	struct nv50_disp_overlay_channel_dma_v0 args = {
		.pushbuf = 0xb0007e00 | head,
357 358
		.head = head,
	};
359
	static const s32 oclass[] = {
360 361 362 363 364 365
		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,
366 367 368
		0
	};

369
	return nv50_dmac_create(device, disp, oclass, head, &args, sizeof(args),
370 371
				syncbuf, &ovly->base);
}
372

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

382 383 384 385 386 387
#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)
388 389 390 391 392 393 394
#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];
};
395

396
struct nv50_disp {
397
	struct nvif_object *disp;
398
	struct nv50_mast mast;
399

400
	struct list_head fbdma;
401 402

	struct nouveau_bo *sync;
403 404
};

405 406
static struct nv50_disp *
nv50_disp(struct drm_device *dev)
407
{
408
	return nouveau_display(dev)->priv;
409 410
}

411
#define nv50_mast(d) (&nv50_disp(d)->mast)
412

413
static struct drm_crtc *
414
nv50_display_crtc_get(struct drm_encoder *encoder)
415 416 417 418 419 420 421
{
	return nouveau_encoder(encoder)->crtc;
}

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

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

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

		put = 0;
	}

446
	return dmac->ptr + put;
447 448 449
}

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

457
#if 1
458 459
#define evo_mthd(p,m,s) *((p)++) = (((s) << 18) | (m))
#define evo_data(p,d)   *((p)++) = (d)
460 461 462 463 464 465 466 467 468 469 470 471
#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
472

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

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

	return -EBUSY;
}

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

516 517 518 519 520 521 522 523 524 525
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) ==
526
					      flip->chan->data)
527 528 529 530 531
		return true;
	usleep_range(1, 2);
	return false;
}

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

542
	push = evo_wait(flip.chan, 8);
543 544 545 546 547 548 549 550 551
	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);
552
		evo_kick(push, flip.chan);
553
	}
554

555 556 557 558
	nvif_msec(device, 2000,
		if (nv50_display_flip_wait(&flip))
			break;
	);
559 560 561
}

int
562
nv50_display_flip_next(struct drm_crtc *crtc, struct drm_framebuffer *fb,
563 564 565 566
		       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 已提交
567
	struct nv50_head *head = nv50_head(crtc);
568
	struct nv50_sync *sync = nv50_sync(crtc);
569
	u32 *push;
B
Ben Skeggs 已提交
570
	int ret;
571

572 573 574 575
	if (crtc->primary->fb->width != fb->width ||
	    crtc->primary->fb->height != fb->height)
		return -EINVAL;

576 577 578
	swap_interval <<= 4;
	if (swap_interval == 0)
		swap_interval |= 0x100;
579 580
	if (chan == NULL)
		evo_sync(crtc->dev);
581

582
	push = evo_wait(sync, 128);
583 584 585
	if (unlikely(push == NULL))
		return -EBUSY;

586
	if (chan && chan->user.oclass < G82_CHANNEL_GPFIFO) {
587 588 589 590 591
		ret = RING_SPACE(chan, 8);
		if (ret)
			return ret;

		BEGIN_NV04(chan, 0, NV11_SUBCHAN_DMA_SEMAPHORE, 2);
B
Ben Skeggs 已提交
592
		OUT_RING  (chan, NvEvoSema0 + nv_crtc->index);
593 594 595 596 597 598 599
		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
600
	if (chan && chan->user.oclass < FERMI_CHANNEL_GPFIFO) {
B
Ben Skeggs 已提交
601
		u64 addr = nv84_fence_crtc(chan, nv_crtc->index) + sync->addr;
602 603 604 605 606
		ret = RING_SPACE(chan, 12);
		if (ret)
			return ret;

		BEGIN_NV04(chan, 0, NV11_SUBCHAN_DMA_SEMAPHORE, 1);
607
		OUT_RING  (chan, chan->vram.handle);
608 609 610 611 612 613 614 615 616 617 618 619
		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 已提交
620
		u64 addr = nv84_fence_crtc(chan, nv_crtc->index) + sync->addr;
621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
		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);
	}
638

639 640 641
	if (chan) {
		sync->addr ^= 0x10;
		sync->data++;
642 643 644 645 646 647 648 649 650 651 652 653 654
		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);
655 656 657
	evo_data(push, sync->addr);
	evo_data(push, sync->data++);
	evo_data(push, sync->data);
658
	evo_data(push, sync->base.sync.handle);
659 660 661 662
	evo_mthd(push, 0x00a0, 2);
	evo_data(push, 0x00000000);
	evo_data(push, 0x00000000);
	evo_mthd(push, 0x00c0, 1);
663
	evo_data(push, nv_fb->r_handle);
664 665 666
	evo_mthd(push, 0x0110, 2);
	evo_data(push, 0x00000000);
	evo_data(push, 0x00000000);
667
	if (nv50_vers(sync) < GF110_DISP_BASE_CHANNEL_DMA) {
668 669 670 671 672 673 674 675 676 677 678 679 680 681
		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);
	}
682 683
	evo_mthd(push, 0x0080, 1);
	evo_data(push, 0x00000000);
684
	evo_kick(push, sync);
B
Ben Skeggs 已提交
685 686

	nouveau_bo_ref(nv_fb->nvbo, &head->image);
687 688 689
	return 0;
}

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

701
	nv_connector = nouveau_crtc_connector_get(nv_crtc);
702 703
	connector = &nv_connector->base;
	if (nv_connector->dithering_mode == DITHERING_MODE_AUTO) {
704
		if (nv_crtc->base.primary->fb->depth > connector->display_info.bpc * 3)
705 706 707 708 709 710 711 712 713 714
			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;
715 716
	}

717
	push = evo_wait(mast, 4);
718
	if (push) {
719
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
720 721 722
			evo_mthd(push, 0x08a0 + (nv_crtc->index * 0x0400), 1);
			evo_data(push, mode);
		} else
723
		if (nv50_vers(mast) < GK104_DISP_CORE_CHANNEL_DMA) {
724 725 726 727 728 729 730
			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);
		}

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

	return 0;
}

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

751 752 753
	/* start off at the resolution we programmed the crtc for, this
	 * effectively handles NONE/FULL scaling
	 */
B
Ben Skeggs 已提交
754
	nv_connector = nouveau_crtc_connector_get(nv_crtc);
755
	if (nv_connector && nv_connector->native_mode) {
756
		mode = nv_connector->scaling_mode;
757 758 759
		if (nv_connector->scaling_full) /* non-EDID LVDS/eDP mode */
			mode = DRM_MODE_SCALE_FULLSCREEN;
	}
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 806 807

	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 &&
			      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 已提交
808
		}
809 810 811
		break;
	default:
		break;
B
Ben Skeggs 已提交
812
	}
813

814
	push = evo_wait(mast, 8);
815
	if (push) {
816
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837
			/*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);

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

	return 0;
}

848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863
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;
}

864
static int
865
nv50_crtc_set_color_vibrance(struct nouveau_crtc *nv_crtc, bool update)
866
{
867
	struct nv50_mast *mast = nv50_mast(nv_crtc->base.dev);
868 869 870 871 872 873 874 875 876
	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) {
877
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894
			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;
}

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

903
	push = evo_wait(mast, 16);
904
	if (push) {
905
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
906 907 908 909 910 911 912 913
			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);
914
			if (nv50_vers(mast) > NV50_DISP_CORE_CHANNEL_DMA) {
915
				evo_mthd(push, 0x0874 + (nv_crtc->index * 0x400), 1);
916
				evo_data(push, nvfb->r_handle);
917 918 919 920 921 922 923 924
			}
		} 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);
925
			evo_data(push, nvfb->r_handle);
926 927 928 929
			evo_mthd(push, 0x04b0 + (nv_crtc->index * 0x300), 1);
			evo_data(push, (y << 16) | x);
		}

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

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

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

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

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

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

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

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

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

1028
	nv50_display_flip_stop(crtc);
1029

1030
	push = evo_wait(mast, 6);
1031
	if (push) {
1032
		if (nv50_vers(mast) < G82_DISP_CORE_CHANNEL_DMA) {
1033 1034 1035 1036 1037
			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
1038
		if (nv50_vers(mast) <  GF110_DISP_CORE_CHANNEL_DMA) {
1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054
			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);
1055 1056
	}

1057
	nv50_crtc_cursor_show_hide(nv_crtc, false, false);
1058 1059 1060
}

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

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

		evo_kick(push, mast);
1099 1100
	}

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

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

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

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

B
Ben Skeggs 已提交
1127
	return ret;
1128 1129 1130
}

static int
1131
nv50_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *umode,
1132 1133 1134
		   struct drm_display_mode *mode, int x, int y,
		   struct drm_framebuffer *old_fb)
{
1135
	struct nv50_mast *mast = nv50_mast(crtc->dev);
1136 1137
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
	struct nouveau_connector *nv_connector;
1138 1139 1140 1141
	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;
1142
	u32 vblan2e = 0, vblan2s = 1, vblankus = 0;
1143
	u32 *push;
1144 1145
	int ret;

1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158
	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;
1159 1160 1161 1162 1163
	/* XXX: Safe underestimate, even "0" works */
	vblankus = (vactive - mode->vdisplay - 2) * hactive;
	vblankus *= 1000;
	vblankus /= mode->clock;

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

1170
	ret = nv50_crtc_swap_fbs(crtc, old_fb);
1171 1172 1173
	if (ret)
		return ret;

1174
	push = evo_wait(mast, 64);
1175
	if (push) {
1176
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1177 1178 1179
			evo_mthd(push, 0x0804 + (nv_crtc->index * 0x400), 2);
			evo_data(push, 0x00800000 | mode->clock);
			evo_data(push, (ilace == 2) ? 2 : 0);
1180
			evo_mthd(push, 0x0810 + (nv_crtc->index * 0x400), 6);
1181 1182 1183 1184 1185 1186
			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);
1187
			evo_mthd(push, 0x082c + (nv_crtc->index * 0x400), 1);
1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211
			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);
1212 1213 1214
	}

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

	/* 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);

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

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

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

1240
	ret = nv50_crtc_swap_fbs(crtc, old_fb);
1241 1242 1243
	if (ret)
		return ret;

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

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

static void
1262
nv50_crtc_lut_load(struct drm_crtc *crtc)
1263
{
1264
	struct nv50_disp *disp = nv50_disp(crtc->dev);
1265 1266 1267 1268 1269
	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++) {
1270 1271 1272 1273
		u16 r = nv_crtc->lut.r[i] >> 2;
		u16 g = nv_crtc->lut.g[i] >> 2;
		u16 b = nv_crtc->lut.b[i] >> 2;

1274
		if (disp->disp->oclass < GF110_DISP) {
1275 1276 1277 1278 1279 1280 1281 1282
			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);
		}
1283 1284 1285
	}
}

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

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

1306
	if (handle) {
1307 1308 1309 1310 1311 1312 1313 1314
		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);

1315
		ret = nouveau_bo_pin(nvbo, TTM_PL_FLAG_VRAM, true);
1316 1317
	}

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

1325
	nv50_crtc_cursor_show_hide(nv_crtc, true, true);
1326 1327 1328 1329
	return ret;
}

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

	nv_crtc->cursor_saved_x = x;
	nv_crtc->cursor_saved_y = y;
1340 1341 1342 1343
	return 0;
}

static void
1344
nv50_crtc_gamma_set(struct drm_crtc *crtc, u16 *r, u16 *g, u16 *b,
1345 1346 1347
		    uint32_t start, uint32_t size)
{
	struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
1348
	u32 end = min_t(u32, start + size, 256);
1349 1350 1351 1352 1353 1354 1355 1356
	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];
	}

1357
	nv50_crtc_lut_load(crtc);
1358 1359
}

1360 1361 1362 1363 1364 1365 1366 1367
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);
}

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

1376 1377 1378 1379 1380 1381 1382 1383
	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 已提交
1384 1385 1386 1387 1388 1389 1390 1391

	/*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);

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

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

1402 1403 1404 1405
	drm_crtc_cleanup(crtc);
	kfree(crtc);
}

1406 1407 1408 1409 1410 1411 1412 1413 1414
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 已提交
1415
	.disable = nv50_crtc_disable,
1416 1417
};

1418 1419 1420 1421
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,
1422
	.set_config = nouveau_crtc_set_config,
1423
	.destroy = nv50_crtc_destroy,
1424
	.page_flip = nouveau_crtc_page_flip,
1425 1426 1427
};

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

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

1441
	head->base.index = index;
1442 1443 1444
	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;
1445 1446
	head->base.color_vibrance = 50;
	head->base.vibrant_hue = 0;
1447
	head->base.cursor.set_pos = nv50_crtc_cursor_restore;
1448
	for (i = 0; i < 256; i++) {
1449 1450 1451
		head->base.lut.r[i] = i << 8;
		head->base.lut.g[i] = i << 8;
		head->base.lut.b[i] = i << 8;
1452 1453
	}

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

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

	if (ret)
		goto out;

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

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

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

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

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

out:
	if (ret)
1501
		nv50_crtc_destroy(crtc);
1502 1503 1504
	return ret;
}

1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
/******************************************************************************
 * 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) {
1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534
		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);
1535 1536 1537 1538 1539
	}

	return true;
}

1540 1541 1542
/******************************************************************************
 * DAC
 *****************************************************************************/
B
Ben Skeggs 已提交
1543
static void
1544
nv50_dac_dpms(struct drm_encoder *encoder, int mode)
B
Ben Skeggs 已提交
1545 1546
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1547
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562
	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 已提交
1563

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

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

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

1581
	nv50_dac_dpms(encoder, DRM_MODE_DPMS_ON);
B
Ben Skeggs 已提交
1582

1583
	push = evo_wait(mast, 8);
B
Ben Skeggs 已提交
1584
	if (push) {
1585
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
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 1614 1615
			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 已提交
1616 1617 1618 1619 1620 1621
	}

	nv_encoder->crtc = encoder->crtc;
}

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

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

1632
		push = evo_wait(mast, 4);
B
Ben Skeggs 已提交
1633
		if (push) {
1634
			if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1635 1636 1637 1638 1639 1640 1641
				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 已提交
1642 1643
		}
	}
1644 1645

	nv_encoder->crtc = NULL;
B
Ben Skeggs 已提交
1646 1647
}

1648
static enum drm_connector_status
1649
nv50_dac_detect(struct drm_encoder *encoder, struct drm_connector *connector)
1650
{
1651
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1652
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666
	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 已提交
1667

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

1672
	return connector_status_connected;
1673 1674
}

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

1682 1683
static const struct drm_encoder_helper_funcs nv50_dac_hfunc = {
	.dpms = nv50_dac_dpms,
1684
	.mode_fixup = nv50_encoder_mode_fixup,
1685 1686 1687 1688 1689 1690
	.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 已提交
1691 1692
};

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

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

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

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

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

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

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

	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);
1756
	memcpy(args.data, nv_connector->base.eld, sizeof(args.data));
1757

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

static void
B
Ben Skeggs 已提交
1763
nv50_audio_disconnect(struct drm_encoder *encoder, struct nouveau_crtc *nv_crtc)
1764 1765
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1766
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1767 1768 1769 1770 1771 1772 1773
	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 已提交
1774 1775
		.base.hashm   = (0xf0ff & nv_encoder->dcb->hashm) |
				(0x0100 << nv_crtc->index),
1776
	};
1777

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

/******************************************************************************
 * HDMI
 *****************************************************************************/
static void
1785
nv50_hdmi_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode)
1786
{
1787 1788
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
	struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc);
1789
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802
	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;
1803 1804 1805 1806 1807 1808 1809
	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;
1810
	max_ac_packet -= args.pwr.rekey;
1811
	max_ac_packet -= 18; /* constant from tegra */
1812
	args.pwr.max_ac_packet = max_ac_packet / 32;
B
Ben Skeggs 已提交
1813

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

static void
1819
nv50_hdmi_disconnect(struct drm_encoder *encoder, struct nouveau_crtc *nv_crtc)
1820
{
1821
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1822
	struct nv50_disp *disp = nv50_disp(encoder->dev);
1823 1824 1825 1826 1827 1828 1829 1830 1831 1832
	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),
	};
1833

1834
	nvif_mthd(disp->disp, 0, &args, sizeof(args));
1835 1836
}

1837 1838 1839
/******************************************************************************
 * SOR
 *****************************************************************************/
1840
static void
1841
nv50_sor_dpms(struct drm_encoder *encoder, int mode)
1842 1843
{
	struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder);
1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854
	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,
	};
1855 1856 1857 1858 1859 1860 1861 1862 1863 1864
	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,
	};
1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876
	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 &&
1877
		    nv_partner->dcb->or == nv_encoder->dcb->or) {
1878 1879 1880 1881 1882 1883
			if (nv_partner->last_dpms == DRM_MODE_DPMS_ON)
				return;
			break;
		}
	}

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

1893
static void
1894
nv50_sor_ctrl(struct nouveau_encoder *nv_encoder, u32 mask, u32 data)
1895
{
1896 1897 1898
	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))) {
1899
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
1900 1901 1902 1903 1904
			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));
1905
		}
1906
		evo_kick(push, mast);
1907
	}
1908 1909 1910 1911 1912 1913 1914
}

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);
1915 1916 1917

	nv_encoder->last_dpms = DRM_MODE_DPMS_OFF;
	nv_encoder->crtc = NULL;
1918 1919 1920 1921

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

1927
static void
1928
nv50_sor_commit(struct drm_encoder *encoder)
1929 1930 1931 1932
{
}

static void
1933
nv50_sor_mode_set(struct drm_encoder *encoder, struct drm_display_mode *umode,
1934
		  struct drm_display_mode *mode)
1935
{
1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946
	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,
	};
1947 1948
	struct nv50_disp *disp = nv50_disp(encoder->dev);
	struct nv50_mast *mast = nv50_mast(encoder->dev);
1949
	struct drm_device *dev = encoder->dev;
1950
	struct nouveau_drm *drm = nouveau_drm(dev);
1951
	struct nouveau_connector *nv_connector;
1952
	struct nvbios *bios = &drm->vbios;
1953
	u32 mask, ctrl;
1954 1955 1956
	u8 owner = 1 << nv_crtc->index;
	u8 proto = 0xf;
	u8 depth = 0x0;
1957

1958
	nv_connector = nouveau_encoder_connector_get(nv_encoder);
1959 1960
	nv_encoder->crtc = encoder->crtc;

1961
	switch (nv_encoder->dcb->type) {
1962
	case DCB_OUTPUT_TMDS:
1963
		if (nv_encoder->dcb->sorconf.link & 1) {
1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974
			proto = 0x1;
			/* Only enable dual-link if:
			 *  - Need to (i.e. rate > 165MHz)
			 *  - DCB says we can
			 *  - Not an HDMI monitor, since there's no dual-link
			 *    on HDMI.
			 */
			if (mode->clock >= 165000 &&
			    nv_encoder->dcb->duallink_possible &&
			    !drm_detect_hdmi_monitor(nv_connector->edid))
				proto |= 0x4;
1975
		} else {
1976
			proto = 0x2;
1977 1978
		}

1979
		nv50_hdmi_mode_set(&nv_encoder->base.base, mode);
1980
		break;
1981
	case DCB_OUTPUT_LVDS:
1982 1983
		proto = 0x0;

1984 1985
		if (bios->fp_no_ddc) {
			if (bios->fp.dual_link)
1986
				lvds.lvds.script |= 0x0100;
1987
			if (bios->fp.if_is_24bit)
1988
				lvds.lvds.script |= 0x0200;
1989
		} else {
1990
			if (nv_connector->type == DCB_CONNECTOR_LVDS_SPWG) {
1991
				if (((u8 *)nv_connector->edid)[121] == 2)
1992
					lvds.lvds.script |= 0x0100;
1993 1994
			} else
			if (mode->clock >= bios->fp.duallink_transition_clk) {
1995
				lvds.lvds.script |= 0x0100;
1996
			}
1997

1998
			if (lvds.lvds.script & 0x0100) {
1999
				if (bios->fp.strapless_is_24bit & 2)
2000
					lvds.lvds.script |= 0x0200;
2001 2002
			} else {
				if (bios->fp.strapless_is_24bit & 1)
2003
					lvds.lvds.script |= 0x0200;
2004 2005 2006
			}

			if (nv_connector->base.display_info.bpc == 8)
2007
				lvds.lvds.script |= 0x0200;
2008
		}
2009

2010
		nvif_mthd(disp->disp, 0, &lvds, sizeof(lvds));
2011
		break;
2012
	case DCB_OUTPUT_DP:
2013
		if (nv_connector->base.display_info.bpc == 6) {
2014
			nv_encoder->dp.datarate = mode->clock * 18 / 8;
2015
			depth = 0x2;
2016 2017
		} else
		if (nv_connector->base.display_info.bpc == 8) {
2018
			nv_encoder->dp.datarate = mode->clock * 24 / 8;
2019
			depth = 0x5;
2020 2021 2022
		} else {
			nv_encoder->dp.datarate = mode->clock * 30 / 8;
			depth = 0x6;
2023
		}
2024 2025

		if (nv_encoder->dcb->sorconf.link & 1)
2026
			proto = 0x8;
2027
		else
2028
			proto = 0x9;
2029
		nv50_audio_mode_set(encoder, mode);
2030
		break;
2031 2032 2033 2034
	default:
		BUG_ON(1);
		break;
	}
2035

2036
	nv50_sor_dpms(&nv_encoder->base.base, DRM_MODE_DPMS_ON);
2037

2038
	if (nv50_vers(mast) >= GF110_DISP) {
2039 2040
		u32 *push = evo_wait(mast, 3);
		if (push) {
2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054
			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);
2055
			evo_kick(push, mast);
2056 2057
		}

2058 2059 2060 2061 2062 2063 2064 2065 2066
		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;
2067 2068
	}

2069
	nv50_sor_ctrl(nv_encoder, mask | owner, ctrl | owner);
2070 2071 2072
}

static void
2073
nv50_sor_destroy(struct drm_encoder *encoder)
2074 2075 2076 2077 2078
{
	drm_encoder_cleanup(encoder);
	kfree(encoder);
}

2079 2080
static const struct drm_encoder_helper_funcs nv50_sor_hfunc = {
	.dpms = nv50_sor_dpms,
2081
	.mode_fixup = nv50_encoder_mode_fixup,
2082
	.prepare = nv50_sor_disconnect,
2083 2084 2085 2086
	.commit = nv50_sor_commit,
	.mode_set = nv50_sor_mode_set,
	.disable = nv50_sor_disconnect,
	.get_crtc = nv50_display_crtc_get,
2087 2088
};

2089 2090
static const struct drm_encoder_funcs nv50_sor_func = {
	.destroy = nv50_sor_destroy,
2091 2092 2093
};

static int
2094
nv50_sor_create(struct drm_connector *connector, struct dcb_output *dcbe)
2095
{
2096
	struct nouveau_drm *drm = nouveau_drm(connector->dev);
2097
	struct nvkm_i2c *i2c = nvxx_i2c(&drm->device);
2098 2099
	struct nouveau_encoder *nv_encoder;
	struct drm_encoder *encoder;
2100 2101 2102 2103 2104 2105 2106 2107 2108 2109
	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;
	}
2110 2111 2112 2113 2114 2115 2116 2117

	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;

2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131
	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;
	}

2132 2133 2134
	encoder = to_drm_encoder(nv_encoder);
	encoder->possible_crtcs = dcbe->heads;
	encoder->possible_clones = 0;
2135
	drm_encoder_init(connector->dev, encoder, &nv50_sor_func, type, NULL);
2136
	drm_encoder_helper_add(encoder, &nv50_sor_hfunc);
2137 2138 2139 2140

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

2142 2143 2144 2145 2146 2147 2148 2149 2150
/******************************************************************************
 * 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);
2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163
	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));
2164 2165 2166 2167 2168 2169 2170
}

static bool
nv50_pior_mode_fixup(struct drm_encoder *encoder,
		     const struct drm_display_mode *mode,
		     struct drm_display_mode *adjusted_mode)
{
2171 2172
	if (!nv50_encoder_mode_fixup(encoder, mode, adjusted_mode))
		return false;
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 2207 2208 2209 2210 2211 2212 2213 2214 2215
	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) {
2216
		if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244
			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) {
2245
			if (nv50_vers(mast) < GF110_DISP_CORE_CHANNEL_DMA) {
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 2272 2273 2274 2275 2276 2277 2278 2279 2280
				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);
2281
	struct nvkm_i2c *i2c = nvxx_i2c(&drm->device);
2282 2283 2284
	struct nvkm_i2c_bus *bus = NULL;
	struct nvkm_i2c_aux *aux = NULL;
	struct i2c_adapter *ddc;
2285 2286 2287 2288 2289 2290
	struct nouveau_encoder *nv_encoder;
	struct drm_encoder *encoder;
	int type;

	switch (dcbe->type) {
	case DCB_OUTPUT_TMDS:
2291 2292
		bus  = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_EXT(dcbe->extdev));
		ddc  = bus ? &bus->i2c : NULL;
2293 2294 2295
		type = DRM_MODE_ENCODER_TMDS;
		break;
	case DCB_OUTPUT_DP:
2296 2297
		aux  = nvkm_i2c_aux_find(i2c, NVKM_I2C_AUX_EXT(dcbe->extdev));
		ddc  = aux ? &aux->i2c : NULL;
2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309
		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;
2310
	nv_encoder->aux = aux;
2311 2312 2313 2314

	encoder = to_drm_encoder(nv_encoder);
	encoder->possible_crtcs = dcbe->heads;
	encoder->possible_clones = 0;
2315
	drm_encoder_init(connector->dev, encoder, &nv50_pior_func, type, NULL);
2316 2317 2318 2319 2320 2321
	drm_encoder_helper_add(encoder, &nv50_pior_hfunc);

	drm_mode_connector_attach_encoder(connector, encoder);
	return 0;
}

2322 2323 2324 2325
/******************************************************************************
 * Framebuffer
 *****************************************************************************/

2326
static void
2327
nv50_fbdma_fini(struct nv50_fbdma *fbdma)
2328
{
2329 2330 2331 2332
	int i;
	for (i = 0; i < ARRAY_SIZE(fbdma->base); i++)
		nvif_object_fini(&fbdma->base[i]);
	nvif_object_fini(&fbdma->core);
2333 2334 2335 2336 2337 2338 2339 2340 2341 2342
	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);
2343 2344 2345 2346 2347
	struct __attribute__ ((packed)) {
		struct nv_dma_v0 base;
		union {
			struct nv50_dma_v0 nv50;
			struct gf100_dma_v0 gf100;
2348
			struct gf119_dma_v0 gf119;
2349 2350
		};
	} args = {};
2351 2352
	struct nv50_fbdma *fbdma;
	struct drm_crtc *crtc;
2353
	u32 size = sizeof(args.base);
2354 2355 2356
	int ret;

	list_for_each_entry(fbdma, &disp->fbdma, head) {
2357
		if (fbdma->core.handle == name)
2358 2359 2360 2361 2362 2363 2364 2365
			return 0;
	}

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

2366 2367 2368 2369
	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;
2370

2371
	if (drm->device.info.chipset < 0x80) {
2372 2373
		args.nv50.part = NV50_DMA_V0_PART_256;
		size += sizeof(args.nv50);
2374
	} else
2375
	if (drm->device.info.chipset < 0xc0) {
2376 2377 2378
		args.nv50.part = NV50_DMA_V0_PART_256;
		args.nv50.kind = kind;
		size += sizeof(args.nv50);
2379
	} else
2380
	if (drm->device.info.chipset < 0xd0) {
2381 2382
		args.gf100.kind = kind;
		size += sizeof(args.gf100);
2383
	} else {
2384 2385 2386
		args.gf119.page = GF119_DMA_V0_PAGE_LP;
		args.gf119.kind = kind;
		size += sizeof(args.gf119);
2387 2388 2389
	}

	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
2390
		struct nv50_head *head = nv50_head(crtc);
2391 2392
		int ret = nvif_object_init(&head->sync.base.base.user, name,
					   NV_DMA_IN_MEMORY, &args, size,
2393
					   &fbdma->base[head->base.index]);
2394
		if (ret) {
2395
			nv50_fbdma_fini(fbdma);
2396 2397 2398 2399
			return ret;
		}
	}

2400 2401
	ret = nvif_object_init(&mast->base.base.user, name, NV_DMA_IN_MEMORY,
			       &args, size, &fbdma->core);
2402
	if (ret) {
2403
		nv50_fbdma_fini(fbdma);
2404 2405 2406 2407 2408 2409
		return ret;
	}

	return 0;
}

2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420
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;
2421 2422 2423
	struct nv50_disp *disp = nv50_disp(fb->dev);
	u8 kind = nouveau_bo_tile_layout(nvbo) >> 8;
	u8 tile = nvbo->tile_mode;
2424

2425
	if (drm->device.info.chipset >= 0xc0)
2426 2427
		tile >>= 4; /* yep.. */

2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439
	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;
	}

2440
	if (disp->disp->oclass < G82_DISP) {
2441 2442 2443 2444
		nv_fb->r_pitch   = kind ? (((fb->pitches[0] / 4) << 4) | tile) :
					    (fb->pitches[0] | 0x00100000);
		nv_fb->r_format |= kind << 16;
	} else
2445
	if (disp->disp->oclass < GF110_DISP) {
2446 2447
		nv_fb->r_pitch  = kind ? (((fb->pitches[0] / 4) << 4) | tile) :
					   (fb->pitches[0] | 0x00100000);
2448
	} else {
2449 2450
		nv_fb->r_pitch  = kind ? (((fb->pitches[0] / 4) << 4) | tile) :
					   (fb->pitches[0] | 0x01000000);
2451
	}
2452
	nv_fb->r_handle = 0xffff0000 | kind;
2453

2454 2455
	return nv50_fbdma_init(fb->dev, nv_fb->r_handle, 0,
			       drm->device.info.ram_user, kind);
2456 2457
}

2458 2459 2460
/******************************************************************************
 * Init
 *****************************************************************************/
2461

2462
void
2463
nv50_display_fini(struct drm_device *dev)
2464 2465 2466 2467
{
}

int
2468
nv50_display_init(struct drm_device *dev)
2469
{
2470 2471 2472 2473 2474 2475 2476 2477 2478 2479
	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);
2480 2481

		nv50_crtc_lut_load(crtc);
2482
		nouveau_bo_wr32(disp->sync, sync->addr / 4, sync->data);
2483
	}
2484

2485
	evo_mthd(push, 0x0088, 1);
2486
	evo_data(push, nv50_mast(dev)->base.sync.handle);
2487 2488
	evo_kick(push, nv50_mast(dev));
	return 0;
2489 2490 2491
}

void
2492
nv50_display_destroy(struct drm_device *dev)
2493
{
2494
	struct nv50_disp *disp = nv50_disp(dev);
2495 2496 2497
	struct nv50_fbdma *fbdma, *fbtmp;

	list_for_each_entry_safe(fbdma, fbtmp, &disp->fbdma, head) {
2498
		nv50_fbdma_fini(fbdma);
2499
	}
2500

2501
	nv50_dmac_destroy(&disp->mast.base, disp->disp);
2502

2503
	nouveau_bo_unmap(disp->sync);
2504 2505
	if (disp->sync)
		nouveau_bo_unpin(disp->sync);
2506
	nouveau_bo_ref(NULL, &disp->sync);
2507

2508
	nouveau_display(dev)->priv = NULL;
2509 2510 2511 2512
	kfree(disp);
}

int
2513
nv50_display_create(struct drm_device *dev)
2514
{
2515
	struct nvif_device *device = &nouveau_drm(dev)->device;
2516 2517
	struct nouveau_drm *drm = nouveau_drm(dev);
	struct dcb_table *dcb = &drm->vbios.dcb;
2518
	struct drm_connector *connector, *tmp;
2519
	struct nv50_disp *disp;
2520
	struct dcb_output *dcbe;
2521
	int crtcs, ret, i;
2522 2523 2524 2525

	disp = kzalloc(sizeof(*disp), GFP_KERNEL);
	if (!disp)
		return -ENOMEM;
2526
	INIT_LIST_HEAD(&disp->fbdma);
2527 2528

	nouveau_display(dev)->priv = disp;
2529 2530 2531
	nouveau_display(dev)->dtor = nv50_display_destroy;
	nouveau_display(dev)->init = nv50_display_init;
	nouveau_display(dev)->fini = nv50_display_fini;
2532 2533
	nouveau_display(dev)->fb_ctor = nv50_fb_ctor;
	nouveau_display(dev)->fb_dtor = nv50_fb_dtor;
2534
	disp->disp = &nouveau_display(dev)->disp;
2535

2536 2537
	/* small shared memory area we use for notifiers and semaphores */
	ret = nouveau_bo_new(dev, 4096, 0x1000, TTM_PL_FLAG_VRAM,
2538
			     0, 0x0000, NULL, NULL, &disp->sync);
2539
	if (!ret) {
2540
		ret = nouveau_bo_pin(disp->sync, TTM_PL_FLAG_VRAM, true);
2541
		if (!ret) {
2542
			ret = nouveau_bo_map(disp->sync);
2543 2544 2545
			if (ret)
				nouveau_bo_unpin(disp->sync);
		}
2546 2547 2548 2549 2550 2551 2552 2553
		if (ret)
			nouveau_bo_ref(NULL, &disp->sync);
	}

	if (ret)
		goto out;

	/* allocate master evo channel */
2554
	ret = nv50_core_create(device, disp->disp, disp->sync->bo.offset,
2555
			      &disp->mast);
2556 2557 2558
	if (ret)
		goto out;

2559
	/* create crtc objects to represent the hw heads */
2560
	if (disp->disp->oclass >= GF110_DISP)
2561
		crtcs = nvif_rd32(&device->object, 0x022448);
2562 2563 2564
	else
		crtcs = 2;

2565
	for (i = 0; i < crtcs; i++) {
2566
		ret = nv50_crtc_create(dev, i);
2567 2568 2569 2570
		if (ret)
			goto out;
	}

2571 2572 2573 2574 2575 2576
	/* 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;

2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592
		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);
2593 2594
		}

2595 2596 2597 2598
		if (ret) {
			NV_WARN(drm, "failed to create encoder %d/%d/%d: %d\n",
				     dcbe->location, dcbe->type,
				     ffs(dcbe->or) - 1, ret);
2599
			ret = 0;
2600 2601 2602 2603 2604 2605 2606 2607
		}
	}

	/* 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;

2608
		NV_WARN(drm, "%s has no encoders, removing\n",
2609
			connector->name);
2610 2611 2612
		connector->funcs->destroy(connector);
	}

2613 2614
out:
	if (ret)
2615
		nv50_display_destroy(dev);
2616 2617
	return ret;
}