drm.c 28.3 KB
Newer Older
T
Thierry Reding 已提交
1 2
/*
 * Copyright (C) 2012 Avionic Design GmbH
3
 * Copyright (C) 2012-2016 NVIDIA CORPORATION.  All rights reserved.
T
Thierry Reding 已提交
4 5 6 7 8 9
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

10
#include <linux/bitops.h>
11
#include <linux/host1x.h>
12
#include <linux/idr.h>
T
Thierry Reding 已提交
13
#include <linux/iommu.h>
14

15
#include <drm/drm_atomic.h>
16 17
#include <drm/drm_atomic_helper.h>

T
Thierry Reding 已提交
18
#include "drm.h"
19
#include "gem.h"
T
Thierry Reding 已提交
20 21 22 23 24 25 26 27

#define DRIVER_NAME "tegra"
#define DRIVER_DESC "NVIDIA Tegra graphics"
#define DRIVER_DATE "20120330"
#define DRIVER_MAJOR 0
#define DRIVER_MINOR 0
#define DRIVER_PATCHLEVEL 0

28 29
#define CARVEOUT_SZ SZ_64M

30
struct tegra_drm_file {
31 32
	struct idr contexts;
	struct mutex lock;
33 34
};

35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62
static void tegra_atomic_schedule(struct tegra_drm *tegra,
				  struct drm_atomic_state *state)
{
	tegra->commit.state = state;
	schedule_work(&tegra->commit.work);
}

static void tegra_atomic_complete(struct tegra_drm *tegra,
				  struct drm_atomic_state *state)
{
	struct drm_device *drm = tegra->drm;

	/*
	 * Everything below can be run asynchronously without the need to grab
	 * any modeset locks at all under one condition: It must be guaranteed
	 * that the asynchronous work has either been cancelled (if the driver
	 * supports it, which at least requires that the framebuffers get
	 * cleaned up with drm_atomic_helper_cleanup_planes()) or completed
	 * before the new state gets committed on the software side with
	 * drm_atomic_helper_swap_state().
	 *
	 * This scheme allows new atomic state updates to be prepared and
	 * checked in parallel to the asynchronous completion of the previous
	 * update. Which is important since compositors need to figure out the
	 * composition of the next frame right after having submitted the
	 * current layout.
	 */

63 64
	drm_atomic_helper_commit_modeset_disables(drm, state);
	drm_atomic_helper_commit_modeset_enables(drm, state);
65 66
	drm_atomic_helper_commit_planes(drm, state,
					DRM_PLANE_COMMIT_ACTIVE_ONLY);
67 68 69 70

	drm_atomic_helper_wait_for_vblanks(drm, state);

	drm_atomic_helper_cleanup_planes(drm, state);
71
	drm_atomic_state_put(state);
72 73 74 75 76 77 78 79 80 81 82
}

static void tegra_atomic_work(struct work_struct *work)
{
	struct tegra_drm *tegra = container_of(work, struct tegra_drm,
					       commit.work);

	tegra_atomic_complete(tegra, tegra->commit.state);
}

static int tegra_atomic_commit(struct drm_device *drm,
83
			       struct drm_atomic_state *state, bool nonblock)
84 85 86 87 88 89 90 91
{
	struct tegra_drm *tegra = drm->dev_private;
	int err;

	err = drm_atomic_helper_prepare_planes(drm, state);
	if (err)
		return err;

92
	/* serialize outstanding nonblocking commits */
93 94 95 96 97 98 99 100 101
	mutex_lock(&tegra->commit.lock);
	flush_work(&tegra->commit.work);

	/*
	 * This is the point of no return - everything below never fails except
	 * when the hw goes bonghits. Which means we can commit the new state on
	 * the software side now.
	 */

102
	drm_atomic_helper_swap_state(state, true);
103

104
	drm_atomic_state_get(state);
105
	if (nonblock)
106 107 108 109 110 111 112 113
		tegra_atomic_schedule(tegra, state);
	else
		tegra_atomic_complete(tegra, state);

	mutex_unlock(&tegra->commit.lock);
	return 0;
}

114 115
static const struct drm_mode_config_funcs tegra_drm_mode_funcs = {
	.fb_create = tegra_fb_create,
116
#ifdef CONFIG_DRM_FBDEV_EMULATION
117 118
	.output_poll_changed = tegra_fb_output_poll_changed,
#endif
119
	.atomic_check = drm_atomic_helper_check,
120
	.atomic_commit = tegra_atomic_commit,
121 122
};

