drm_irq.c 55.6 KB
Newer Older
D
Daniel Vetter 已提交
1 2
/*
 * drm_irq.c IRQ and vblank support
L
Linus Torvalds 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
 *
 * \author Rickard E. (Rik) Faith <faith@valinux.com>
 * \author Gareth Hughes <gareth@valinux.com>
 */

/*
 * Created: Fri Mar 19 14:30:16 1999 by faith@valinux.com
 *
 * Copyright 1999, 2000 Precision Insight, Inc., Cedar Park, Texas.
 * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
 * All Rights Reserved.
 *
 * 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 (including the next
 * paragraph) 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
 * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS 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.
 */

35
#include <drm/drmP.h>
J
Jesse Barnes 已提交
36
#include "drm_trace.h"
37
#include "drm_internal.h"
L
Linus Torvalds 已提交
38 39

#include <linux/interrupt.h>	/* For task queue support */
40
#include <linux/slab.h>
L
Linus Torvalds 已提交
41

42
#include <linux/vgaarb.h>
43
#include <linux/export.h>
44 45

/* Access macro for slots in vblank timestamp ringbuffer. */
46 47
#define vblanktimestamp(dev, pipe, count) \
	((dev)->vblank[pipe].time[(count) % DRM_VBLANKTIME_RBSIZE])
48 49 50 51 52 53 54 55 56 57 58

/* Retry timestamp calculation up to 3 times to satisfy
 * drm_timestamp_precision before giving up.
 */
#define DRM_TIMESTAMP_MAXRETRIES 3

/* Threshold in nanoseconds for detection of redundant
 * vblank irq in drm_handle_vblank(). 1 msec should be ok.
 */
#define DRM_REDUNDANT_VBLIRQ_THRESH_NS 1000000

59
static bool
60
drm_get_last_vbltimestamp(struct drm_device *dev, unsigned int pipe,
61 62
			  struct timeval *tvblank, unsigned flags);

63 64 65 66 67 68 69 70 71 72 73 74 75
static unsigned int drm_timestamp_precision = 20;  /* Default to 20 usecs. */

/*
 * Default to use monotonic timestamps for wait-for-vblank and page-flip
 * complete events.
 */
unsigned int drm_timestamp_monotonic = 1;

static int drm_vblank_offdelay = 5000;    /* Default to 5000 msecs. */

module_param_named(vblankoffdelay, drm_vblank_offdelay, int, 0600);
module_param_named(timestamp_precision_usec, drm_timestamp_precision, int, 0600);
module_param_named(timestamp_monotonic, drm_timestamp_monotonic, int, 0600);
76 77 78
MODULE_PARM_DESC(vblankoffdelay, "Delay until vblank irq auto-disable [msecs] (0: never disable, <0: disable immediately)");
MODULE_PARM_DESC(timestamp_precision_usec, "Max. error on timestamps [usecs]");
MODULE_PARM_DESC(timestamp_monotonic, "Use monotonic timestamps");
79

80
static void store_vblank(struct drm_device *dev, unsigned int pipe,
81
			 u32 vblank_count_inc,
82
			 struct timeval *t_vblank, u32 last)
83
{
84
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
85 86 87 88
	u32 tslot;

	assert_spin_locked(&dev->vblank_time_lock);

89 90
	vblank->last = last;

91 92 93 94 95
	/* All writers hold the spinlock, but readers are serialized by
	 * the latching of vblank->count below.
	 */
	tslot = vblank->count + vblank_count_inc;
	vblanktimestamp(dev, pipe, tslot) = *t_vblank;
96 97 98 99 100 101 102 103 104 105 106 107 108 109

	/*
	 * vblank timestamp updates are protected on the write side with
	 * vblank_time_lock, but on the read side done locklessly using a
	 * sequence-lock on the vblank counter. Ensure correct ordering using
	 * memory barrriers. We need the barrier both before and also after the
	 * counter update to synchronize with the next timestamp write.
	 * The read-side barriers for this are in drm_vblank_count_and_time.
	 */
	smp_wmb();
	vblank->count += vblank_count_inc;
	smp_wmb();
}

110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157
/**
 * drm_reset_vblank_timestamp - reset the last timestamp to the last vblank
 * @dev: DRM device
 * @pipe: index of CRTC for which to reset the timestamp
 *
 * Reset the stored timestamp for the current vblank count to correspond
 * to the last vblank occurred.
 *
 * Only to be called from drm_vblank_on().
 *
 * Note: caller must hold dev->vbl_lock since this reads & writes
 * device vblank fields.
 */
static void drm_reset_vblank_timestamp(struct drm_device *dev, unsigned int pipe)
{
	u32 cur_vblank;
	bool rc;
	struct timeval t_vblank;
	int count = DRM_TIMESTAMP_MAXRETRIES;

	spin_lock(&dev->vblank_time_lock);

	/*
	 * sample the current counter to avoid random jumps
	 * when drm_vblank_enable() applies the diff
	 */
	do {
		cur_vblank = dev->driver->get_vblank_counter(dev, pipe);
		rc = drm_get_last_vbltimestamp(dev, pipe, &t_vblank, 0);
	} while (cur_vblank != dev->driver->get_vblank_counter(dev, pipe) && --count > 0);

	/*
	 * Only reinitialize corresponding vblank timestamp if high-precision query
	 * available and didn't fail. Otherwise reinitialize delayed at next vblank
	 * interrupt and assign 0 for now, to mark the vblanktimestamp as invalid.
	 */
	if (!rc)
		t_vblank = (struct timeval) {0, 0};

	/*
	 * +1 to make sure user will never see the same
	 * vblank counter value before and after a modeset
	 */
	store_vblank(dev, pipe, 1, &t_vblank, cur_vblank);

	spin_unlock(&dev->vblank_time_lock);
}

158 159 160
/**
 * drm_update_vblank_count - update the master vblank counter
 * @dev: DRM device
161
 * @pipe: counter to update
162 163
 *
 * Call back into the driver to update the appropriate vblank counter
164
 * (specified by @pipe).  Deal with wraparound, if it occurred, and
165 166 167 168 169 170 171 172 173
 * update the last read value so we can deal with wraparound on the next
 * call if necessary.
 *
 * Only necessary when going from off->on, to account for frames we
 * didn't get an interrupt for.
 *
 * Note: caller must hold dev->vbl_lock since this reads & writes
 * device vblank fields.
 */
174 175
static void drm_update_vblank_count(struct drm_device *dev, unsigned int pipe,
				    unsigned long flags)
176
{
177
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
178
	u32 cur_vblank, diff;
179
	bool rc;
180
	struct timeval t_vblank;
181
	int count = DRM_TIMESTAMP_MAXRETRIES;
182
	int framedur_ns = vblank->framedur_ns;
183 184 185 186

	/*
	 * Interrupts were disabled prior to this call, so deal with counter
	 * wrap if needed.
187
	 * NOTE!  It's possible we lost a full dev->max_vblank_count + 1 events
188 189 190 191 192 193 194 195 196
	 * here if the register is small or we had vblank interrupts off for
	 * a long time.
	 *
	 * We repeat the hardware vblank counter & timestamp query until
	 * we get consistent results. This to prevent races between gpu
	 * updating its hardware counter while we are retrieving the
	 * corresponding vblank timestamp.
	 */
	do {
197
		cur_vblank = dev->driver->get_vblank_counter(dev, pipe);
198
		rc = drm_get_last_vbltimestamp(dev, pipe, &t_vblank, flags);
199
	} while (cur_vblank != dev->driver->get_vblank_counter(dev, pipe) && --count > 0);
200

201 202 203 204 205 206 207 208 209
	if (dev->max_vblank_count != 0) {
		/* trust the hw counter when it's around */
		diff = (cur_vblank - vblank->last) & dev->max_vblank_count;
	} else if (rc && framedur_ns) {
		const struct timeval *t_old;
		u64 diff_ns;

		t_old = &vblanktimestamp(dev, pipe, vblank->count);
		diff_ns = timeval_to_ns(&t_vblank) - timeval_to_ns(t_old);
210

211 212 213 214 215 216 217 218
		/*
		 * Figure out how many vblanks we've missed based
		 * on the difference in the timestamps and the
		 * frame/field duration.
		 */
		diff = DIV_ROUND_CLOSEST_ULL(diff_ns, framedur_ns);

		if (diff == 0 && flags & DRM_CALLED_FROM_VBLIRQ)
V
Ville Syrjälä 已提交
219 220 221
			DRM_DEBUG_VBL("crtc %u: Redundant vblirq ignored."
				      " diff_ns = %lld, framedur_ns = %d)\n",
				      pipe, (long long) diff_ns, framedur_ns);
222 223 224
	} else {
		/* some kind of default for drivers w/o accurate vbl timestamping */
		diff = (flags & DRM_CALLED_FROM_VBLIRQ) != 0;
225 226
	}

V
Ville Syrjälä 已提交
227 228 229
	DRM_DEBUG_VBL("updating vblank count on crtc %u:"
		      " current=%u, diff=%u, hw=%u hw_last=%u\n",
		      pipe, vblank->count, diff, cur_vblank, vblank->last);
230

231 232
	if (diff == 0) {
		WARN_ON_ONCE(cur_vblank != vblank->last);
233
		return;
234
	}
235

236 237
	/*
	 * Only reinitialize corresponding vblank timestamp if high-precision query
238 239 240
	 * available and didn't fail, or we were called from the vblank interrupt.
	 * Otherwise reinitialize delayed at next vblank interrupt and assign 0
	 * for now, to mark the vblanktimestamp as invalid.
241
	 */
242
	if (!rc && (flags & DRM_CALLED_FROM_VBLIRQ) == 0)
243 244
		t_vblank = (struct timeval) {0, 0};

245
	store_vblank(dev, pipe, diff, &t_vblank, cur_vblank);
246 247
}