123
static int tegra_drm_load(struct drm_device *drm, unsigned long flags)
124
{
125
	struct host1x_device *device = to_host1x_device(drm->dev);
126
	struct tegra_drm *tegra;
127 128
	int err;

129
	tegra = kzalloc(sizeof(*tegra), GFP_KERNEL);
130
	if (!tegra)
131 132
		return -ENOMEM;

T
Thierry Reding 已提交
133
	if (iommu_present(&platform_bus_type)) {
134
		u64 carveout_start, carveout_end, gem_start, gem_end;
135
		struct iommu_domain_geometry *geometry;
136
		unsigned long order;
137

T
Thierry Reding 已提交
138
		tegra->domain = iommu_domain_alloc(&platform_bus_type);
139 140
		if (!tegra->domain) {
			err = -ENOMEM;
T
Thierry Reding 已提交
141 142 143
			goto free;
		}

144
		geometry = &tegra->domain->geometry;
145 146 147 148 149 150 151 152 153
		gem_start = geometry->aperture_start;
		gem_end = geometry->aperture_end - CARVEOUT_SZ;
		carveout_start = gem_end + 1;
		carveout_end = geometry->aperture_end;

		order = __ffs(tegra->domain->pgsize_bitmap);
		init_iova_domain(&tegra->carveout.domain, 1UL << order,
				 carveout_start >> order,
				 carveout_end >> order);
154

155 156 157 158
		tegra->carveout.shift = iova_shift(&tegra->carveout.domain);
		tegra->carveout.limit = carveout_end >> tegra->carveout.shift;

		drm_mm_init(&tegra->mm, gem_start, gem_end - gem_start + 1);
159
		mutex_init(&tegra->mm_lock);
160 161 162 163 164

		DRM_DEBUG("IOMMU apertures:\n");
		DRM_DEBUG("  GEM: %#llx-%#llx\n", gem_start, gem_end);
		DRM_DEBUG("  Carveout: %#llx-%#llx\n", carveout_start,
			  carveout_end);
T
Thierry Reding 已提交
165 166
	}

167 168
	mutex_init(&tegra->clients_lock);
	INIT_LIST_HEAD(&tegra->clients);
169 170 171 172

	mutex_init(&tegra->commit.lock);
	INIT_WORK(&tegra->commit.work, tegra_atomic_work);

173 174
	drm->dev_private = tegra;
	tegra->drm = drm;
T
Thierry Reding 已提交
175 176 177

	drm_mode_config_init(drm);

178 179 180 181 182 183
	drm->mode_config.min_width = 0;
	drm->mode_config.min_height = 0;

	drm->mode_config.max_width = 4096;
	drm->mode_config.max_height = 4096;

184 185
	drm->mode_config.allow_fb_modifiers = true;

186 187
	drm->mode_config.funcs = &tegra_drm_mode_funcs;

188 189
	err = tegra_drm_fb_prepare(drm);
	if (err < 0)
190
		goto config;
191 192 193

	drm_kms_helper_poll_init(drm);

194
	err = host1x_device_init(device);
T
Thierry Reding 已提交
195
	if (err < 0)
196
		goto fbdev;
T
Thierry Reding 已提交
197

198 199 200 201 202
	/*
	 * We don't use the drm_irq_install() helpers provided by the DRM
	 * core, so we need to set this manually in order to allow the
	 * DRM_IOCTL_WAIT_VBLANK to operate correctly.
	 */
V
Ville Syrjälä 已提交
203
	drm->irq_enabled = true;
204

205 206 207
	/* syncpoints are used for full 32-bit hardware VBLANK counters */
	drm->max_vblank_count = 0xffffffff;

208 209
	err = drm_vblank_init(drm, drm->mode_config.num_crtc);
	if (err < 0)
210
		goto device;
211

212 213
	drm_mode_config_reset(drm);

T
Thierry Reding 已提交
214 215
	err = tegra_drm_fb_init(drm);
	if (err < 0)
216
		goto device;
T
Thierry Reding 已提交
217 218

	return 0;
219 220 221 222 223 224 225 226

device:
	host1x_device_exit(device);
fbdev:
	drm_kms_helper_poll_fini(drm);
	tegra_drm_fb_free(drm);
config:
	drm_mode_config_cleanup(drm);
T
Thierry Reding 已提交
227 228 229 230

	if (tegra->domain) {
		iommu_domain_free(tegra->domain);
		drm_mm_takedown(&tegra->mm);
231
		mutex_destroy(&tegra->mm_lock);
232
		put_iova_domain(&tegra->carveout.domain);
T
Thierry Reding 已提交
233 234
	}
free:
235 236
	kfree(tegra);
	return err;
T
Thierry Reding 已提交
237 238
}

239
static void tegra_drm_unload(struct drm_device *drm)
T
Thierry Reding 已提交
240
{
241
	struct host1x_device *device = to_host1x_device(drm->dev);
T
Thierry Reding 已提交
242
	struct tegra_drm *tegra = drm->dev_private;
243 244
	int err;

T
Thierry Reding 已提交
245 246
	drm_kms_helper_poll_fini(drm);
	tegra_drm_fb_exit(drm);
247
	drm_mode_config_cleanup(drm);
T
Thierry Reding 已提交
248

249 250
	err = host1x_device_exit(device);
	if (err < 0)
251
		return;
252

T
Thierry Reding 已提交
253 254 255
	if (tegra->domain) {
		iommu_domain_free(tegra->domain);
		drm_mm_takedown(&tegra->mm);
256
		mutex_destroy(&tegra->mm_lock);
257
		put_iova_domain(&tegra->carveout.domain);
T
Thierry Reding 已提交
258 259
	}

T
Thierry Reding 已提交
260
	kfree(tegra);
T
Thierry Reding 已提交
261 262 263 264
}

static int tegra_drm_open(struct drm_device *drm, struct drm_file *filp)
{
265
	struct tegra_drm_file *fpriv;
T
Terje Bergstrom 已提交
266 267 268 269 270

	fpriv = kzalloc(sizeof(*fpriv), GFP_KERNEL);
	if (!fpriv)
		return -ENOMEM;

271 272
	idr_init(&fpriv->contexts);
	mutex_init(&fpriv->lock);
T
Terje Bergstrom 已提交
273 274
	filp->driver_priv = fpriv;

T
Thierry Reding 已提交
275 276 277
	return 0;
}

278
static void tegra_drm_context_free(struct tegra_drm_context *context)
T
Terje Bergstrom 已提交
279 280 281 282 283
{
	context->client->ops->close_channel(context);
	kfree(context);
}

T
Thierry Reding 已提交
284 285
static void tegra_drm_lastclose(struct drm_device *drm)
{
286
#ifdef CONFIG_DRM_FBDEV_EMULATION
287
	struct tegra_drm *tegra = drm->dev_private;
T
Thierry Reding 已提交
288

289
	tegra_fbdev_restore_mode(tegra->fbdev);
290
#endif
T
Thierry Reding 已提交
291 292
}