248 249 250 251 252 253
/*
 * Disable vblank irq's on crtc, make sure that last vblank count
 * of hardware and corresponding consistent software vblank counter
 * are preserved, even if there are any spurious vblank irq's after
 * disable.
 */
254
static void vblank_disable_and_save(struct drm_device *dev, unsigned int pipe)
255
{
256
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
257 258 259 260 261 262 263 264
	unsigned long irqflags;

	/* Prevent vblank irq processing while disabling vblank irqs,
	 * so no updates of timestamps or count can happen after we've
	 * disabled. Needed to prevent races in case of delayed irq's.
	 */
	spin_lock_irqsave(&dev->vblank_time_lock, irqflags);

265 266 267 268 269 270
	/*
	 * Only disable vblank interrupts if they're enabled. This avoids
	 * calling the ->disable_vblank() operation in atomic context with the
	 * hardware potentially runtime suspended.
	 */
	if (vblank->enabled) {
271
		dev->driver->disable_vblank(dev, pipe);
272 273
		vblank->enabled = false;
	}
274

275 276 277 278 279
	/*
	 * Always update the count and timestamp to maintain the
	 * appearance that the counter has been ticking all along until
	 * this time. This makes the count account for the entire time
	 * between drm_vblank_on() and drm_vblank_off().
280
	 */
281
	drm_update_vblank_count(dev, pipe, 0);
282 283 284 285

	spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
}

286 287
static void vblank_disable_fn(unsigned long arg)
{
288 289
	struct drm_vblank_crtc *vblank = (void *)arg;
	struct drm_device *dev = vblank->dev;
290
	unsigned int pipe = vblank->pipe;
291 292 293 294 295
	unsigned long irqflags;

	if (!dev->vblank_disable_allowed)
		return;

296 297
	spin_lock_irqsave(&dev->vbl_lock, irqflags);
	if (atomic_read(&vblank->refcount) == 0 && vblank->enabled) {
298 299
		DRM_DEBUG("disabling vblank on crtc %u\n", pipe);
		vblank_disable_and_save(dev, pipe);
300
	}
301
	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
302 303
}

D
Daniel Vetter 已提交
304 305 306 307 308 309
/**
 * drm_vblank_cleanup - cleanup vblank support
 * @dev: DRM device
 *
 * This function cleans up any resources allocated in drm_vblank_init.
 */
310
void drm_vblank_cleanup(struct drm_device *dev)
311
{
312
	unsigned int pipe;
313

314 315 316 317
	/* Bail if the driver didn't call drm_vblank_init() */
	if (dev->num_crtcs == 0)
		return;

318 319
	for (pipe = 0; pipe < dev->num_crtcs; pipe++) {
		struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
320

321 322
		WARN_ON(vblank->enabled &&
			drm_core_check_feature(dev, DRIVER_MODESET));
323

324
		del_timer_sync(&vblank->disable_timer);
325
	}
326

327
	kfree(dev->vblank);
328 329 330

	dev->num_crtcs = 0;
}
331
EXPORT_SYMBOL(drm_vblank_cleanup);
332

D
Daniel Vetter 已提交
333 334
/**
 * drm_vblank_init - initialize vblank support
335 336
 * @dev: DRM device
 * @num_crtcs: number of CRTCs supported by @dev
D
Daniel Vetter 已提交
337 338 339 340 341 342
 *
 * This function initializes vblank support for @num_crtcs display pipelines.
 *
 * Returns:
 * Zero on success or a negative error code on failure.
 */
343
int drm_vblank_init(struct drm_device *dev, unsigned int num_crtcs)
344
{
345 346
	int ret = -ENOMEM;
	unsigned int i;
347 348

	spin_lock_init(&dev->vbl_lock);
349 350
	spin_lock_init(&dev->vblank_time_lock);

351 352
	dev->num_crtcs = num_crtcs;

353 354
	dev->vblank = kcalloc(num_crtcs, sizeof(*dev->vblank), GFP_KERNEL);
	if (!dev->vblank)
355 356
		goto err;

357
	for (i = 0; i < num_crtcs; i++) {
358 359 360
		struct drm_vblank_crtc *vblank = &dev->vblank[i];

		vblank->dev = dev;
361
		vblank->pipe = i;
362 363 364
		init_waitqueue_head(&vblank->queue);
		setup_timer(&vblank->disable_timer, vblank_disable_fn,
			    (unsigned long)vblank);
365
	}
366

367
	DRM_INFO("Supports vblank timestamp caching Rev 2 (21.10.2013).\n");
368 369 370 371 372 373 374

	/* Driver specific high-precision vblank timestamping supported? */
	if (dev->driver->get_vblank_timestamp)
		DRM_INFO("Driver supports precise vblank timestamp query.\n");
	else
		DRM_INFO("No driver support for vblank timestamp query.\n");

375 376 377 378 379 380 381
	/* Must have precise timestamping for reliable vblank instant disable */
	if (dev->vblank_disable_immediate && !dev->driver->get_vblank_timestamp) {
		dev->vblank_disable_immediate = false;
		DRM_INFO("Setting vblank_disable_immediate to false because "
			 "get_vblank_timestamp == NULL\n");
	}

382 383
	dev->vblank_disable_allowed = false;

384 385 386
	return 0;

err:
387
	dev->num_crtcs = 0;
388 389 390 391
	return ret;
}
EXPORT_SYMBOL(drm_vblank_init);

392 393 394 395 396 397 398 399 400 401 402 403
static void drm_irq_vgaarb_nokms(void *cookie, bool state)
{
	struct drm_device *dev = cookie;

	if (dev->driver->vgaarb_irq) {
		dev->driver->vgaarb_irq(dev, state);
		return;
	}

	if (!dev->irq_enabled)
		return;

404 405 406 407 408 409 410 411
	if (state) {
		if (dev->driver->irq_uninstall)
			dev->driver->irq_uninstall(dev);
	} else {
		if (dev->driver->irq_preinstall)
			dev->driver->irq_preinstall(dev);
		if (dev->driver->irq_postinstall)
			dev->driver->irq_postinstall(dev);
412 413 414
	}
}

L
Linus Torvalds 已提交
415
/**
D
Daniel Vetter 已提交
416 417 418
 * drm_irq_install - install IRQ handler
 * @dev: DRM device
 * @irq: IRQ number to install the handler for
L
Linus Torvalds 已提交
419
 *
420
 * Initializes the IRQ related data. Installs the handler, calling the driver
D
Daniel Vetter 已提交
421 422 423 424 425 426 427 428 429 430
 * irq_preinstall() and irq_postinstall() functions before and after the
 * installation.
 *
 * This is the simplified helper interface provided for drivers with no special
 * needs. Drivers which need to install interrupt handlers for multiple
 * interrupts must instead set drm_device->irq_enabled to signal the DRM core
 * that vblank interrupts are available.
 *
 * Returns:
 * Zero on success or a negative error code on failure.
L
Linus Torvalds 已提交
431
 */
432
int drm_irq_install(struct drm_device *dev, int irq)
L
Linus Torvalds 已提交
433
{
434
	int ret;
D
Dave Airlie 已提交
435
	unsigned long sh_flags = 0;
L
Linus Torvalds 已提交
436 437 438 439

	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
		return -EINVAL;

440
	if (irq == 0)
L
Linus Torvalds 已提交
441 442 443
		return -EINVAL;

	/* Driver must have been initialized */
444
	if (!dev->dev_private)
L
Linus Torvalds 已提交
445 446
		return -EINVAL;

447
	if (dev->irq_enabled)
L
Linus Torvalds 已提交
448
		return -EBUSY;
V
Ville Syrjälä 已提交
449
	dev->irq_enabled = true;
L
Linus Torvalds 已提交
450

451
	DRM_DEBUG("irq=%d\n", irq);
L
Linus Torvalds 已提交
452

D
Dave Airlie 已提交
453
	/* Before installing handler */
454 455
	if (dev->driver->irq_preinstall)
		dev->driver->irq_preinstall(dev);
L
Linus Torvalds 已提交
456

D
Dave Airlie 已提交
457
	/* Install handler */
L
Linus Torvalds 已提交
458
	if (drm_core_check_feature(dev, DRIVER_IRQ_SHARED))
459
		sh_flags = IRQF_SHARED;
D
Dave Airlie 已提交
460

461
	ret = request_irq(irq, dev->driver->irq_handler,
D
Daniel Vetter 已提交
462
			  sh_flags, dev->driver->name, dev);
J
Jesse Barnes 已提交
463

D
Dave Airlie 已提交
464
	if (ret < 0) {
V
Ville Syrjälä 已提交
465
		dev->irq_enabled = false;
L
Linus Torvalds 已提交
466 467 468
		return ret;
	}

469 470 471
	if (!drm_core_check_feature(dev, DRIVER_MODESET))
		vga_client_register(dev->pdev, (void *)dev, drm_irq_vgaarb_nokms, NULL);

D
Dave Airlie 已提交
472
	/* After installing handler */
473 474 475
	if (dev->driver->irq_postinstall)
		ret = dev->driver->irq_postinstall(dev);

476
	if (ret < 0) {
V
Ville Syrjälä 已提交
477
		dev->irq_enabled = false;
478 479
		if (!drm_core_check_feature(dev, DRIVER_MODESET))
			vga_client_register(dev->pdev, NULL, NULL, NULL);
480 481 482
		free_irq(irq, dev);
	} else {
		dev->irq = irq;
483
	}
L
Linus Torvalds 已提交
484

485
	return ret;
L
Linus Torvalds 已提交
486
}
487
EXPORT_SYMBOL(drm_irq_install);
L
Linus Torvalds 已提交
488 489

/**
D
Daniel Vetter 已提交
490 491 492 493 494 495 496
 * drm_irq_uninstall - uninstall the IRQ handler
 * @dev: DRM device
 *
 * Calls the driver's irq_uninstall() function and unregisters the IRQ handler.
 * This should only be called by drivers which used drm_irq_install() to set up
 * their interrupt handler. Other drivers must only reset
 * drm_device->irq_enabled to false.
L
Linus Torvalds 已提交
497
 *
D
Daniel Vetter 已提交
498 499 500
 * Note that for kernel modesetting drivers it is a bug if this function fails.
 * The sanity checks are only to catch buggy user modesetting drivers which call
 * the same function through an ioctl.
L
Linus Torvalds 已提交
501
 *
D
Daniel Vetter 已提交
502 503
 * Returns:
 * Zero on success or a negative error code on failure.
L
Linus Torvalds 已提交
504
 */
505
int drm_irq_uninstall(struct drm_device *dev)
L
Linus Torvalds 已提交
506
{
507
	unsigned long irqflags;
V
Ville Syrjälä 已提交
508 509
	bool irq_enabled;
	int i;
L
Linus Torvalds 已提交
510 511 512 513 514

	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
		return -EINVAL;

	irq_enabled = dev->irq_enabled;
V
Ville Syrjälä 已提交
515
	dev->irq_enabled = false;
L
Linus Torvalds 已提交
516

517
	/*
518 519 520 521
	 * Wake up any waiters so they don't hang. This is just to paper over
	 * isssues for UMS drivers which aren't in full control of their
	 * vblank/irq handling. KMS drivers must ensure that vblanks are all
	 * disabled when uninstalling the irq handler.
522
	 */
523 524 525
	if (dev->num_crtcs) {
		spin_lock_irqsave(&dev->vbl_lock, irqflags);
		for (i = 0; i < dev->num_crtcs; i++) {
526 527
			struct drm_vblank_crtc *vblank = &dev->vblank[i];

528 529 530 531 532 533
			if (!vblank->enabled)
				continue;

			WARN_ON(drm_core_check_feature(dev, DRIVER_MODESET));

			vblank_disable_and_save(dev, i);
534
			wake_up(&vblank->queue);
535 536
		}
		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
537 538
	}

D
Dave Airlie 已提交
539
	if (!irq_enabled)
L
Linus Torvalds 已提交
540 541
		return -EINVAL;

542
	DRM_DEBUG("irq=%d\n", dev->irq);
L
Linus Torvalds 已提交
543

544 545 546
	if (!drm_core_check_feature(dev, DRIVER_MODESET))
		vga_client_register(dev->pdev, NULL, NULL, NULL);

547 548
	if (dev->driver->irq_uninstall)
		dev->driver->irq_uninstall(dev);
L
Linus Torvalds 已提交
549

550
	free_irq(dev->irq, dev);
L
Linus Torvalds 已提交
551 552 553 554 555

	return 0;
}
EXPORT_SYMBOL(drm_irq_uninstall);

D
Daniel Vetter 已提交
556
/*
L
Linus Torvalds 已提交
557 558 559
 * IRQ control ioctl.
 *
 * \param inode device inode.
560
 * \param file_priv DRM file private.
L
Linus Torvalds 已提交
561 562 563 564 565 566
 * \param cmd command.
 * \param arg user argument, pointing to a drm_control structure.
 * \return zero on success or a negative number on failure.
 *
 * Calls irq_install() or irq_uninstall() according to \p arg.
 */
567 568
int drm_control(struct drm_device *dev, void *data,
		struct drm_file *file_priv)
L
Linus Torvalds 已提交
569
{
570
	struct drm_control *ctl = data;
571
	int ret = 0, irq;
D
Dave Airlie 已提交
572

573 574 575
	/* if we haven't irq we fallback for compatibility reasons -
	 * this used to be a separate function in drm_dma.h
	 */
L
Linus Torvalds 已提交
576

577 578 579 580 581 582 583
	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
		return 0;
	if (drm_core_check_feature(dev, DRIVER_MODESET))
		return 0;
	/* UMS was only ever support on pci devices. */
	if (WARN_ON(!dev->pdev))
		return -EINVAL;
L
Linus Torvalds 已提交
584

585
	switch (ctl->func) {
L
Linus Torvalds 已提交
586
	case DRM_INST_HANDLER:
587 588
		irq = dev->pdev->irq;

L
Linus Torvalds 已提交
589
		if (dev->if_version < DRM_IF_VERSION(1, 2) &&
590
		    ctl->irq != irq)
L
Linus Torvalds 已提交
591
			return -EINVAL;
592
		mutex_lock(&dev->struct_mutex);
593
		ret = drm_irq_install(dev, irq);
594 595 596
		mutex_unlock(&dev->struct_mutex);

		return ret;
L
Linus Torvalds 已提交
597
	case DRM_UNINST_HANDLER:
598 599 600 601 602
		mutex_lock(&dev->struct_mutex);
		ret = drm_irq_uninstall(dev);
		mutex_unlock(&dev->struct_mutex);

		return ret;
L
Linus Torvalds 已提交
603 604 605 606 607
	default:
		return -EINVAL;
	}
}

608
/**
D
Daniel Vetter 已提交
609 610 611
 * drm_calc_timestamping_constants - calculate vblank timestamp constants
 * @crtc: drm_crtc whose timestamp constants should be updated.
 * @mode: display mode containing the scanout timings
612
 *
613 614 615
 * Calculate and store various constants which are later
 * needed by vblank and swap-completion timestamping, e.g,
 * by drm_calc_vbltimestamp_from_scanoutpos(). They are
D
Daniel Vetter 已提交
616
 * derived from CRTC's true scanout timing, so they take
617
 * things like panel scaling or other adjustments into account.
618
 */
619 620
void drm_calc_timestamping_constants(struct drm_crtc *crtc,
				     const struct drm_display_mode *mode)
621
{
622 623 624
	struct drm_device *dev = crtc->dev;
	unsigned int pipe = drm_crtc_index(crtc);
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
V
Ville Syrjälä 已提交
625
	int linedur_ns = 0, framedur_ns = 0;
626
	int dotclock = mode->crtc_clock;
627

628 629 630 631 632 633
	if (!dev->num_crtcs)
		return;

	if (WARN_ON(pipe >= dev->num_crtcs))
		return;

634 635
	/* Valid dotclock? */
	if (dotclock > 0) {
636 637 638 639
		int frame_size = mode->crtc_htotal * mode->crtc_vtotal;

		/*
		 * Convert scanline length in pixels and video
V
Ville Syrjälä 已提交
640 641
		 * dot clock to line duration and frame duration
		 * in nanoseconds:
642
		 */
643 644
		linedur_ns  = div_u64((u64) mode->crtc_htotal * 1000000, dotclock);
		framedur_ns = div_u64((u64) frame_size * 1000000, dotclock);
645 646 647 648 649 650

		/*
		 * Fields of interlaced scanout modes are only half a frame duration.
		 */
		if (mode->flags & DRM_MODE_FLAG_INTERLACE)
			framedur_ns /= 2;
651
	} else
652
		DRM_ERROR("crtc %u: Can't calculate constants, dotclock = 0!\n",
653 654
			  crtc->base.id);

655 656
	vblank->linedur_ns  = linedur_ns;
	vblank->framedur_ns = framedur_ns;
657

658
	DRM_DEBUG("crtc %u: hwmode: htotal %d, vtotal %d, vdisplay %d\n",
659 660
		  crtc->base.id, mode->crtc_htotal,
		  mode->crtc_vtotal, mode->crtc_vdisplay);
V
Ville Syrjälä 已提交
661 662
	DRM_DEBUG("crtc %u: clock %d kHz framedur %d linedur %d\n",
		  crtc->base.id, dotclock, framedur_ns, linedur_ns);
663 664 665 666
}
EXPORT_SYMBOL(drm_calc_timestamping_constants);

/**
D
Daniel Vetter 已提交
667 668
 * drm_calc_vbltimestamp_from_scanoutpos - precise vblank timestamp helper
 * @dev: DRM device
669
 * @pipe: index of CRTC whose vblank timestamp to retrieve
D
Daniel Vetter 已提交
670 671 672 673 674 675 676 677 678 679 680 681
 * @max_error: Desired maximum allowable error in timestamps (nanosecs)
 *             On return contains true maximum error of timestamp
 * @vblank_time: Pointer to struct timeval which should receive the timestamp
 * @flags: Flags to pass to driver:
 *         0 = Default,
 *         DRM_CALLED_FROM_VBLIRQ = If function is called from vbl IRQ handler
 * @mode: mode which defines the scanout timings
 *
 * Implements calculation of exact vblank timestamps from given drm_display_mode
 * timings and current video scanout position of a CRTC. This can be called from
 * within get_vblank_timestamp() implementation of a kms driver to implement the
 * actual timestamping.
682 683 684 685 686 687 688 689 690 691 692 693 694 695
 *
 * Should return timestamps conforming to the OML_sync_control OpenML
 * extension specification. The timestamp corresponds to the end of
 * the vblank interval, aka start of scanout of topmost-leftmost display
 * pixel in the following video frame.
 *
 * Requires support for optional dev->driver->get_scanout_position()
 * in kms driver, plus a bit of setup code to provide a drm_display_mode
 * that corresponds to the true scanout timing.
 *
 * The current implementation only handles standard video modes. It
 * returns as no operation if a doublescan or interlaced video mode is
 * active. Higher level code is expected to handle this.
 *
D
Daniel Vetter 已提交
696 697
 * Returns:
 * Negative value on error, failure or if not supported in current
698 699
 * video mode:
 *
D
Daniel Vetter 已提交
700
 * -EINVAL   - Invalid CRTC.
701 702 703 704 705 706 707 708 709 710
 * -EAGAIN   - Temporary unavailable, e.g., called before initial modeset.
 * -ENOTSUPP - Function not supported in current display mode.
 * -EIO      - Failed, e.g., due to failed scanout position query.
 *
 * Returns or'ed positive status flags on success:
 *
 * DRM_VBLANKTIME_SCANOUTPOS_METHOD - Signal this method used for timestamping.
 * DRM_VBLANKTIME_INVBL - Timestamp taken while scanout was in vblank interval.
 *
 */