293
static struct host1x_bo *
294
host1x_bo_lookup(struct drm_file *file, u32 handle)
295 296 297 298
{
	struct drm_gem_object *gem;
	struct tegra_bo *bo;

299
	gem = drm_gem_object_lookup(file, handle);
300 301 302
	if (!gem)
		return NULL;

303
	drm_gem_object_unreference_unlocked(gem);
304 305 306 307 308

	bo = to_tegra_bo(gem);
	return &bo->base;
}

309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328
static int host1x_reloc_copy_from_user(struct host1x_reloc *dest,
				       struct drm_tegra_reloc __user *src,
				       struct drm_device *drm,
				       struct drm_file *file)
{
	u32 cmdbuf, target;
	int err;

	err = get_user(cmdbuf, &src->cmdbuf.handle);
	if (err < 0)
		return err;

	err = get_user(dest->cmdbuf.offset, &src->cmdbuf.offset);
	if (err < 0)
		return err;

	err = get_user(target, &src->target.handle);
	if (err < 0)
		return err;

329
	err = get_user(dest->target.offset, &src->target.offset);
330 331 332 333 334 335 336
	if (err < 0)
		return err;

	err = get_user(dest->shift, &src->shift);
	if (err < 0)
		return err;

337
	dest->cmdbuf.bo = host1x_bo_lookup(file, cmdbuf);
338 339 340
	if (!dest->cmdbuf.bo)
		return -ENOENT;

341
	dest->target.bo = host1x_bo_lookup(file, target);
342 343 344 345 346 347
	if (!dest->target.bo)
		return -ENOENT;

	return 0;
}

348 349 350 351 352 353 354 355
int tegra_drm_submit(struct tegra_drm_context *context,
		     struct drm_tegra_submit *args, struct drm_device *drm,
		     struct drm_file *file)
{
	unsigned int num_cmdbufs = args->num_cmdbufs;
	unsigned int num_relocs = args->num_relocs;
	unsigned int num_waitchks = args->num_waitchks;
	struct drm_tegra_cmdbuf __user *cmdbufs =
356
		(void __user *)(uintptr_t)args->cmdbufs;
357
	struct drm_tegra_reloc __user *relocs =
358
		(void __user *)(uintptr_t)args->relocs;
359
	struct drm_tegra_waitchk __user *waitchks =
360
		(void __user *)(uintptr_t)args->waitchks;
361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383
	struct drm_tegra_syncpt syncpt;
	struct host1x_job *job;
	int err;

	/* We don't yet support other than one syncpt_incr struct per submit */
	if (args->num_syncpts != 1)
		return -EINVAL;

	job = host1x_job_alloc(context->channel, args->num_cmdbufs,
			       args->num_relocs, args->num_waitchks);
	if (!job)
		return -ENOMEM;

	job->num_relocs = args->num_relocs;
	job->num_waitchk = args->num_waitchks;
	job->client = (u32)args->context;
	job->class = context->client->base.class;
	job->serialize = true;

	while (num_cmdbufs) {
		struct drm_tegra_cmdbuf cmdbuf;
		struct host1x_bo *bo;

384 385
		if (copy_from_user(&cmdbuf, cmdbufs, sizeof(cmdbuf))) {
			err = -EFAULT;
386
			goto fail;
387
		}
388

389
		bo = host1x_bo_lookup(file, cmdbuf.handle);
390 391 392 393 394 395 396 397 398 399
		if (!bo) {
			err = -ENOENT;
			goto fail;
		}

		host1x_job_add_gather(job, bo, cmdbuf.words, cmdbuf.offset);
		num_cmdbufs--;
		cmdbufs++;
	}

400
	/* copy and resolve relocations from submit */
401
	while (num_relocs--) {
402 403 404 405
		err = host1x_reloc_copy_from_user(&job->relocarray[num_relocs],
						  &relocs[num_relocs], drm,
						  file);
		if (err < 0)
406 407 408
			goto fail;
	}

409 410 411
	if (copy_from_user(job->waitchk, waitchks,
			   sizeof(*waitchks) * num_waitchks)) {
		err = -EFAULT;
412
		goto fail;
413
	}
414

415 416 417
	if (copy_from_user(&syncpt, (void __user *)(uintptr_t)args->syncpts,
			   sizeof(syncpt))) {
		err = -EFAULT;
418
		goto fail;
419
	}
420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449

	job->is_addr_reg = context->client->ops->is_addr_reg;
	job->syncpt_incrs = syncpt.incrs;
	job->syncpt_id = syncpt.id;
	job->timeout = 10000;

	if (args->timeout && args->timeout < 10000)
		job->timeout = args->timeout;

	err = host1x_job_pin(job, context->client->base.dev);
	if (err)
		goto fail;

	err = host1x_job_submit(job);
	if (err)
		goto fail_submit;

	args->fence = job->syncpt_end;

	host1x_job_put(job);
	return 0;

fail_submit:
	host1x_job_unpin(job);
fail:
	host1x_job_put(job);
	return err;
}


T
Terje Bergstrom 已提交
450
#ifdef CONFIG_DRM_TEGRA_STAGING
451 452
static struct tegra_drm_context *
tegra_drm_file_get_context(struct tegra_drm_file *file, u32 id)
T
Terje Bergstrom 已提交
453
{
454
	struct tegra_drm_context *context;
T
Terje Bergstrom 已提交
455

456 457 458
	mutex_lock(&file->lock);
	context = idr_find(&file->contexts, id);
	mutex_unlock(&file->lock);
T
Terje Bergstrom 已提交
459

460
	return context;
T
Terje Bergstrom 已提交
461 462 463 464 465 466 467 468
}

static int tegra_gem_create(struct drm_device *drm, void *data,
			    struct drm_file *file)
{
	struct drm_tegra_gem_create *args = data;
	struct tegra_bo *bo;

469
	bo = tegra_bo_create_with_handle(file, drm, args->size, args->flags,
T
Terje Bergstrom 已提交
470 471 472 473 474 475 476 477 478 479 480 481 482 483
					 &args->handle);
	if (IS_ERR(bo))
		return PTR_ERR(bo);

	return 0;
}

static int tegra_gem_mmap(struct drm_device *drm, void *data,
			  struct drm_file *file)
{
	struct drm_tegra_gem_mmap *args = data;
	struct drm_gem_object *gem;
	struct tegra_bo *bo;

484
	gem = drm_gem_object_lookup(file, args->handle);
T
Terje Bergstrom 已提交
485 486 487 488 489
	if (!gem)
		return -EINVAL;

	bo = to_tegra_bo(gem);

490
	args->offset = drm_vma_node_offset_addr(&bo->gem.vma_node);
T
Terje Bergstrom 已提交
491

492
	drm_gem_object_unreference_unlocked(gem);
T
Terje Bergstrom 已提交
493 494 495 496 497 498 499

	return 0;
}

static int tegra_syncpt_read(struct drm_device *drm, void *data,
			     struct drm_file *file)
{
500
	struct host1x *host = dev_get_drvdata(drm->dev->parent);
T
Terje Bergstrom 已提交
501
	struct drm_tegra_syncpt_read *args = data;
502
	struct host1x_syncpt *sp;
T
Terje Bergstrom 已提交
503

504
	sp = host1x_syncpt_get(host, args->id);
T
Terje Bergstrom 已提交
505 506 507 508 509 510 511 512 513 514
	if (!sp)
		return -EINVAL;

	args->value = host1x_syncpt_read_min(sp);
	return 0;
}

static int tegra_syncpt_incr(struct drm_device *drm, void *data,
			     struct drm_file *file)
{
515
	struct host1x *host1x = dev_get_drvdata(drm->dev->parent);
T
Terje Bergstrom 已提交
516
	struct drm_tegra_syncpt_incr *args = data;
517
	struct host1x_syncpt *sp;
T
Terje Bergstrom 已提交
518

519
	sp = host1x_syncpt_get(host1x, args->id);
T
Terje Bergstrom 已提交
520 521 522
	if (!sp)
		return -EINVAL;

523
	return host1x_syncpt_incr(sp);
T
Terje Bergstrom 已提交
524 525 526 527 528
}

static int tegra_syncpt_wait(struct drm_device *drm, void *data,
			     struct drm_file *file)
{
529
	struct host1x *host1x = dev_get_drvdata(drm->dev->parent);
T
Terje Bergstrom 已提交
530
	struct drm_tegra_syncpt_wait *args = data;
531
	struct host1x_syncpt *sp;
T
Terje Bergstrom 已提交
532

533
	sp = host1x_syncpt_get(host1x, args->id);
T
Terje Bergstrom 已提交
534 535 536 537 538 539 540
	if (!sp)
		return -EINVAL;

	return host1x_syncpt_wait(sp, args->thresh, args->timeout,
				  &args->value);
}

541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562
static int tegra_client_open(struct tegra_drm_file *fpriv,
			     struct tegra_drm_client *client,
			     struct tegra_drm_context *context)
{
	int err;

	err = client->ops->open_channel(client, context);
	if (err < 0)
		return err;

	err = idr_alloc(&fpriv->contexts, context, 0, 0, GFP_KERNEL);
	if (err < 0) {
		client->ops->close_channel(context);
		return err;
	}

	context->client = client;
	context->id = err;

	return 0;
}

T
Terje Bergstrom 已提交
563 564 565
static int tegra_open_channel(struct drm_device *drm, void *data,
			      struct drm_file *file)
{
566
	struct tegra_drm_file *fpriv = file->driver_priv;
567
	struct tegra_drm *tegra = drm->dev_private;
T
Terje Bergstrom 已提交
568
	struct drm_tegra_open_channel *args = data;
569
	struct tegra_drm_context *context;
570
	struct tegra_drm_client *client;
T
Terje Bergstrom 已提交
571 572 573 574 575 576
	int err = -ENODEV;

	context = kzalloc(sizeof(*context), GFP_KERNEL);
	if (!context)
		return -ENOMEM;

577 578
	mutex_lock(&fpriv->lock);

579
	list_for_each_entry(client, &tegra->clients, list)
580
		if (client->base.class == args->client) {
581 582
			err = tegra_client_open(fpriv, client, context);
			if (err < 0)
T
Terje Bergstrom 已提交
583 584
				break;

585 586
			args->context = context->id;
			break;
T
Terje Bergstrom 已提交
587 588
		}

589 590 591 592
	if (err < 0)
		kfree(context);

	mutex_unlock(&fpriv->lock);
T
Terje Bergstrom 已提交
593 594 595 596 597 598
	return err;
}

static int tegra_close_channel(struct drm_device *drm, void *data,
			       struct drm_file *file)
{
599
	struct tegra_drm_file *fpriv = file->driver_priv;
600
	struct drm_tegra_close_channel *args = data;
601
	struct tegra_drm_context *context;
602
	int err = 0;
603

604
	mutex_lock(&fpriv->lock);
T
Terje Bergstrom 已提交
605

606 607 608 609 610
	context = tegra_drm_file_get_context(fpriv, args->context);
	if (!context) {
		err = -EINVAL;
		goto unlock;
	}
T
Terje Bergstrom 已提交
611

612
	idr_remove(&fpriv->contexts, context->id);
613
	tegra_drm_context_free(context);
T
Terje Bergstrom 已提交
614

615 616 617
unlock:
	mutex_unlock(&fpriv->lock);
	return err;
T
Terje Bergstrom 已提交
618 619 620 621 622
}