711 712
int drm_calc_vbltimestamp_from_scanoutpos(struct drm_device *dev,
					  unsigned int pipe,
713 714 715
					  int *max_error,
					  struct timeval *vblank_time,
					  unsigned flags,
716
					  const struct drm_display_mode *mode)
717
{
718
	struct timeval tv_etime;
T
Thomas Gleixner 已提交
719
	ktime_t stime, etime;
720 721
	unsigned int vbl_status;
	int ret = DRM_VBLANKTIME_SCANOUTPOS_METHOD;
722
	int vpos, hpos, i;
723
	int delta_ns, duration_ns;
724

725 726
	if (pipe >= dev->num_crtcs) {
		DRM_ERROR("Invalid crtc %u\n", pipe);
727 728 729 730 731 732 733 734 735 736 737 738
		return -EINVAL;
	}

	/* Scanout position query not supported? Should not happen. */
	if (!dev->driver->get_scanout_position) {
		DRM_ERROR("Called from driver w/o get_scanout_position()!?\n");
		return -EIO;
	}

	/* If mode timing undefined, just return as no-op:
	 * Happens during initial modesetting of a crtc.
	 */
739
	if (mode->crtc_clock == 0) {
740
		DRM_DEBUG("crtc %u: Noop due to uninitialized mode.\n", pipe);
741 742 743 744 745 746 747 748 749 750 751
		return -EAGAIN;
	}

	/* Get current scanout position with system timestamp.
	 * Repeat query up to DRM_TIMESTAMP_MAXRETRIES times
	 * if single query takes longer than max_error nanoseconds.
	 *
	 * This guarantees a tight bound on maximum error if
	 * code gets preempted or delayed for some reason.
	 */
	for (i = 0; i < DRM_TIMESTAMP_MAXRETRIES; i++) {
752 753 754 755
		/*
		 * Get vertical and horizontal scanout position vpos, hpos,
		 * and bounding timestamps stime, etime, pre/post query.
		 */
756 757 758 759
		vbl_status = dev->driver->get_scanout_position(dev, pipe, flags,
							       &vpos, &hpos,
							       &stime, &etime,
							       mode);
760 761 762

		/* Return as no-op if scanout query unsupported or failed. */
		if (!(vbl_status & DRM_SCANOUTPOS_VALID)) {
763
			DRM_DEBUG("crtc %u : scanoutpos query failed [0x%x].\n",
764
				  pipe, vbl_status);
765 766 767
			return -EIO;
		}

768
		/* Compute uncertainty in timestamp of scanout position query. */
769
		duration_ns = ktime_to_ns(etime) - ktime_to_ns(stime);
770 771

		/* Accept result with <  max_error nsecs timing uncertainty. */
772
		if (duration_ns <= *max_error)
773 774 775 776 777
			break;
	}

	/* Noisy system timing? */
	if (i == DRM_TIMESTAMP_MAXRETRIES) {
778 779
		DRM_DEBUG("crtc %u: Noisy timestamp %d us > %d us [%d reps].\n",
			  pipe, duration_ns/1000, *max_error/1000, i);
780 781 782
	}

	/* Return upper bound of timestamp precision error. */
783
	*max_error = duration_ns;
784 785 786 787 788 789

	/* Check if in vblank area:
	 * vpos is >=0 in video scanout area, but negative
	 * within vblank area, counting down the number of lines until
	 * start of scanout.
	 */
790 791
	if (vbl_status & DRM_SCANOUTPOS_IN_VBLANK)
		ret |= DRM_VBLANKTIME_IN_VBLANK;
792 793 794 795 796

	/* Convert scanout position into elapsed time at raw_time query
	 * since start of scanout at first display scanline. delta_ns
	 * can be negative if start of scanout hasn't happened yet.
	 */
797 798
	delta_ns = div_s64(1000000LL * (vpos * mode->crtc_htotal + hpos),
			   mode->crtc_clock);
799

800
	if (!drm_timestamp_monotonic)
T
Thomas Gleixner 已提交
801
		etime = ktime_mono_to_real(etime);
802

803 804
	/* save this only for debugging purposes */
	tv_etime = ktime_to_timeval(etime);
805 806 807
	/* Subtract time delta from raw timestamp to get final
	 * vblank_time timestamp for end of vblank.
	 */
808 809 810 811
	if (delta_ns < 0)
		etime = ktime_add_ns(etime, -delta_ns);
	else
		etime = ktime_sub_ns(etime, delta_ns);
812
	*vblank_time = ktime_to_timeval(etime);
813

V
Ville Syrjälä 已提交
814 815 816 817 818
	DRM_DEBUG_VBL("crtc %u : v 0x%x p(%d,%d)@ %ld.%ld -> %ld.%ld [e %d us, %d rep]\n",
		      pipe, vbl_status, hpos, vpos,
		      (long)tv_etime.tv_sec, (long)tv_etime.tv_usec,
		      (long)vblank_time->tv_sec, (long)vblank_time->tv_usec,
		      duration_ns/1000, i);
819

820
	return ret;
821 822 823
}
EXPORT_SYMBOL(drm_calc_vbltimestamp_from_scanoutpos);

824 825 826 827
static struct timeval get_drm_timestamp(void)
{
	ktime_t now;

T
Thomas Gleixner 已提交
828
	now = drm_timestamp_monotonic ? ktime_get() : ktime_get_real();
829 830 831
	return ktime_to_timeval(now);
}

832 833
/**
 * drm_get_last_vbltimestamp - retrieve raw timestamp for the most recent
834
 *                             vblank interval
835
 * @dev: DRM device
836
 * @pipe: index of CRTC whose vblank timestamp to retrieve
837 838
 * @tvblank: Pointer to target struct timeval which should receive the timestamp
 * @flags: Flags to pass to driver:
D
Daniel Vetter 已提交
839 840
 *         0 = Default,
 *         DRM_CALLED_FROM_VBLIRQ = If function is called from vbl IRQ handler
841 842
 *
 * Fetches the system timestamp corresponding to the time of the most recent
D
Daniel Vetter 已提交
843
 * vblank interval on specified CRTC. May call into kms-driver to
844 845 846 847 848
 * compute the timestamp with a high-precision GPU specific method.
 *
 * Returns zero if timestamp originates from uncorrected do_gettimeofday()
 * call, i.e., it isn't very precisely locked to the true vblank.
 *
D
Daniel Vetter 已提交
849
 * Returns:
850
 * True if timestamp is considered to be very precise, false otherwise.
851
 */
852
static bool
853
drm_get_last_vbltimestamp(struct drm_device *dev, unsigned int pipe,
854
			  struct timeval *tvblank, unsigned flags)
855
{
856
	int ret;
857 858 859 860 861 862

	/* Define requested maximum error on timestamps (nanoseconds). */
	int max_error = (int) drm_timestamp_precision * 1000;

	/* Query driver if possible and precision timestamping enabled. */
	if (dev->driver->get_vblank_timestamp && (max_error > 0)) {
863
		ret = dev->driver->get_vblank_timestamp(dev, pipe, &max_error,
864 865
							tvblank, flags);
		if (ret > 0)
866
			return true;
867 868 869
	}

	/* GPU high precision timestamp query unsupported or failed.
870
	 * Return current monotonic/gettimeofday timestamp as best estimate.
871
	 */
872
	*tvblank = get_drm_timestamp();
873

874
	return false;
875 876
}

877 878 879
/**
 * drm_vblank_count - retrieve "cooked" vblank counter value
 * @dev: DRM device
880
 * @pipe: index of CRTC for which to retrieve the counter
881 882 883 884
 *
 * Fetches the "cooked" vblank count value that represents the number of
 * vblank events since the system was booted, including lost events due to
 * modesetting activity.
D
Daniel Vetter 已提交
885
 *
886 887
 * This is the legacy version of drm_crtc_vblank_count().
 *
D
Daniel Vetter 已提交
888 889
 * Returns:
 * The software vblank counter.
890
 */
891
u32 drm_vblank_count(struct drm_device *dev, unsigned int pipe)
892
{
893
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
894

895
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
896
		return 0;
897

898
	return vblank->count;
899 900 901
}
EXPORT_SYMBOL(drm_vblank_count);

902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920
/**
 * drm_crtc_vblank_count - retrieve "cooked" vblank counter value
 * @crtc: which counter to retrieve
 *
 * Fetches the "cooked" vblank count value that represents the number of
 * vblank events since the system was booted, including lost events due to
 * modesetting activity.
 *
 * This is the native KMS version of drm_vblank_count().
 *
 * Returns:
 * The software vblank counter.
 */