static int tegra_get_syncpt(struct drm_device *drm, void *data,
			    struct drm_file *file)
{
623
	struct tegra_drm_file *fpriv = file->driver_priv;
T
Terje Bergstrom 已提交
624
	struct drm_tegra_get_syncpt *args = data;
625
	struct tegra_drm_context *context;
T
Terje Bergstrom 已提交
626
	struct host1x_syncpt *syncpt;
627
	int err = 0;
T
Terje Bergstrom 已提交
628

629
	mutex_lock(&fpriv->lock);
630

631 632 633 634 635
	context = tegra_drm_file_get_context(fpriv, args->context);
	if (!context) {
		err = -ENODEV;
		goto unlock;
	}
T
Terje Bergstrom 已提交
636

637 638 639 640
	if (args->index >= context->client->base.num_syncpts) {
		err = -EINVAL;
		goto unlock;
	}
T
Terje Bergstrom 已提交
641

642
	syncpt = context->client->base.syncpts[args->index];
T
Terje Bergstrom 已提交
643 644
	args->id = host1x_syncpt_id(syncpt);

645 646 647
unlock:
	mutex_unlock(&fpriv->lock);
	return err;
T
Terje Bergstrom 已提交
648 649 650 651 652
}

static int tegra_submit(struct drm_device *drm, void *data,
			struct drm_file *file)
{
653
	struct tegra_drm_file *fpriv = file->driver_priv;
T
Terje Bergstrom 已提交
654
	struct drm_tegra_submit *args = data;
655
	struct tegra_drm_context *context;
656
	int err;
657

658
	mutex_lock(&fpriv->lock);
T
Terje Bergstrom 已提交
659

660 661 662 663 664
	context = tegra_drm_file_get_context(fpriv, args->context);
	if (!context) {
		err = -ENODEV;
		goto unlock;
	}
T
Terje Bergstrom 已提交
665

666
	err = context->client->ops->submit(context, args, drm, file);
T
Terje Bergstrom 已提交
667

668 669 670
unlock:
	mutex_unlock(&fpriv->lock);
	return err;
T
Terje Bergstrom 已提交
671
}
672 673 674 675 676 677 678 679 680

static int tegra_get_syncpt_base(struct drm_device *drm, void *data,
				 struct drm_file *file)
{
	struct tegra_drm_file *fpriv = file->driver_priv;
	struct drm_tegra_get_syncpt_base *args = data;
	struct tegra_drm_context *context;
	struct host1x_syncpt_base *base;
	struct host1x_syncpt *syncpt;
681
	int err = 0;
682

683
	mutex_lock(&fpriv->lock);
684

685 686 687 688 689
	context = tegra_drm_file_get_context(fpriv, args->context);
	if (!context) {
		err = -ENODEV;
		goto unlock;
	}
690

691 692 693 694
	if (args->syncpt >= context->client->base.num_syncpts) {
		err = -EINVAL;
		goto unlock;
	}
695 696 697 698

	syncpt = context->client->base.syncpts[args->syncpt];

	base = host1x_syncpt_get_base(syncpt);
699 700 701 702
	if (!base) {
		err = -ENXIO;
		goto unlock;
	}
703 704 705

	args->id = host1x_syncpt_base_id(base);

706 707 708
unlock:
	mutex_unlock(&fpriv->lock);
	return err;
709
}
710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749

static int tegra_gem_set_tiling(struct drm_device *drm, void *data,
				struct drm_file *file)
{
	struct drm_tegra_gem_set_tiling *args = data;
	enum tegra_bo_tiling_mode mode;
	struct drm_gem_object *gem;
	unsigned long value = 0;
	struct tegra_bo *bo;

	switch (args->mode) {
	case DRM_TEGRA_GEM_TILING_MODE_PITCH:
		mode = TEGRA_BO_TILING_MODE_PITCH;

		if (args->value != 0)
			return -EINVAL;

		break;

	case DRM_TEGRA_GEM_TILING_MODE_TILED:
		mode = TEGRA_BO_TILING_MODE_TILED;

		if (args->value != 0)
			return -EINVAL;

		break;

	case DRM_TEGRA_GEM_TILING_MODE_BLOCK:
		mode = TEGRA_BO_TILING_MODE_BLOCK;

		if (args->value > 5)
			return -EINVAL;

		value = args->value;
		break;

	default:
		return -EINVAL;
	}

750
	gem = drm_gem_object_lookup(file, args->handle);
751 752 753 754 755 756 757 758
	if (!gem)
		return -ENOENT;

	bo = to_tegra_bo(gem);

	bo->tiling.mode = mode;
	bo->tiling.value = value;

759
	drm_gem_object_unreference_unlocked(gem);
760 761 762 763 764 765 766 767 768 769 770 771

	return 0;
}

static int tegra_gem_get_tiling(struct drm_device *drm, void *data,
				struct drm_file *file)
{
	struct drm_tegra_gem_get_tiling *args = data;
	struct drm_gem_object *gem;
	struct tegra_bo *bo;
	int err = 0;

772
	gem = drm_gem_object_lookup(file, args->handle);
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
	if (!gem)
		return -ENOENT;

	bo = to_tegra_bo(gem);

	switch (bo->tiling.mode) {
	case TEGRA_BO_TILING_MODE_PITCH:
		args->mode = DRM_TEGRA_GEM_TILING_MODE_PITCH;
		args->value = 0;
		break;

	case TEGRA_BO_TILING_MODE_TILED:
		args->mode = DRM_TEGRA_GEM_TILING_MODE_TILED;
		args->value = 0;
		break;

	case TEGRA_BO_TILING_MODE_BLOCK:
		args->mode = DRM_TEGRA_GEM_TILING_MODE_BLOCK;
		args->value = bo->tiling.value;
		break;

	default:
		err = -EINVAL;
		break;
	}

799
	drm_gem_object_unreference_unlocked(gem);
800 801 802

	return err;
}
803 804 805 806 807 808 809 810 811 812 813

static int tegra_gem_set_flags(struct drm_device *drm, void *data,
			       struct drm_file *file)
{
	struct drm_tegra_gem_set_flags *args = data;
	struct drm_gem_object *gem;
	struct tegra_bo *bo;

	if (args->flags & ~DRM_TEGRA_GEM_FLAGS)
		return -EINVAL;

814
	gem = drm_gem_object_lookup(file, args->handle);
815 816 817 818 819 820 821 822 823
	if (!gem)
		return -ENOENT;

	bo = to_tegra_bo(gem);
	bo->flags = 0;

	if (args->flags & DRM_TEGRA_GEM_BOTTOM_UP)
		bo->flags |= TEGRA_BO_BOTTOM_UP;

824
	drm_gem_object_unreference_unlocked(gem);
825 826 827 828 829 830 831 832 833 834 835

	return 0;
}

static int tegra_gem_get_flags(struct drm_device *drm, void *data,
			       struct drm_file *file)
{
	struct drm_tegra_gem_get_flags *args = data;
	struct drm_gem_object *gem;
	struct tegra_bo *bo;

836
	gem = drm_gem_object_lookup(file, args->handle);
837 838 839 840 841 842 843 844 845
	if (!gem)
		return -ENOENT;

	bo = to_tegra_bo(gem);
	args->flags = 0;

	if (bo->flags & TEGRA_BO_BOTTOM_UP)
		args->flags |= DRM_TEGRA_GEM_BOTTOM_UP;

846
	drm_gem_object_unreference_unlocked(gem);
847 848 849

	return 0;
}
T
Terje Bergstrom 已提交
850 851
#endif

R
Rob Clark 已提交
852
static const struct drm_ioctl_desc tegra_drm_ioctls[] = {
T
Terje Bergstrom 已提交
853
#ifdef CONFIG_DRM_TEGRA_STAGING
854 855 856 857 858 859 860 861 862 863 864 865 866 867
	DRM_IOCTL_DEF_DRV(TEGRA_GEM_CREATE, tegra_gem_create, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GEM_MMAP, tegra_gem_mmap, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_SYNCPT_READ, tegra_syncpt_read, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_SYNCPT_INCR, tegra_syncpt_incr, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_SYNCPT_WAIT, tegra_syncpt_wait, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_OPEN_CHANNEL, tegra_open_channel, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_CLOSE_CHANNEL, tegra_close_channel, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GET_SYNCPT, tegra_get_syncpt, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_SUBMIT, tegra_submit, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GET_SYNCPT_BASE, tegra_get_syncpt_base, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GEM_SET_TILING, tegra_gem_set_tiling, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GEM_GET_TILING, tegra_gem_get_tiling, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GEM_SET_FLAGS, tegra_gem_set_flags, 0),
	DRM_IOCTL_DEF_DRV(TEGRA_GEM_GET_FLAGS, tegra_gem_get_flags, 0),
T
Terje Bergstrom 已提交
868
#endif
T
Thierry Reding 已提交
869 870 871 872 873 874 875
};

static const struct file_operations tegra_drm_fops = {
	.owner = THIS_MODULE,
	.open = drm_open,
	.release = drm_release,
	.unlocked_ioctl = drm_ioctl,
876
	.mmap = tegra_drm_mmap,
T
Thierry Reding 已提交
877 878 879 880 881 882
	.poll = drm_poll,
	.read = drm_read,
	.compat_ioctl = drm_compat_ioctl,
	.llseek = noop_llseek,
};

883 884 885 886 887 888 889 890 891
static int tegra_drm_context_cleanup(int id, void *p, void *data)
{
	struct tegra_drm_context *context = p;

	tegra_drm_context_free(context);

	return 0;
}

D
Daniel Vetter 已提交
892
static void tegra_drm_postclose(struct drm_device *drm, struct drm_file *file)
893
{
894
	struct tegra_drm_file *fpriv = file->driver_priv;
895

896 897 898
	mutex_lock(&fpriv->lock);
	idr_for_each(&fpriv->contexts, tegra_drm_context_cleanup, NULL);
	mutex_unlock(&fpriv->lock);
T
Terje Bergstrom 已提交
899

900 901
	idr_destroy(&fpriv->contexts);
	mutex_destroy(&fpriv->lock);
T
Terje Bergstrom 已提交
902
	kfree(fpriv);
903 904
}

905 906 907 908 909 910 911 912 913 914 915
#ifdef CONFIG_DEBUG_FS
static int tegra_debugfs_framebuffers(struct seq_file *s, void *data)
{
	struct drm_info_node *node = (struct drm_info_node *)s->private;
	struct drm_device *drm = node->minor->dev;
	struct drm_framebuffer *fb;

	mutex_lock(&drm->mode_config.fb_lock);

	list_for_each_entry(fb, &drm->mode_config.fb_list, head) {
		seq_printf(s, "%3d: user size: %d x %d, depth %d, %d bpp, refcount %d\n",
V
Ville Syrjälä 已提交
916 917
			   fb->base.id, fb->width, fb->height,
			   fb->format->depth,
V
Ville Syrjälä 已提交
918
			   fb->format->cpp[0] * 8,
919
			   drm_framebuffer_read_refcount(fb));
920 921 922 923 924 925 926
	}

	mutex_unlock(&drm->mode_config.fb_lock);

	return 0;
}