u32 drm_crtc_vblank_count(struct drm_crtc *crtc)
{
	return drm_vblank_count(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_vblank_count);

921
/**
922 923
 * drm_vblank_count_and_time - retrieve "cooked" vblank counter value and the
 *     system timestamp corresponding to that vblank counter value.
924
 * @dev: DRM device
925
 * @pipe: index of CRTC whose counter to retrieve
926 927 928 929 930
 * @vblanktime: Pointer to struct timeval to receive the vblank timestamp.
 *
 * Fetches the "cooked" vblank count value that represents the number of
 * vblank events since the system was booted, including lost events due to
 * modesetting activity. Returns corresponding system timestamp of the time
D
Daniel Vetter 已提交
931
 * of the vblank interval that corresponds to the current vblank counter value.
932 933
 *
 * This is the legacy version of drm_crtc_vblank_count_and_time().
934
 */
935
u32 drm_vblank_count_and_time(struct drm_device *dev, unsigned int pipe,
936 937
			      struct timeval *vblanktime)
{
938
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
939
	int count = DRM_TIMESTAMP_MAXRETRIES;
940 941
	u32 cur_vblank;

942
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
943 944
		return 0;

945 946 947 948
	/*
	 * Vblank timestamps are read lockless. To ensure consistency the vblank
	 * counter is rechecked and ordering is ensured using memory barriers.
	 * This works like a seqlock. The write-side barriers are in store_vblank.
949 950
	 */
	do {
951 952
		cur_vblank = vblank->count;
		smp_rmb();
953
		*vblanktime = vblanktimestamp(dev, pipe, cur_vblank);
954
		smp_rmb();
955
	} while (cur_vblank != vblank->count && --count > 0);
956 957 958 959 960

	return cur_vblank;
}
EXPORT_SYMBOL(drm_vblank_count_and_time);

961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981
/**
 * drm_crtc_vblank_count_and_time - retrieve "cooked" vblank counter value
 *     and the system timestamp corresponding to that vblank counter value
 * @crtc: which counter to retrieve
 * @vblanktime: Pointer to struct timeval to receive the vblank timestamp.
 *
 * Fetches the "cooked" vblank count value that represents the number of
 * vblank events since the system was booted, including lost events due to
 * modesetting activity. Returns corresponding system timestamp of the time
 * of the vblank interval that corresponds to the current vblank counter value.
 *
 * This is the native KMS version of drm_vblank_count_and_time().
 */
u32 drm_crtc_vblank_count_and_time(struct drm_crtc *crtc,
				   struct timeval *vblanktime)
{
	return drm_vblank_count_and_time(crtc->dev, drm_crtc_index(crtc),
					 vblanktime);
}
EXPORT_SYMBOL(drm_crtc_vblank_count_and_time);

982 983 984 985
static void send_vblank_event(struct drm_device *dev,
		struct drm_pending_vblank_event *e,
		unsigned long seq, struct timeval *now)
{
986 987
	assert_spin_locked(&dev->event_lock);

988 989 990 991 992 993 994 995 996 997 998
	e->event.sequence = seq;
	e->event.tv_sec = now->tv_sec;
	e->event.tv_usec = now->tv_usec;

	list_add_tail(&e->base.link,
		      &e->base.file_priv->event_list);
	wake_up_interruptible(&e->base.file_priv->event_wait);
	trace_drm_vblank_event_delivered(e->base.pid, e->pipe,
					 e->event.sequence);
}

999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 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
/**
 * drm_arm_vblank_event - arm vblank event after pageflip
 * @dev: DRM device
 * @pipe: CRTC index
 * @e: the event to prepare to send
 *
 * A lot of drivers need to generate vblank events for the very next vblank
 * interrupt. For example when the page flip interrupt happens when the page
 * flip gets armed, but not when it actually executes within the next vblank
 * period. This helper function implements exactly the required vblank arming
 * behaviour.
 *
 * Caller must hold event lock. Caller must also hold a vblank reference for
 * the event @e, which will be dropped when the next vblank arrives.
 *
 * This is the legacy version of drm_crtc_arm_vblank_event().
 */
void drm_arm_vblank_event(struct drm_device *dev, unsigned int pipe,
			  struct drm_pending_vblank_event *e)
{
	assert_spin_locked(&dev->event_lock);

	e->pipe = pipe;
	e->event.sequence = drm_vblank_count(dev, pipe);
	list_add_tail(&e->base.link, &dev->vblank_event_list);
}
EXPORT_SYMBOL(drm_arm_vblank_event);

/**
 * drm_crtc_arm_vblank_event - arm vblank event after pageflip
 * @crtc: the source CRTC of the vblank event
 * @e: the event to send
 *
 * A lot of drivers need to generate vblank events for the very next vblank
 * interrupt. For example when the page flip interrupt happens when the page
 * flip gets armed, but not when it actually executes within the next vblank
 * period. This helper function implements exactly the required vblank arming
 * behaviour.
 *
 * Caller must hold event lock. Caller must also hold a vblank reference for
 * the event @e, which will be dropped when the next vblank arrives.
 *
 * This is the native KMS version of drm_arm_vblank_event().
 */
void drm_crtc_arm_vblank_event(struct drm_crtc *crtc,
			       struct drm_pending_vblank_event *e)
{
	drm_arm_vblank_event(crtc->dev, drm_crtc_index(crtc), e);
}
EXPORT_SYMBOL(drm_crtc_arm_vblank_event);

1050 1051 1052
/**
 * drm_send_vblank_event - helper to send vblank event after pageflip
 * @dev: DRM device
1053
 * @pipe: CRTC index
1054 1055 1056 1057
 * @e: the event to send
 *
 * Updates sequence # and timestamp on event, and sends it to userspace.
 * Caller must hold event lock.
1058 1059
 *
 * This is the legacy version of drm_crtc_send_vblank_event().
1060
 */
1061 1062
void drm_send_vblank_event(struct drm_device *dev, unsigned int pipe,
			   struct drm_pending_vblank_event *e)
1063 1064 1065
{
	struct timeval now;
	unsigned int seq;
1066

1067
	if (dev->num_crtcs > 0) {
1068
		seq = drm_vblank_count_and_time(dev, pipe, &now);
1069 1070
	} else {
		seq = 0;
1071 1072

		now = get_drm_timestamp();
1073
	}
1074
	e->pipe = pipe;
1075 1076 1077 1078
	send_vblank_event(dev, e, seq, &now);
}
EXPORT_SYMBOL(drm_send_vblank_event);

1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095
/**
 * drm_crtc_send_vblank_event - helper to send vblank event after pageflip
 * @crtc: the source CRTC of the vblank event
 * @e: the event to send
 *
 * Updates sequence # and timestamp on event, and sends it to userspace.
 * Caller must hold event lock.
 *
 * This is the native KMS version of drm_send_vblank_event().
 */
void drm_crtc_send_vblank_event(struct drm_crtc *crtc,
				struct drm_pending_vblank_event *e)
{
	drm_send_vblank_event(crtc->dev, drm_crtc_index(crtc), e);
}
EXPORT_SYMBOL(drm_crtc_send_vblank_event);

V
Ville Syrjälä 已提交
1096 1097 1098
/**
 * drm_vblank_enable - enable the vblank interrupt on a CRTC
 * @dev: DRM device
1099
 * @pipe: CRTC index
1100 1101 1102
 *
 * Returns:
 * Zero on success or a negative error code on failure.
V
Ville Syrjälä 已提交
1103
 */
1104
static int drm_vblank_enable(struct drm_device *dev, unsigned int pipe)
V
Ville Syrjälä 已提交
1105
{
1106
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
V
Ville Syrjälä 已提交
1107 1108 1109 1110 1111 1112
	int ret = 0;

	assert_spin_locked(&dev->vbl_lock);

	spin_lock(&dev->vblank_time_lock);

1113
	if (!vblank->enabled) {
D
Daniel Vetter 已提交
1114 1115
		/*
		 * Enable vblank irqs under vblank_time_lock protection.
V
Ville Syrjälä 已提交
1116 1117 1118 1119 1120
		 * All vblank count & timestamp updates are held off
		 * until we are done reinitializing master counter and
		 * timestamps. Filtercode in drm_handle_vblank() will
		 * prevent double-accounting of same vblank interval.
		 */
1121 1122
		ret = dev->driver->enable_vblank(dev, pipe);
		DRM_DEBUG("enabling vblank on crtc %u, ret: %d\n", pipe, ret);
V
Ville Syrjälä 已提交
1123
		if (ret)
1124
			atomic_dec(&vblank->refcount);
V
Ville Syrjälä 已提交
1125
		else {
1126
			vblank->enabled = true;
1127
			drm_update_vblank_count(dev, pipe, 0);
V
Ville Syrjälä 已提交
1128 1129 1130 1131 1132 1133 1134 1135
		}
	}

	spin_unlock(&dev->vblank_time_lock);

	return ret;
}

1136 1137 1138
/**
 * drm_vblank_get - get a reference count on vblank events
 * @dev: DRM device
1139
 * @pipe: index of CRTC to own
1140 1141 1142 1143
 *
 * Acquire a reference count on vblank events to avoid having them disabled
 * while in use.
 *
1144 1145
 * This is the legacy version of drm_crtc_vblank_get().
 *
D
Daniel Vetter 已提交
1146
 * Returns:
1147
 * Zero on success or a negative error code on failure.
1148
 */
1149
int drm_vblank_get(struct drm_device *dev, unsigned int pipe)
1150
{
1151
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1152
	unsigned long irqflags;
1153 1154
	int ret = 0;

1155 1156 1157
	if (!dev->num_crtcs)
		return -EINVAL;

1158
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
1159 1160
		return -EINVAL;

1161 1162
	spin_lock_irqsave(&dev->vbl_lock, irqflags);
	/* Going from 0->1 means we have to enable interrupts again */
1163
	if (atomic_add_return(1, &vblank->refcount) == 1) {
1164
		ret = drm_vblank_enable(dev, pipe);
1165
	} else {
1166 1167
		if (!vblank->enabled) {
			atomic_dec(&vblank->refcount);
1168
			ret = -EINVAL;
1169 1170 1171 1172 1173 1174 1175 1176
		}
	}
	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);

	return ret;
}
EXPORT_SYMBOL(drm_vblank_get);