927 928 929 930 931
static int tegra_debugfs_iova(struct seq_file *s, void *data)
{
	struct drm_info_node *node = (struct drm_info_node *)s->private;
	struct drm_device *drm = node->minor->dev;
	struct tegra_drm *tegra = drm->dev_private;
D
Daniel Vetter 已提交
932
	struct drm_printer p = drm_seq_file_printer(s);
933

934
	mutex_lock(&tegra->mm_lock);
D
Daniel Vetter 已提交
935
	drm_mm_print(&tegra->mm, &p);
936
	mutex_unlock(&tegra->mm_lock);
D
Daniel Vetter 已提交
937 938

	return 0;
939 940
}

941 942
static struct drm_info_list tegra_debugfs_list[] = {
	{ "framebuffers", tegra_debugfs_framebuffers, 0 },
943
	{ "iova", tegra_debugfs_iova, 0 },
944 945 946 947 948 949 950 951 952 953
};

static int tegra_debugfs_init(struct drm_minor *minor)
{
	return drm_debugfs_create_files(tegra_debugfs_list,
					ARRAY_SIZE(tegra_debugfs_list),
					minor->debugfs_root, minor);
}
#endif

954
static struct drm_driver tegra_drm_driver = {
955 956
	.driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME |
			   DRIVER_ATOMIC,
T
Thierry Reding 已提交
957 958 959
	.load = tegra_drm_load,
	.unload = tegra_drm_unload,
	.open = tegra_drm_open,
D
Daniel Vetter 已提交
960
	.postclose = tegra_drm_postclose,
T
Thierry Reding 已提交
961 962
	.lastclose = tegra_drm_lastclose,

963 964 965 966
#if defined(CONFIG_DEBUG_FS)
	.debugfs_init = tegra_debugfs_init,
#endif

967
	.gem_free_object_unlocked = tegra_bo_free_object,
968
	.gem_vm_ops = &tegra_bo_vm_ops,
T
Thierry Reding 已提交
969 970 971 972 973 974

	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
	.gem_prime_export = tegra_gem_prime_export,
	.gem_prime_import = tegra_gem_prime_import,

975 976
	.dumb_create = tegra_bo_dumb_create,
	.dumb_map_offset = tegra_bo_dumb_map_offset,
977
	.dumb_destroy = drm_gem_dumb_destroy,
T
Thierry Reding 已提交
978 979 980 981 982 983 984 985 986 987 988 989

	.ioctls = tegra_drm_ioctls,
	.num_ioctls = ARRAY_SIZE(tegra_drm_ioctls),
	.fops = &tegra_drm_fops,

	.name = DRIVER_NAME,
	.desc = DRIVER_DESC,
	.date = DRIVER_DATE,
	.major = DRIVER_MAJOR,
	.minor = DRIVER_MINOR,
	.patchlevel = DRIVER_PATCHLEVEL,
};
990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010

int tegra_drm_register_client(struct tegra_drm *tegra,
			      struct tegra_drm_client *client)
{
	mutex_lock(&tegra->clients_lock);
	list_add_tail(&client->list, &tegra->clients);
	mutex_unlock(&tegra->clients_lock);

	return 0;
}

int tegra_drm_unregister_client(struct tegra_drm *tegra,
				struct tegra_drm_client *client)
{
	mutex_lock(&tegra->clients_lock);
	list_del_init(&client->list);
	mutex_unlock(&tegra->clients_lock);

	return 0;
}

1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088
void *tegra_drm_alloc(struct tegra_drm *tegra, size_t size,
			      dma_addr_t *dma)
{
	struct iova *alloc;
	void *virt;
	gfp_t gfp;
	int err;

	if (tegra->domain)
		size = iova_align(&tegra->carveout.domain, size);
	else
		size = PAGE_ALIGN(size);

	gfp = GFP_KERNEL | __GFP_ZERO;
	if (!tegra->domain) {
		/*
		 * Many units only support 32-bit addresses, even on 64-bit
		 * SoCs. If there is no IOMMU to translate into a 32-bit IO
		 * virtual address space, force allocations to be in the
		 * lower 32-bit range.
		 */
		gfp |= GFP_DMA;
	}

	virt = (void *)__get_free_pages(gfp, get_order(size));
	if (!virt)
		return ERR_PTR(-ENOMEM);

	if (!tegra->domain) {
		/*
		 * If IOMMU is disabled, devices address physical memory
		 * directly.
		 */
		*dma = virt_to_phys(virt);
		return virt;
	}

	alloc = alloc_iova(&tegra->carveout.domain,
			   size >> tegra->carveout.shift,
			   tegra->carveout.limit, true);
	if (!alloc) {
		err = -EBUSY;
		goto free_pages;
	}

	*dma = iova_dma_addr(&tegra->carveout.domain, alloc);
	err = iommu_map(tegra->domain, *dma, virt_to_phys(virt),
			size, IOMMU_READ | IOMMU_WRITE);
	if (err < 0)
		goto free_iova;

	return virt;

free_iova:
	__free_iova(&tegra->carveout.domain, alloc);
free_pages:
	free_pages((unsigned long)virt, get_order(size));

	return ERR_PTR(err);
}

void tegra_drm_free(struct tegra_drm *tegra, size_t size, void *virt,
		    dma_addr_t dma)
{
	if (tegra->domain)
		size = iova_align(&tegra->carveout.domain, size);
	else
		size = PAGE_ALIGN(size);

	if (tegra->domain) {
		iommu_unmap(tegra->domain, dma, size);
		free_iova(&tegra->carveout.domain,
			  iova_pfn(&tegra->carveout.domain, dma));
	}

	free_pages((unsigned long)virt, get_order(size));
}