1177 1178 1179 1180 1181 1182 1183
/**
 * drm_crtc_vblank_get - get a reference count on vblank events
 * @crtc: which CRTC to own
 *
 * Acquire a reference count on vblank events to avoid having them disabled
 * while in use.
 *
1184
 * This is the native kms version of drm_vblank_get().
1185 1186
 *
 * Returns:
1187
 * Zero on success or a negative error code on failure.
1188 1189 1190 1191 1192 1193 1194
 */
int drm_crtc_vblank_get(struct drm_crtc *crtc)
{
	return drm_vblank_get(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_vblank_get);

1195
/**
1196
 * drm_vblank_put - release ownership of vblank events
1197
 * @dev: DRM device
1198
 * @pipe: index of CRTC to release
1199 1200
 *
 * Release ownership of a given vblank counter, turning off interrupts
1201
 * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
1202 1203
 *
 * This is the legacy version of drm_crtc_vblank_put().
1204
 */
1205
void drm_vblank_put(struct drm_device *dev, unsigned int pipe)
1206
{
1207
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1208

1209
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
1210
		return;
1211

1212
	if (WARN_ON(atomic_read(&vblank->refcount) == 0))
R
Rob Clark 已提交
1213 1214
		return;

1215
	/* Last user schedules interrupt disable */
1216
	if (atomic_dec_and_test(&vblank->refcount)) {
1217 1218 1219
		if (drm_vblank_offdelay == 0)
			return;
		else if (dev->vblank_disable_immediate || drm_vblank_offdelay < 0)
1220
			vblank_disable_fn((unsigned long)vblank);
1221
		else
1222 1223 1224
			mod_timer(&vblank->disable_timer,
				  jiffies + ((drm_vblank_offdelay * HZ)/1000));
	}
1225 1226 1227
}
EXPORT_SYMBOL(drm_vblank_put);

1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242
/**
 * drm_crtc_vblank_put - give up ownership of vblank events
 * @crtc: which counter to give up
 *
 * Release ownership of a given vblank counter, turning off interrupts
 * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
 *
 * This is the native kms version of drm_vblank_put().
 */
void drm_crtc_vblank_put(struct drm_crtc *crtc)
{
	drm_vblank_put(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_vblank_put);

1243 1244 1245
/**
 * drm_wait_one_vblank - wait for one vblank
 * @dev: DRM device
1246
 * @pipe: CRTC index
1247
 *
1248 1249
 * This waits for one vblank to pass on @pipe, using the irq driver interfaces.
 * It is a failure to call this when the vblank irq for @pipe is disabled, e.g.
1250 1251
 * due to lack of driver support or because the crtc is off.
 */
1252
void drm_wait_one_vblank(struct drm_device *dev, unsigned int pipe)
1253
{
1254
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1255 1256 1257
	int ret;
	u32 last;

1258
	if (WARN_ON(pipe >= dev->num_crtcs))
1259 1260
		return;

1261 1262
	ret = drm_vblank_get(dev, pipe);
	if (WARN(ret, "vblank not available on crtc %i, ret=%i\n", pipe, ret))
1263 1264
		return;

1265
	last = drm_vblank_count(dev, pipe);
1266

1267 1268
	ret = wait_event_timeout(vblank->queue,
				 last != drm_vblank_count(dev, pipe),
1269 1270
				 msecs_to_jiffies(100));

1271
	WARN(ret == 0, "vblank wait timed out on crtc %i\n", pipe);
1272

1273
	drm_vblank_put(dev, pipe);
1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290
}
EXPORT_SYMBOL(drm_wait_one_vblank);

/**
 * drm_crtc_wait_one_vblank - wait for one vblank
 * @crtc: DRM crtc
 *
 * This waits for one vblank to pass on @crtc, using the irq driver interfaces.
 * It is a failure to call this when the vblank irq for @crtc is disabled, e.g.
 * due to lack of driver support or because the crtc is off.
 */
void drm_crtc_wait_one_vblank(struct drm_crtc *crtc)
{
	drm_wait_one_vblank(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_wait_one_vblank);

1291 1292 1293
/**
 * drm_vblank_off - disable vblank events on a CRTC
 * @dev: DRM device
1294
 * @pipe: CRTC index
1295
 *
D
Daniel Vetter 已提交
1296 1297 1298 1299 1300 1301
 * Drivers can use this function to shut down the vblank interrupt handling when
 * disabling a crtc. This function ensures that the latest vblank frame count is
 * stored so that drm_vblank_on() can restore it again.
 *
 * Drivers must use this function when the hardware vblank counter can get
 * reset, e.g. when suspending.
1302 1303
 *
 * This is the legacy version of drm_crtc_vblank_off().
1304
 */
1305
void drm_vblank_off(struct drm_device *dev, unsigned int pipe)
1306
{
1307
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1308 1309
	struct drm_pending_vblank_event *e, *t;
	struct timeval now;
1310
	unsigned long irqflags;
1311
	unsigned int seq;
1312

1313
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
1314 1315
		return;

1316 1317 1318
	spin_lock_irqsave(&dev->event_lock, irqflags);

	spin_lock(&dev->vbl_lock);
1319 1320 1321 1322 1323 1324 1325
	DRM_DEBUG_VBL("crtc %d, vblank enabled %d, inmodeset %d\n",
		      pipe, vblank->enabled, vblank->inmodeset);

	/* Avoid redundant vblank disables without previous drm_vblank_on(). */
	if (drm_core_check_feature(dev, DRIVER_ATOMIC) || !vblank->inmodeset)
		vblank_disable_and_save(dev, pipe);

1326
	wake_up(&vblank->queue);
1327

1328 1329 1330 1331 1332 1333 1334 1335 1336 1337
	/*
	 * Prevent subsequent drm_vblank_get() from re-enabling
	 * the vblank interrupt by bumping the refcount.
	 */
	if (!vblank->inmodeset) {
		atomic_inc(&vblank->refcount);
		vblank->inmodeset = 1;
	}
	spin_unlock(&dev->vbl_lock);

1338
	/* Send any queued vblank events, lest the natives grow disquiet */
1339
	seq = drm_vblank_count_and_time(dev, pipe, &now);
1340

1341
	list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
1342
		if (e->pipe != pipe)
1343
			continue;
1344 1345
		DRM_DEBUG("Sending premature vblank event on disable: "
			  "wanted %d, current %d\n",
1346
			  e->event.sequence, seq);
1347
		list_del(&e->base.link);
1348
		drm_vblank_put(dev, pipe);
1349
		send_vblank_event(dev, e, seq, &now);
1350
	}
1351
	spin_unlock_irqrestore(&dev->event_lock, irqflags);
1352 1353 1354
}
EXPORT_SYMBOL(drm_vblank_off);

1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
/**
 * drm_crtc_vblank_off - disable vblank events on a CRTC
 * @crtc: CRTC in question
 *
 * Drivers can use this function to shut down the vblank interrupt handling when
 * disabling a crtc. This function ensures that the latest vblank frame count is
 * stored so that drm_vblank_on can restore it again.
 *
 * Drivers must use this function when the hardware vblank counter can get
 * reset, e.g. when suspending.
 *
 * This is the native kms version of drm_vblank_off().
 */
void drm_crtc_vblank_off(struct drm_crtc *crtc)
{
	drm_vblank_off(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_vblank_off);

1374 1375
/**
 * drm_crtc_vblank_reset - reset vblank state to off on a CRTC
1376
 * @crtc: CRTC in question
1377 1378 1379 1380 1381 1382 1383
 *
 * Drivers can use this function to reset the vblank state to off at load time.
 * Drivers should use this together with the drm_crtc_vblank_off() and
 * drm_crtc_vblank_on() functions. The difference compared to
 * drm_crtc_vblank_off() is that this function doesn't save the vblank counter
 * and hence doesn't need to call any driver hooks.
 */
1384
void drm_crtc_vblank_reset(struct drm_crtc *crtc)
1385
{
1386
	struct drm_device *dev = crtc->dev;
1387
	unsigned long irqflags;
1388
	unsigned int pipe = drm_crtc_index(crtc);
1389
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405

	spin_lock_irqsave(&dev->vbl_lock, irqflags);
	/*
	 * Prevent subsequent drm_vblank_get() from enabling the vblank
	 * interrupt by bumping the refcount.
	 */
	if (!vblank->inmodeset) {
		atomic_inc(&vblank->refcount);
		vblank->inmodeset = 1;
	}
	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);

	WARN_ON(!list_empty(&dev->vblank_event_list));
}
EXPORT_SYMBOL(drm_crtc_vblank_reset);

V
Ville Syrjälä 已提交
1406 1407 1408
/**
 * drm_vblank_on - enable vblank events on a CRTC
 * @dev: DRM device
1409
 * @pipe: CRTC index
D
Daniel Vetter 已提交
1410 1411 1412
 *
 * This functions restores the vblank interrupt state captured with
 * drm_vblank_off() again. Note that calls to drm_vblank_on() and
1413
 * drm_vblank_off() can be unbalanced and so can also be unconditionally called
D
Daniel Vetter 已提交
1414
 * in driver load code to reflect the current hardware state of the crtc.
1415 1416
 *
 * This is the legacy version of drm_crtc_vblank_on().
V
Ville Syrjälä 已提交
1417
 */
1418
void drm_vblank_on(struct drm_device *dev, unsigned int pipe)
V
Ville Syrjälä 已提交
1419
{
1420
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
V
Ville Syrjälä 已提交
1421 1422
	unsigned long irqflags;

1423
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
1424 1425
		return;

V
Ville Syrjälä 已提交
1426
	spin_lock_irqsave(&dev->vbl_lock, irqflags);
1427 1428 1429
	DRM_DEBUG_VBL("crtc %d, vblank enabled %d, inmodeset %d\n",
		      pipe, vblank->enabled, vblank->inmodeset);

1430
	/* Drop our private "prevent drm_vblank_get" refcount */
1431 1432 1433
	if (vblank->inmodeset) {
		atomic_dec(&vblank->refcount);
		vblank->inmodeset = 0;
1434
	}
1435

1436 1437
	drm_reset_vblank_timestamp(dev, pipe);

1438 1439 1440 1441 1442 1443
	/*
	 * re-enable interrupts if there are users left, or the
	 * user wishes vblank interrupts to be enabled all the time.
	 */
	if (atomic_read(&vblank->refcount) != 0 ||
	    (!dev->vblank_disable_immediate && drm_vblank_offdelay == 0))
1444
		WARN_ON(drm_vblank_enable(dev, pipe));
V
Ville Syrjälä 已提交
1445 1446 1447 1448
	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
}
EXPORT_SYMBOL(drm_vblank_on);

1449 1450 1451 1452 1453 1454
/**
 * drm_crtc_vblank_on - enable vblank events on a CRTC
 * @crtc: CRTC in question
 *
 * This functions restores the vblank interrupt state captured with
 * drm_vblank_off() again. Note that calls to drm_vblank_on() and
1455
 * drm_vblank_off() can be unbalanced and so can also be unconditionally called
1456 1457 1458 1459 1460 1461 1462 1463 1464 1465
 * in driver load code to reflect the current hardware state of the crtc.
 *
 * This is the native kms version of drm_vblank_on().
 */
void drm_crtc_vblank_on(struct drm_crtc *crtc)
{
	drm_vblank_on(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_vblank_on);

D
Dave Airlie 已提交
1466 1467 1468
/**
 * drm_vblank_pre_modeset - account for vblanks across mode sets
 * @dev: DRM device
1469
 * @pipe: CRTC index
D
Dave Airlie 已提交
1470 1471 1472
 *
 * Account for vblank events across mode setting events, which will likely
 * reset the hardware frame counter.
D
Daniel Vetter 已提交
1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487
 *
 * This is done by grabbing a temporary vblank reference to ensure that the
 * vblank interrupt keeps running across the modeset sequence. With this the
 * software-side vblank frame counting will ensure that there are no jumps or
 * discontinuities.
 *
 * Unfortunately this approach is racy and also doesn't work when the vblank
 * interrupt stops running, e.g. across system suspend resume. It is therefore
 * highly recommended that drivers use the newer drm_vblank_off() and
 * drm_vblank_on() instead. drm_vblank_pre_modeset() only works correctly when
 * using "cooked" software vblank frame counters and not relying on any hardware
 * counters.
 *
 * Drivers must call drm_vblank_post_modeset() when re-enabling the same crtc
 * again.
D
Dave Airlie 已提交
1488
 */
1489
void drm_vblank_pre_modeset(struct drm_device *dev, unsigned int pipe)
D
Dave Airlie 已提交
1490
{
1491
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1492

1493
	/* vblank is not initialized (IRQ not installed ?), or has been freed */
1494 1495
	if (!dev->num_crtcs)
		return;
R
Rob Clark 已提交
1496

1497
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
1498 1499
		return;

D
Dave Airlie 已提交
1500 1501 1502 1503 1504 1505 1506
	/*
	 * To avoid all the problems that might happen if interrupts
	 * were enabled/disabled around or between these calls, we just
	 * have the kernel take a reference on the CRTC (just once though
	 * to avoid corrupting the count if multiple, mismatch calls occur),
	 * so that interrupts remain enabled in the interim.
	 */
1507 1508
	if (!vblank->inmodeset) {
		vblank->inmodeset = 0x1;
1509
		if (drm_vblank_get(dev, pipe) == 0)
1510
			vblank->inmodeset |= 0x2;
D
Dave Airlie 已提交
1511 1512 1513 1514
	}
}
EXPORT_SYMBOL(drm_vblank_pre_modeset);

D
Daniel Vetter 已提交
1515 1516 1517
/**
 * drm_vblank_post_modeset - undo drm_vblank_pre_modeset changes
 * @dev: DRM device
1518
 * @pipe: CRTC index
D
Daniel Vetter 已提交
1519 1520 1521 1522
 *
 * This function again drops the temporary vblank reference acquired in
 * drm_vblank_pre_modeset.
 */
1523
void drm_vblank_post_modeset(struct drm_device *dev, unsigned int pipe)
D
Dave Airlie 已提交
1524
{
1525
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
D
Dave Airlie 已提交
1526 1527
	unsigned long irqflags;

1528 1529 1530 1531
	/* vblank is not initialized (IRQ not installed ?), or has been freed */
	if (!dev->num_crtcs)
		return;

1532
	if (WARN_ON(pipe >= dev->num_crtcs))
1533 1534
		return;

1535
	if (vblank->inmodeset) {
D
Dave Airlie 已提交
1536
		spin_lock_irqsave(&dev->vbl_lock, irqflags);
1537
		dev->vblank_disable_allowed = true;
D
Dave Airlie 已提交
1538
		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
1539

1540
		if (vblank->inmodeset & 0x2)
1541
			drm_vblank_put(dev, pipe);
1542

1543
		vblank->inmodeset = 0;
D
Dave Airlie 已提交
1544 1545 1546 1547
	}
}
EXPORT_SYMBOL(drm_vblank_post_modeset);

D
Daniel Vetter 已提交
1548
/*
1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562
 * drm_modeset_ctl - handle vblank event counter changes across mode switch
 * @DRM_IOCTL_ARGS: standard ioctl arguments
 *
 * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET
 * ioctls around modesetting so that any lost vblank events are accounted for.
 *
 * Generally the counter will reset across mode sets.  If interrupts are
 * enabled around this call, we don't have to do anything since the counter
 * will have already been incremented.
 */
int drm_modeset_ctl(struct drm_device *dev, void *data,
		    struct drm_file *file_priv)
{
	struct drm_modeset_ctl *modeset = data;
1563
	unsigned int pipe;
1564 1565 1566

	/* If drm_vblank_init() hasn't been called yet, just no-op */
	if (!dev->num_crtcs)
1567
		return 0;
1568

1569 1570 1571 1572
	/* KMS drivers handle this internally */
	if (drm_core_check_feature(dev, DRIVER_MODESET))
		return 0;

1573 1574
	pipe = modeset->crtc;
	if (pipe >= dev->num_crtcs)
1575
		return -EINVAL;
1576 1577 1578

	switch (modeset->cmd) {
	case _DRM_PRE_MODESET:
1579
		drm_vblank_pre_modeset(dev, pipe);
1580 1581
		break;
	case _DRM_POST_MODESET:
1582
		drm_vblank_post_modeset(dev, pipe);
1583 1584
		break;
	default:
1585
		return -EINVAL;
1586 1587
	}

1588
	return 0;
1589 1590
}

1591
static int drm_queue_vblank_event(struct drm_device *dev, unsigned int pipe,
1592 1593 1594
				  union drm_wait_vblank *vblwait,
				  struct drm_file *file_priv)
{
1595
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1596 1597 1598 1599
	struct drm_pending_vblank_event *e;
	struct timeval now;
	unsigned long flags;
	unsigned int seq;
1600
	int ret;
1601

1602
	e = kzalloc(sizeof(*e), GFP_KERNEL);
1603 1604 1605 1606
	if (e == NULL) {
		ret = -ENOMEM;
		goto err_put;
	}
1607 1608

	e->pipe = pipe;
1609
	e->base.pid = current->pid;
1610
	e->event.base.type = DRM_EVENT_VBLANK;
1611
	e->event.base.length = sizeof(e->event);
1612 1613 1614 1615 1616 1617 1618
	e->event.user_data = vblwait->request.signal;
	e->base.event = &e->event.base;
	e->base.file_priv = file_priv;
	e->base.destroy = (void (*) (struct drm_pending_event *)) kfree;

	spin_lock_irqsave(&dev->event_lock, flags);

1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630
	/*
	 * drm_vblank_off() might have been called after we called
	 * drm_vblank_get(). drm_vblank_off() holds event_lock
	 * around the vblank disable, so no need for further locking.
	 * The reference from drm_vblank_get() protects against
	 * vblank disable from another source.
	 */
	if (!vblank->enabled) {
		ret = -EINVAL;
		goto err_unlock;
	}

1631
	if (file_priv->event_space < sizeof(e->event)) {
1632 1633
		ret = -EBUSY;
		goto err_unlock;
1634 1635
	}

1636
	file_priv->event_space -= sizeof(e->event);
1637 1638
	seq = drm_vblank_count_and_time(dev, pipe, &now);

1639 1640 1641
	if ((vblwait->request.type & _DRM_VBLANK_NEXTONMISS) &&
	    (seq - vblwait->request.sequence) <= (1 << 23)) {
		vblwait->request.sequence = seq + 1;
1642
		vblwait->reply.sequence = vblwait->request.sequence;
1643 1644
	}

1645
	DRM_DEBUG("event on vblank count %d, current %d, crtc %u\n",
1646 1647
		  vblwait->request.sequence, seq, pipe);

1648 1649 1650
	trace_drm_vblank_event_queued(current->pid, pipe,
				      vblwait->request.sequence);

1651 1652
	e->event.sequence = vblwait->request.sequence;
	if ((seq - vblwait->request.sequence) <= (1 << 23)) {
1653
		drm_vblank_put(dev, pipe);
1654
		send_vblank_event(dev, e, seq, &now);
1655
		vblwait->reply.sequence = seq;
1656
	} else {
1657
		/* drm_handle_vblank_events will call drm_vblank_put */
1658
		list_add_tail(&e->base.link, &dev->vblank_event_list);
1659
		vblwait->reply.sequence = vblwait->request.sequence;
1660 1661 1662 1663 1664
	}

	spin_unlock_irqrestore(&dev->event_lock, flags);

	return 0;
1665 1666 1667 1668 1669

err_unlock:
	spin_unlock_irqrestore(&dev->event_lock, flags);
	kfree(e);
err_put:
1670
	drm_vblank_put(dev, pipe);
1671
	return ret;
1672 1673
}

D
Daniel Vetter 已提交
1674
/*
L
Linus Torvalds 已提交
1675 1676 1677
 * Wait for VBLANK.
 *
 * \param inode device inode.
1678
 * \param file_priv DRM file private.
L
Linus Torvalds 已提交
1679 1680 1681 1682
 * \param cmd command.
 * \param data user argument, pointing to a drm_wait_vblank structure.
 * \return zero on success or a negative number on failure.
 *
1683 1684
 * This function enables the vblank interrupt on the pipe requested, then
 * sleeps waiting for the requested sequence number to occur, and drops
D
Daniel Vetter 已提交
1685
 * the vblank interrupt refcount afterwards. (vblank IRQ disable follows that
1686
 * after a timeout with no further vblank waits scheduled).
L
Linus Torvalds 已提交
1687
 */
1688 1689
int drm_wait_vblank(struct drm_device *dev, void *data,
		    struct drm_file *file_priv)
L
Linus Torvalds 已提交
1690
{
1691
	struct drm_vblank_crtc *vblank;
1692
	union drm_wait_vblank *vblwait = data;
1693
	int ret;
1694
	unsigned int flags, seq, pipe, high_pipe;
L
Linus Torvalds 已提交
1695

1696 1697
	if (!dev->irq_enabled)
		return -EINVAL;
L
Linus Torvalds 已提交
1698

1699 1700 1701
	if (vblwait->request.type & _DRM_VBLANK_SIGNAL)
		return -EINVAL;

1702
	if (vblwait->request.type &
1703 1704
	    ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
	      _DRM_VBLANK_HIGH_CRTC_MASK)) {
1705
		DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n",
1706
			  vblwait->request.type,
1707 1708
			  (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
			   _DRM_VBLANK_HIGH_CRTC_MASK));
1709 1710 1711
		return -EINVAL;
	}

1712
	flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK;
1713 1714 1715
	high_pipe = (vblwait->request.type & _DRM_VBLANK_HIGH_CRTC_MASK);
	if (high_pipe)
		pipe = high_pipe >> _DRM_VBLANK_HIGH_CRTC_SHIFT;
1716
	else
1717 1718
		pipe = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
	if (pipe >= dev->num_crtcs)
1719 1720
		return -EINVAL;

1721
	vblank = &dev->vblank[pipe];
1722

1723
	ret = drm_vblank_get(dev, pipe);
1724
	if (ret) {
1725
		DRM_DEBUG("failed to acquire vblank counter, %d\n", ret);
1726 1727
		return ret;
	}
1728
	seq = drm_vblank_count(dev, pipe);
1729

1730
	switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) {
L
Linus Torvalds 已提交
1731
	case _DRM_VBLANK_RELATIVE:
1732 1733
		vblwait->request.sequence += seq;
		vblwait->request.type &= ~_DRM_VBLANK_RELATIVE;
L
Linus Torvalds 已提交
1734 1735 1736
	case _DRM_VBLANK_ABSOLUTE:
		break;
	default:
1737 1738
		ret = -EINVAL;
		goto done;
L
Linus Torvalds 已提交
1739 1740
	}

1741 1742 1743 1744
	if (flags & _DRM_VBLANK_EVENT) {
		/* must hold on to the vblank ref until the event fires
		 * drm_vblank_put will be called asynchronously
		 */
1745
		return drm_queue_vblank_event(dev, pipe, vblwait, file_priv);
1746
	}
1747

1748
	if ((flags & _DRM_VBLANK_NEXTONMISS) &&
1749 1750
	    (seq - vblwait->request.sequence) <= (1<<23)) {
		vblwait->request.sequence = seq + 1;
1751 1752
	}

1753 1754
	DRM_DEBUG("waiting on vblank count %d, crtc %u\n",
		  vblwait->request.sequence, pipe);
1755 1756
	vblank->last_wait = vblwait->request.sequence;
	DRM_WAIT_ON(ret, vblank->queue, 3 * HZ,
1757
		    (((drm_vblank_count(dev, pipe) -
1758
		       vblwait->request.sequence) <= (1 << 23)) ||
1759
		     !vblank->enabled ||
1760
		     !dev->irq_enabled));
L
Linus Torvalds 已提交
1761

1762 1763
	if (ret != -EINTR) {
		struct timeval now;
L
Linus Torvalds 已提交
1764

1765
		vblwait->reply.sequence = drm_vblank_count_and_time(dev, pipe, &now);
1766 1767
		vblwait->reply.tval_sec = now.tv_sec;
		vblwait->reply.tval_usec = now.tv_usec;
1768

1769 1770
		DRM_DEBUG("returning %d to client\n",
			  vblwait->reply.sequence);
L
Linus Torvalds 已提交
1771
	} else {
1772
		DRM_DEBUG("vblank wait interrupted by signal\n");
L
Linus Torvalds 已提交
1773 1774
	}

1775
done:
1776
	drm_vblank_put(dev, pipe);
L
Linus Torvalds 已提交
1777 1778 1779
	return ret;
}