1089
static int host1x_drm_probe(struct host1x_device *dev)
1090
{
1091 1092 1093 1094 1095
	struct drm_driver *driver = &tegra_drm_driver;
	struct drm_device *drm;
	int err;

	drm = drm_dev_alloc(driver, &dev->dev);
1096 1097
	if (IS_ERR(drm))
		return PTR_ERR(drm);
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109

	dev_set_drvdata(&dev->dev, drm);

	err = drm_dev_register(drm, 0);
	if (err < 0)
		goto unref;

	return 0;

unref:
	drm_dev_unref(drm);
	return err;
1110 1111
}

1112
static int host1x_drm_remove(struct host1x_device *dev)
1113
{
1114 1115 1116 1117
	struct drm_device *drm = dev_get_drvdata(&dev->dev);

	drm_dev_unregister(drm);
	drm_dev_unref(drm);
1118 1119 1120 1121

	return 0;
}

1122 1123 1124 1125
#ifdef CONFIG_PM_SLEEP
static int host1x_drm_suspend(struct device *dev)
{
	struct drm_device *drm = dev_get_drvdata(dev);
1126
	struct tegra_drm *tegra = drm->dev_private;
1127 1128

	drm_kms_helper_poll_disable(drm);
1129 1130 1131 1132 1133 1134 1135 1136
	tegra_drm_fb_suspend(drm);

	tegra->state = drm_atomic_helper_suspend(drm);
	if (IS_ERR(tegra->state)) {
		tegra_drm_fb_resume(drm);
		drm_kms_helper_poll_enable(drm);
		return PTR_ERR(tegra->state);
	}
1137 1138 1139 1140 1141 1142 1143

	return 0;
}

static int host1x_drm_resume(struct device *dev)
{
	struct drm_device *drm = dev_get_drvdata(dev);
1144
	struct tegra_drm *tegra = drm->dev_private;
1145

1146 1147
	drm_atomic_helper_resume(drm, tegra->state);
	tegra_drm_fb_resume(drm);
1148 1149 1150 1151 1152 1153
	drm_kms_helper_poll_enable(drm);

	return 0;
}
#endif

1154 1155
static SIMPLE_DEV_PM_OPS(host1x_drm_pm_ops, host1x_drm_suspend,
			 host1x_drm_resume);
1156

1157 1158 1159 1160
static const struct of_device_id host1x_drm_subdevs[] = {
	{ .compatible = "nvidia,tegra20-dc", },
	{ .compatible = "nvidia,tegra20-hdmi", },
	{ .compatible = "nvidia,tegra20-gr2d", },
T
Thierry Reding 已提交
1161
	{ .compatible = "nvidia,tegra20-gr3d", },
1162 1163 1164
	{ .compatible = "nvidia,tegra30-dc", },
	{ .compatible = "nvidia,tegra30-hdmi", },
	{ .compatible = "nvidia,tegra30-gr2d", },
T
Thierry Reding 已提交
1165
	{ .compatible = "nvidia,tegra30-gr3d", },
T
Thierry Reding 已提交
1166
	{ .compatible = "nvidia,tegra114-dsi", },
1167
	{ .compatible = "nvidia,tegra114-hdmi", },
T
Thierry Reding 已提交
1168
	{ .compatible = "nvidia,tegra114-gr3d", },
1169
	{ .compatible = "nvidia,tegra124-dc", },
T
Thierry Reding 已提交
1170
	{ .compatible = "nvidia,tegra124-sor", },
1171
	{ .compatible = "nvidia,tegra124-hdmi", },
1172
	{ .compatible = "nvidia,tegra124-dsi", },
A
Arto Merilainen 已提交
1173
	{ .compatible = "nvidia,tegra124-vic", },
1174
	{ .compatible = "nvidia,tegra132-dsi", },
1175
	{ .compatible = "nvidia,tegra210-dc", },
1176
	{ .compatible = "nvidia,tegra210-dsi", },
1177
	{ .compatible = "nvidia,tegra210-sor", },
1178
	{ .compatible = "nvidia,tegra210-sor1", },
A
Arto Merilainen 已提交
1179
	{ .compatible = "nvidia,tegra210-vic", },
1180 1181 1182 1183
	{ /* sentinel */ }
};

static struct host1x_driver host1x_drm_driver = {
1184 1185
	.driver = {
		.name = "drm",
1186
		.pm = &host1x_drm_pm_ops,
1187
	},
1188 1189 1190 1191 1192
	.probe = host1x_drm_probe,
	.remove = host1x_drm_remove,
	.subdevs = host1x_drm_subdevs,
};

1193 1194 1195 1196 1197 1198 1199 1200
static struct platform_driver * const drivers[] = {
	&tegra_dc_driver,
	&tegra_hdmi_driver,
	&tegra_dsi_driver,
	&tegra_dpaux_driver,
	&tegra_sor_driver,
	&tegra_gr2d_driver,
	&tegra_gr3d_driver,
A
Arto Merilainen 已提交
1201
	&tegra_vic_driver,
1202 1203
};

1204 1205 1206 1207 1208 1209 1210 1211
static int __init host1x_drm_init(void)
{
	int err;

	err = host1x_driver_register(&host1x_drm_driver);
	if (err < 0)
		return err;

1212
	err = platform_register_drivers(drivers, ARRAY_SIZE(drivers));
1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225
	if (err < 0)
		goto unregister_host1x;

	return 0;

unregister_host1x:
	host1x_driver_unregister(&host1x_drm_driver);
	return err;
}
module_init(host1x_drm_init);

static void __exit host1x_drm_exit(void)
{
1226
	platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
1227 1228 1229 1230 1231 1232 1233
	host1x_driver_unregister(&host1x_drm_driver);
}
module_exit(host1x_drm_exit);

MODULE_AUTHOR("Thierry Reding <thierry.reding@avionic-design.de>");
MODULE_DESCRIPTION("NVIDIA Tegra DRM driver");
MODULE_LICENSE("GPL v2");