1780
static void drm_handle_vblank_events(struct drm_device *dev, unsigned int pipe)
1781 1782 1783 1784 1785
{
	struct drm_pending_vblank_event *e, *t;
	struct timeval now;
	unsigned int seq;

1786
	assert_spin_locked(&dev->event_lock);
1787

1788
	seq = drm_vblank_count_and_time(dev, pipe, &now);
1789 1790

	list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
1791
		if (e->pipe != pipe)
1792 1793 1794 1795 1796 1797 1798
			continue;
		if ((seq - e->event.sequence) > (1<<23))
			continue;

		DRM_DEBUG("vblank event on %d, current %d\n",
			  e->event.sequence, seq);

1799
		list_del(&e->base.link);
1800
		drm_vblank_put(dev, pipe);
1801
		send_vblank_event(dev, e, seq, &now);
1802 1803
	}

1804
	trace_drm_vblank_event(pipe, seq);
1805 1806
}

1807 1808 1809
/**
 * drm_handle_vblank - handle a vblank event
 * @dev: DRM device
1810
 * @pipe: index of CRTC where this event occurred
1811 1812 1813
 *
 * Drivers should call this routine in their vblank interrupt handlers to
 * update the vblank counter and send any signals that may be pending.
1814 1815
 *
 * This is the legacy version of drm_crtc_handle_vblank().
1816
 */
1817
bool drm_handle_vblank(struct drm_device *dev, unsigned int pipe)
1818
{
1819
	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1820 1821
	unsigned long irqflags;

1822
	if (WARN_ON_ONCE(!dev->num_crtcs))
1823
		return false;
1824

1825
	if (WARN_ON(pipe >= dev->num_crtcs))
R
Rob Clark 已提交
1826 1827
		return false;

1828 1829
	spin_lock_irqsave(&dev->event_lock, irqflags);

1830 1831 1832 1833
	/* Need timestamp lock to prevent concurrent execution with
	 * vblank enable/disable, as this would cause inconsistent
	 * or corrupted timestamps and vblank counts.
	 */
1834
	spin_lock(&dev->vblank_time_lock);
1835 1836

	/* Vblank irq handling disabled. Nothing to do. */
1837
	if (!vblank->enabled) {
1838 1839
		spin_unlock(&dev->vblank_time_lock);
		spin_unlock_irqrestore(&dev->event_lock, irqflags);
1840
		return false;
1841 1842
	}

1843
	drm_update_vblank_count(dev, pipe, DRM_CALLED_FROM_VBLIRQ);
1844

1845 1846
	spin_unlock(&dev->vblank_time_lock);

1847
	wake_up(&vblank->queue);
1848
	drm_handle_vblank_events(dev, pipe);
1849

1850 1851
	spin_unlock_irqrestore(&dev->event_lock, irqflags);

1852
	return true;
1853 1854
}
EXPORT_SYMBOL(drm_handle_vblank);
1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872

/**
 * drm_crtc_handle_vblank - handle a vblank event
 * @crtc: where this event occurred
 *
 * Drivers should call this routine in their vblank interrupt handlers to
 * update the vblank counter and send any signals that may be pending.
 *
 * This is the native KMS version of drm_handle_vblank().
 *
 * Returns:
 * True if the event was successfully handled, false on failure.
 */
bool drm_crtc_handle_vblank(struct drm_crtc *crtc)
{
	return drm_handle_vblank(crtc->dev, drm_crtc_index(crtc));
}
EXPORT_SYMBOL(drm_crtc_handle_vblank);
1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889

/**
 * drm_vblank_no_hw_counter - "No hw counter" implementation of .get_vblank_counter()
 * @dev: DRM device
 * @pipe: CRTC for which to read the counter
 *
 * Drivers can plug this into the .get_vblank_counter() function if
 * there is no useable hardware frame counter available.
 *
 * Returns:
 * 0
 */
u32 drm_vblank_no_hw_counter(struct drm_device *dev, unsigned int pipe)
{
	return 0;
}
EXPORT_SYMBOL(drm_vblank_no_hw_counter);