xref: /openbmc/linux/drivers/gpu/drm/drm_irq.c (revision a8da474e)
1 /*
2  * drm_irq.c IRQ and vblank support
3  *
4  * \author Rickard E. (Rik) Faith <faith@valinux.com>
5  * \author Gareth Hughes <gareth@valinux.com>
6  */
7 
8 /*
9  * Created: Fri Mar 19 14:30:16 1999 by faith@valinux.com
10  *
11  * Copyright 1999, 2000 Precision Insight, Inc., Cedar Park, Texas.
12  * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
13  * All Rights Reserved.
14  *
15  * Permission is hereby granted, free of charge, to any person obtaining a
16  * copy of this software and associated documentation files (the "Software"),
17  * to deal in the Software without restriction, including without limitation
18  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
19  * and/or sell copies of the Software, and to permit persons to whom the
20  * Software is furnished to do so, subject to the following conditions:
21  *
22  * The above copyright notice and this permission notice (including the next
23  * paragraph) shall be included in all copies or substantial portions of the
24  * Software.
25  *
26  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
27  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
28  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
29  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
30  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
31  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
32  * OTHER DEALINGS IN THE SOFTWARE.
33  */
34 
35 #include <drm/drmP.h>
36 #include "drm_trace.h"
37 #include "drm_internal.h"
38 
39 #include <linux/interrupt.h>	/* For task queue support */
40 #include <linux/slab.h>
41 
42 #include <linux/vgaarb.h>
43 #include <linux/export.h>
44 
45 /* Access macro for slots in vblank timestamp ringbuffer. */
46 #define vblanktimestamp(dev, pipe, count) \
47 	((dev)->vblank[pipe].time[(count) % DRM_VBLANKTIME_RBSIZE])
48 
49 /* Retry timestamp calculation up to 3 times to satisfy
50  * drm_timestamp_precision before giving up.
51  */
52 #define DRM_TIMESTAMP_MAXRETRIES 3
53 
54 /* Threshold in nanoseconds for detection of redundant
55  * vblank irq in drm_handle_vblank(). 1 msec should be ok.
56  */
57 #define DRM_REDUNDANT_VBLIRQ_THRESH_NS 1000000
58 
59 static bool
60 drm_get_last_vbltimestamp(struct drm_device *dev, unsigned int pipe,
61 			  struct timeval *tvblank, unsigned flags);
62 
63 static unsigned int drm_timestamp_precision = 20;  /* Default to 20 usecs. */
64 
65 /*
66  * Default to use monotonic timestamps for wait-for-vblank and page-flip
67  * complete events.
68  */
69 unsigned int drm_timestamp_monotonic = 1;
70 
71 static int drm_vblank_offdelay = 5000;    /* Default to 5000 msecs. */
72 
73 module_param_named(vblankoffdelay, drm_vblank_offdelay, int, 0600);
74 module_param_named(timestamp_precision_usec, drm_timestamp_precision, int, 0600);
75 module_param_named(timestamp_monotonic, drm_timestamp_monotonic, int, 0600);
76 
77 static void store_vblank(struct drm_device *dev, unsigned int pipe,
78 			 u32 vblank_count_inc,
79 			 struct timeval *t_vblank, u32 last)
80 {
81 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
82 	u32 tslot;
83 
84 	assert_spin_locked(&dev->vblank_time_lock);
85 
86 	vblank->last = last;
87 
88 	/* All writers hold the spinlock, but readers are serialized by
89 	 * the latching of vblank->count below.
90 	 */
91 	tslot = vblank->count + vblank_count_inc;
92 	vblanktimestamp(dev, pipe, tslot) = *t_vblank;
93 
94 	/*
95 	 * vblank timestamp updates are protected on the write side with
96 	 * vblank_time_lock, but on the read side done locklessly using a
97 	 * sequence-lock on the vblank counter. Ensure correct ordering using
98 	 * memory barrriers. We need the barrier both before and also after the
99 	 * counter update to synchronize with the next timestamp write.
100 	 * The read-side barriers for this are in drm_vblank_count_and_time.
101 	 */
102 	smp_wmb();
103 	vblank->count += vblank_count_inc;
104 	smp_wmb();
105 }
106 
107 /**
108  * drm_reset_vblank_timestamp - reset the last timestamp to the last vblank
109  * @dev: DRM device
110  * @pipe: index of CRTC for which to reset the timestamp
111  *
112  * Reset the stored timestamp for the current vblank count to correspond
113  * to the last vblank occurred.
114  *
115  * Only to be called from drm_vblank_on().
116  *
117  * Note: caller must hold dev->vbl_lock since this reads & writes
118  * device vblank fields.
119  */
120 static void drm_reset_vblank_timestamp(struct drm_device *dev, unsigned int pipe)
121 {
122 	u32 cur_vblank;
123 	bool rc;
124 	struct timeval t_vblank;
125 	int count = DRM_TIMESTAMP_MAXRETRIES;
126 
127 	spin_lock(&dev->vblank_time_lock);
128 
129 	/*
130 	 * sample the current counter to avoid random jumps
131 	 * when drm_vblank_enable() applies the diff
132 	 */
133 	do {
134 		cur_vblank = dev->driver->get_vblank_counter(dev, pipe);
135 		rc = drm_get_last_vbltimestamp(dev, pipe, &t_vblank, 0);
136 	} while (cur_vblank != dev->driver->get_vblank_counter(dev, pipe) && --count > 0);
137 
138 	/*
139 	 * Only reinitialize corresponding vblank timestamp if high-precision query
140 	 * available and didn't fail. Otherwise reinitialize delayed at next vblank
141 	 * interrupt and assign 0 for now, to mark the vblanktimestamp as invalid.
142 	 */
143 	if (!rc)
144 		t_vblank = (struct timeval) {0, 0};
145 
146 	/*
147 	 * +1 to make sure user will never see the same
148 	 * vblank counter value before and after a modeset
149 	 */
150 	store_vblank(dev, pipe, 1, &t_vblank, cur_vblank);
151 
152 	spin_unlock(&dev->vblank_time_lock);
153 }
154 
155 /**
156  * drm_update_vblank_count - update the master vblank counter
157  * @dev: DRM device
158  * @pipe: counter to update
159  *
160  * Call back into the driver to update the appropriate vblank counter
161  * (specified by @pipe).  Deal with wraparound, if it occurred, and
162  * update the last read value so we can deal with wraparound on the next
163  * call if necessary.
164  *
165  * Only necessary when going from off->on, to account for frames we
166  * didn't get an interrupt for.
167  *
168  * Note: caller must hold dev->vbl_lock since this reads & writes
169  * device vblank fields.
170  */
171 static void drm_update_vblank_count(struct drm_device *dev, unsigned int pipe,
172 				    unsigned long flags)
173 {
174 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
175 	u32 cur_vblank, diff;
176 	bool rc;
177 	struct timeval t_vblank;
178 	int count = DRM_TIMESTAMP_MAXRETRIES;
179 	int framedur_ns = vblank->framedur_ns;
180 
181 	/*
182 	 * Interrupts were disabled prior to this call, so deal with counter
183 	 * wrap if needed.
184 	 * NOTE!  It's possible we lost a full dev->max_vblank_count + 1 events
185 	 * here if the register is small or we had vblank interrupts off for
186 	 * a long time.
187 	 *
188 	 * We repeat the hardware vblank counter & timestamp query until
189 	 * we get consistent results. This to prevent races between gpu
190 	 * updating its hardware counter while we are retrieving the
191 	 * corresponding vblank timestamp.
192 	 */
193 	do {
194 		cur_vblank = dev->driver->get_vblank_counter(dev, pipe);
195 		rc = drm_get_last_vbltimestamp(dev, pipe, &t_vblank, flags);
196 	} while (cur_vblank != dev->driver->get_vblank_counter(dev, pipe) && --count > 0);
197 
198 	if (dev->max_vblank_count != 0) {
199 		/* trust the hw counter when it's around */
200 		diff = (cur_vblank - vblank->last) & dev->max_vblank_count;
201 	} else if (rc && framedur_ns) {
202 		const struct timeval *t_old;
203 		u64 diff_ns;
204 
205 		t_old = &vblanktimestamp(dev, pipe, vblank->count);
206 		diff_ns = timeval_to_ns(&t_vblank) - timeval_to_ns(t_old);
207 
208 		/*
209 		 * Figure out how many vblanks we've missed based
210 		 * on the difference in the timestamps and the
211 		 * frame/field duration.
212 		 */
213 		diff = DIV_ROUND_CLOSEST_ULL(diff_ns, framedur_ns);
214 
215 		if (diff == 0 && flags & DRM_CALLED_FROM_VBLIRQ)
216 			DRM_DEBUG_VBL("crtc %u: Redundant vblirq ignored."
217 				      " diff_ns = %lld, framedur_ns = %d)\n",
218 				      pipe, (long long) diff_ns, framedur_ns);
219 	} else {
220 		/* some kind of default for drivers w/o accurate vbl timestamping */
221 		diff = (flags & DRM_CALLED_FROM_VBLIRQ) != 0;
222 	}
223 
224 	DRM_DEBUG_VBL("updating vblank count on crtc %u:"
225 		      " current=%u, diff=%u, hw=%u hw_last=%u\n",
226 		      pipe, vblank->count, diff, cur_vblank, vblank->last);
227 
228 	if (diff == 0) {
229 		WARN_ON_ONCE(cur_vblank != vblank->last);
230 		return;
231 	}
232 
233 	/*
234 	 * Only reinitialize corresponding vblank timestamp if high-precision query
235 	 * available and didn't fail, or we were called from the vblank interrupt.
236 	 * Otherwise reinitialize delayed at next vblank interrupt and assign 0
237 	 * for now, to mark the vblanktimestamp as invalid.
238 	 */
239 	if (!rc && (flags & DRM_CALLED_FROM_VBLIRQ) == 0)
240 		t_vblank = (struct timeval) {0, 0};
241 
242 	store_vblank(dev, pipe, diff, &t_vblank, cur_vblank);
243 }
244 
245 /*
246  * Disable vblank irq's on crtc, make sure that last vblank count
247  * of hardware and corresponding consistent software vblank counter
248  * are preserved, even if there are any spurious vblank irq's after
249  * disable.
250  */
251 static void vblank_disable_and_save(struct drm_device *dev, unsigned int pipe)
252 {
253 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
254 	unsigned long irqflags;
255 
256 	/* Prevent vblank irq processing while disabling vblank irqs,
257 	 * so no updates of timestamps or count can happen after we've
258 	 * disabled. Needed to prevent races in case of delayed irq's.
259 	 */
260 	spin_lock_irqsave(&dev->vblank_time_lock, irqflags);
261 
262 	/*
263 	 * Only disable vblank interrupts if they're enabled. This avoids
264 	 * calling the ->disable_vblank() operation in atomic context with the
265 	 * hardware potentially runtime suspended.
266 	 */
267 	if (vblank->enabled) {
268 		dev->driver->disable_vblank(dev, pipe);
269 		vblank->enabled = false;
270 	}
271 
272 	/*
273 	 * Always update the count and timestamp to maintain the
274 	 * appearance that the counter has been ticking all along until
275 	 * this time. This makes the count account for the entire time
276 	 * between drm_vblank_on() and drm_vblank_off().
277 	 */
278 	drm_update_vblank_count(dev, pipe, 0);
279 
280 	spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
281 }
282 
283 static void vblank_disable_fn(unsigned long arg)
284 {
285 	struct drm_vblank_crtc *vblank = (void *)arg;
286 	struct drm_device *dev = vblank->dev;
287 	unsigned int pipe = vblank->pipe;
288 	unsigned long irqflags;
289 
290 	if (!dev->vblank_disable_allowed)
291 		return;
292 
293 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
294 	if (atomic_read(&vblank->refcount) == 0 && vblank->enabled) {
295 		DRM_DEBUG("disabling vblank on crtc %u\n", pipe);
296 		vblank_disable_and_save(dev, pipe);
297 	}
298 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
299 }
300 
301 /**
302  * drm_vblank_cleanup - cleanup vblank support
303  * @dev: DRM device
304  *
305  * This function cleans up any resources allocated in drm_vblank_init.
306  */
307 void drm_vblank_cleanup(struct drm_device *dev)
308 {
309 	unsigned int pipe;
310 
311 	/* Bail if the driver didn't call drm_vblank_init() */
312 	if (dev->num_crtcs == 0)
313 		return;
314 
315 	for (pipe = 0; pipe < dev->num_crtcs; pipe++) {
316 		struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
317 
318 		WARN_ON(vblank->enabled &&
319 			drm_core_check_feature(dev, DRIVER_MODESET));
320 
321 		del_timer_sync(&vblank->disable_timer);
322 	}
323 
324 	kfree(dev->vblank);
325 
326 	dev->num_crtcs = 0;
327 }
328 EXPORT_SYMBOL(drm_vblank_cleanup);
329 
330 /**
331  * drm_vblank_init - initialize vblank support
332  * @dev: DRM device
333  * @num_crtcs: number of CRTCs supported by @dev
334  *
335  * This function initializes vblank support for @num_crtcs display pipelines.
336  *
337  * Returns:
338  * Zero on success or a negative error code on failure.
339  */
340 int drm_vblank_init(struct drm_device *dev, unsigned int num_crtcs)
341 {
342 	int ret = -ENOMEM;
343 	unsigned int i;
344 
345 	spin_lock_init(&dev->vbl_lock);
346 	spin_lock_init(&dev->vblank_time_lock);
347 
348 	dev->num_crtcs = num_crtcs;
349 
350 	dev->vblank = kcalloc(num_crtcs, sizeof(*dev->vblank), GFP_KERNEL);
351 	if (!dev->vblank)
352 		goto err;
353 
354 	for (i = 0; i < num_crtcs; i++) {
355 		struct drm_vblank_crtc *vblank = &dev->vblank[i];
356 
357 		vblank->dev = dev;
358 		vblank->pipe = i;
359 		init_waitqueue_head(&vblank->queue);
360 		setup_timer(&vblank->disable_timer, vblank_disable_fn,
361 			    (unsigned long)vblank);
362 	}
363 
364 	DRM_INFO("Supports vblank timestamp caching Rev 2 (21.10.2013).\n");
365 
366 	/* Driver specific high-precision vblank timestamping supported? */
367 	if (dev->driver->get_vblank_timestamp)
368 		DRM_INFO("Driver supports precise vblank timestamp query.\n");
369 	else
370 		DRM_INFO("No driver support for vblank timestamp query.\n");
371 
372 	/* Must have precise timestamping for reliable vblank instant disable */
373 	if (dev->vblank_disable_immediate && !dev->driver->get_vblank_timestamp) {
374 		dev->vblank_disable_immediate = false;
375 		DRM_INFO("Setting vblank_disable_immediate to false because "
376 			 "get_vblank_timestamp == NULL\n");
377 	}
378 
379 	dev->vblank_disable_allowed = false;
380 
381 	return 0;
382 
383 err:
384 	dev->num_crtcs = 0;
385 	return ret;
386 }
387 EXPORT_SYMBOL(drm_vblank_init);
388 
389 static void drm_irq_vgaarb_nokms(void *cookie, bool state)
390 {
391 	struct drm_device *dev = cookie;
392 
393 	if (dev->driver->vgaarb_irq) {
394 		dev->driver->vgaarb_irq(dev, state);
395 		return;
396 	}
397 
398 	if (!dev->irq_enabled)
399 		return;
400 
401 	if (state) {
402 		if (dev->driver->irq_uninstall)
403 			dev->driver->irq_uninstall(dev);
404 	} else {
405 		if (dev->driver->irq_preinstall)
406 			dev->driver->irq_preinstall(dev);
407 		if (dev->driver->irq_postinstall)
408 			dev->driver->irq_postinstall(dev);
409 	}
410 }
411 
412 /**
413  * drm_irq_install - install IRQ handler
414  * @dev: DRM device
415  * @irq: IRQ number to install the handler for
416  *
417  * Initializes the IRQ related data. Installs the handler, calling the driver
418  * irq_preinstall() and irq_postinstall() functions before and after the
419  * installation.
420  *
421  * This is the simplified helper interface provided for drivers with no special
422  * needs. Drivers which need to install interrupt handlers for multiple
423  * interrupts must instead set drm_device->irq_enabled to signal the DRM core
424  * that vblank interrupts are available.
425  *
426  * Returns:
427  * Zero on success or a negative error code on failure.
428  */
429 int drm_irq_install(struct drm_device *dev, int irq)
430 {
431 	int ret;
432 	unsigned long sh_flags = 0;
433 
434 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
435 		return -EINVAL;
436 
437 	if (irq == 0)
438 		return -EINVAL;
439 
440 	/* Driver must have been initialized */
441 	if (!dev->dev_private)
442 		return -EINVAL;
443 
444 	if (dev->irq_enabled)
445 		return -EBUSY;
446 	dev->irq_enabled = true;
447 
448 	DRM_DEBUG("irq=%d\n", irq);
449 
450 	/* Before installing handler */
451 	if (dev->driver->irq_preinstall)
452 		dev->driver->irq_preinstall(dev);
453 
454 	/* Install handler */
455 	if (drm_core_check_feature(dev, DRIVER_IRQ_SHARED))
456 		sh_flags = IRQF_SHARED;
457 
458 	ret = request_irq(irq, dev->driver->irq_handler,
459 			  sh_flags, dev->driver->name, dev);
460 
461 	if (ret < 0) {
462 		dev->irq_enabled = false;
463 		return ret;
464 	}
465 
466 	if (!drm_core_check_feature(dev, DRIVER_MODESET))
467 		vga_client_register(dev->pdev, (void *)dev, drm_irq_vgaarb_nokms, NULL);
468 
469 	/* After installing handler */
470 	if (dev->driver->irq_postinstall)
471 		ret = dev->driver->irq_postinstall(dev);
472 
473 	if (ret < 0) {
474 		dev->irq_enabled = false;
475 		if (!drm_core_check_feature(dev, DRIVER_MODESET))
476 			vga_client_register(dev->pdev, NULL, NULL, NULL);
477 		free_irq(irq, dev);
478 	} else {
479 		dev->irq = irq;
480 	}
481 
482 	return ret;
483 }
484 EXPORT_SYMBOL(drm_irq_install);
485 
486 /**
487  * drm_irq_uninstall - uninstall the IRQ handler
488  * @dev: DRM device
489  *
490  * Calls the driver's irq_uninstall() function and unregisters the IRQ handler.
491  * This should only be called by drivers which used drm_irq_install() to set up
492  * their interrupt handler. Other drivers must only reset
493  * drm_device->irq_enabled to false.
494  *
495  * Note that for kernel modesetting drivers it is a bug if this function fails.
496  * The sanity checks are only to catch buggy user modesetting drivers which call
497  * the same function through an ioctl.
498  *
499  * Returns:
500  * Zero on success or a negative error code on failure.
501  */
502 int drm_irq_uninstall(struct drm_device *dev)
503 {
504 	unsigned long irqflags;
505 	bool irq_enabled;
506 	int i;
507 
508 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
509 		return -EINVAL;
510 
511 	irq_enabled = dev->irq_enabled;
512 	dev->irq_enabled = false;
513 
514 	/*
515 	 * Wake up any waiters so they don't hang. This is just to paper over
516 	 * isssues for UMS drivers which aren't in full control of their
517 	 * vblank/irq handling. KMS drivers must ensure that vblanks are all
518 	 * disabled when uninstalling the irq handler.
519 	 */
520 	if (dev->num_crtcs) {
521 		spin_lock_irqsave(&dev->vbl_lock, irqflags);
522 		for (i = 0; i < dev->num_crtcs; i++) {
523 			struct drm_vblank_crtc *vblank = &dev->vblank[i];
524 
525 			if (!vblank->enabled)
526 				continue;
527 
528 			WARN_ON(drm_core_check_feature(dev, DRIVER_MODESET));
529 
530 			vblank_disable_and_save(dev, i);
531 			wake_up(&vblank->queue);
532 		}
533 		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
534 	}
535 
536 	if (!irq_enabled)
537 		return -EINVAL;
538 
539 	DRM_DEBUG("irq=%d\n", dev->irq);
540 
541 	if (!drm_core_check_feature(dev, DRIVER_MODESET))
542 		vga_client_register(dev->pdev, NULL, NULL, NULL);
543 
544 	if (dev->driver->irq_uninstall)
545 		dev->driver->irq_uninstall(dev);
546 
547 	free_irq(dev->irq, dev);
548 
549 	return 0;
550 }
551 EXPORT_SYMBOL(drm_irq_uninstall);
552 
553 /*
554  * IRQ control ioctl.
555  *
556  * \param inode device inode.
557  * \param file_priv DRM file private.
558  * \param cmd command.
559  * \param arg user argument, pointing to a drm_control structure.
560  * \return zero on success or a negative number on failure.
561  *
562  * Calls irq_install() or irq_uninstall() according to \p arg.
563  */
564 int drm_control(struct drm_device *dev, void *data,
565 		struct drm_file *file_priv)
566 {
567 	struct drm_control *ctl = data;
568 	int ret = 0, irq;
569 
570 	/* if we haven't irq we fallback for compatibility reasons -
571 	 * this used to be a separate function in drm_dma.h
572 	 */
573 
574 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
575 		return 0;
576 	if (drm_core_check_feature(dev, DRIVER_MODESET))
577 		return 0;
578 	/* UMS was only ever support on pci devices. */
579 	if (WARN_ON(!dev->pdev))
580 		return -EINVAL;
581 
582 	switch (ctl->func) {
583 	case DRM_INST_HANDLER:
584 		irq = dev->pdev->irq;
585 
586 		if (dev->if_version < DRM_IF_VERSION(1, 2) &&
587 		    ctl->irq != irq)
588 			return -EINVAL;
589 		mutex_lock(&dev->struct_mutex);
590 		ret = drm_irq_install(dev, irq);
591 		mutex_unlock(&dev->struct_mutex);
592 
593 		return ret;
594 	case DRM_UNINST_HANDLER:
595 		mutex_lock(&dev->struct_mutex);
596 		ret = drm_irq_uninstall(dev);
597 		mutex_unlock(&dev->struct_mutex);
598 
599 		return ret;
600 	default:
601 		return -EINVAL;
602 	}
603 }
604 
605 /**
606  * drm_calc_timestamping_constants - calculate vblank timestamp constants
607  * @crtc: drm_crtc whose timestamp constants should be updated.
608  * @mode: display mode containing the scanout timings
609  *
610  * Calculate and store various constants which are later
611  * needed by vblank and swap-completion timestamping, e.g,
612  * by drm_calc_vbltimestamp_from_scanoutpos(). They are
613  * derived from CRTC's true scanout timing, so they take
614  * things like panel scaling or other adjustments into account.
615  */
616 void drm_calc_timestamping_constants(struct drm_crtc *crtc,
617 				     const struct drm_display_mode *mode)
618 {
619 	struct drm_device *dev = crtc->dev;
620 	unsigned int pipe = drm_crtc_index(crtc);
621 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
622 	int linedur_ns = 0, framedur_ns = 0;
623 	int dotclock = mode->crtc_clock;
624 
625 	if (!dev->num_crtcs)
626 		return;
627 
628 	if (WARN_ON(pipe >= dev->num_crtcs))
629 		return;
630 
631 	/* Valid dotclock? */
632 	if (dotclock > 0) {
633 		int frame_size = mode->crtc_htotal * mode->crtc_vtotal;
634 
635 		/*
636 		 * Convert scanline length in pixels and video
637 		 * dot clock to line duration and frame duration
638 		 * in nanoseconds:
639 		 */
640 		linedur_ns  = div_u64((u64) mode->crtc_htotal * 1000000, dotclock);
641 		framedur_ns = div_u64((u64) frame_size * 1000000, dotclock);
642 
643 		/*
644 		 * Fields of interlaced scanout modes are only half a frame duration.
645 		 */
646 		if (mode->flags & DRM_MODE_FLAG_INTERLACE)
647 			framedur_ns /= 2;
648 	} else
649 		DRM_ERROR("crtc %u: Can't calculate constants, dotclock = 0!\n",
650 			  crtc->base.id);
651 
652 	vblank->linedur_ns  = linedur_ns;
653 	vblank->framedur_ns = framedur_ns;
654 
655 	DRM_DEBUG("crtc %u: hwmode: htotal %d, vtotal %d, vdisplay %d\n",
656 		  crtc->base.id, mode->crtc_htotal,
657 		  mode->crtc_vtotal, mode->crtc_vdisplay);
658 	DRM_DEBUG("crtc %u: clock %d kHz framedur %d linedur %d\n",
659 		  crtc->base.id, dotclock, framedur_ns, linedur_ns);
660 }
661 EXPORT_SYMBOL(drm_calc_timestamping_constants);
662 
663 /**
664  * drm_calc_vbltimestamp_from_scanoutpos - precise vblank timestamp helper
665  * @dev: DRM device
666  * @pipe: index of CRTC whose vblank timestamp to retrieve
667  * @max_error: Desired maximum allowable error in timestamps (nanosecs)
668  *             On return contains true maximum error of timestamp
669  * @vblank_time: Pointer to struct timeval which should receive the timestamp
670  * @flags: Flags to pass to driver:
671  *         0 = Default,
672  *         DRM_CALLED_FROM_VBLIRQ = If function is called from vbl IRQ handler
673  * @mode: mode which defines the scanout timings
674  *
675  * Implements calculation of exact vblank timestamps from given drm_display_mode
676  * timings and current video scanout position of a CRTC. This can be called from
677  * within get_vblank_timestamp() implementation of a kms driver to implement the
678  * actual timestamping.
679  *
680  * Should return timestamps conforming to the OML_sync_control OpenML
681  * extension specification. The timestamp corresponds to the end of
682  * the vblank interval, aka start of scanout of topmost-leftmost display
683  * pixel in the following video frame.
684  *
685  * Requires support for optional dev->driver->get_scanout_position()
686  * in kms driver, plus a bit of setup code to provide a drm_display_mode
687  * that corresponds to the true scanout timing.
688  *
689  * The current implementation only handles standard video modes. It
690  * returns as no operation if a doublescan or interlaced video mode is
691  * active. Higher level code is expected to handle this.
692  *
693  * Returns:
694  * Negative value on error, failure or if not supported in current
695  * video mode:
696  *
697  * -EINVAL   - Invalid CRTC.
698  * -EAGAIN   - Temporary unavailable, e.g., called before initial modeset.
699  * -ENOTSUPP - Function not supported in current display mode.
700  * -EIO      - Failed, e.g., due to failed scanout position query.
701  *
702  * Returns or'ed positive status flags on success:
703  *
704  * DRM_VBLANKTIME_SCANOUTPOS_METHOD - Signal this method used for timestamping.
705  * DRM_VBLANKTIME_INVBL - Timestamp taken while scanout was in vblank interval.
706  *
707  */
708 int drm_calc_vbltimestamp_from_scanoutpos(struct drm_device *dev,
709 					  unsigned int pipe,
710 					  int *max_error,
711 					  struct timeval *vblank_time,
712 					  unsigned flags,
713 					  const struct drm_display_mode *mode)
714 {
715 	struct timeval tv_etime;
716 	ktime_t stime, etime;
717 	unsigned int vbl_status;
718 	int ret = DRM_VBLANKTIME_SCANOUTPOS_METHOD;
719 	int vpos, hpos, i;
720 	int delta_ns, duration_ns;
721 
722 	if (pipe >= dev->num_crtcs) {
723 		DRM_ERROR("Invalid crtc %u\n", pipe);
724 		return -EINVAL;
725 	}
726 
727 	/* Scanout position query not supported? Should not happen. */
728 	if (!dev->driver->get_scanout_position) {
729 		DRM_ERROR("Called from driver w/o get_scanout_position()!?\n");
730 		return -EIO;
731 	}
732 
733 	/* If mode timing undefined, just return as no-op:
734 	 * Happens during initial modesetting of a crtc.
735 	 */
736 	if (mode->crtc_clock == 0) {
737 		DRM_DEBUG("crtc %u: Noop due to uninitialized mode.\n", pipe);
738 		return -EAGAIN;
739 	}
740 
741 	/* Get current scanout position with system timestamp.
742 	 * Repeat query up to DRM_TIMESTAMP_MAXRETRIES times
743 	 * if single query takes longer than max_error nanoseconds.
744 	 *
745 	 * This guarantees a tight bound on maximum error if
746 	 * code gets preempted or delayed for some reason.
747 	 */
748 	for (i = 0; i < DRM_TIMESTAMP_MAXRETRIES; i++) {
749 		/*
750 		 * Get vertical and horizontal scanout position vpos, hpos,
751 		 * and bounding timestamps stime, etime, pre/post query.
752 		 */
753 		vbl_status = dev->driver->get_scanout_position(dev, pipe, flags,
754 							       &vpos, &hpos,
755 							       &stime, &etime,
756 							       mode);
757 
758 		/* Return as no-op if scanout query unsupported or failed. */
759 		if (!(vbl_status & DRM_SCANOUTPOS_VALID)) {
760 			DRM_DEBUG("crtc %u : scanoutpos query failed [0x%x].\n",
761 				  pipe, vbl_status);
762 			return -EIO;
763 		}
764 
765 		/* Compute uncertainty in timestamp of scanout position query. */
766 		duration_ns = ktime_to_ns(etime) - ktime_to_ns(stime);
767 
768 		/* Accept result with <  max_error nsecs timing uncertainty. */
769 		if (duration_ns <= *max_error)
770 			break;
771 	}
772 
773 	/* Noisy system timing? */
774 	if (i == DRM_TIMESTAMP_MAXRETRIES) {
775 		DRM_DEBUG("crtc %u: Noisy timestamp %d us > %d us [%d reps].\n",
776 			  pipe, duration_ns/1000, *max_error/1000, i);
777 	}
778 
779 	/* Return upper bound of timestamp precision error. */
780 	*max_error = duration_ns;
781 
782 	/* Check if in vblank area:
783 	 * vpos is >=0 in video scanout area, but negative
784 	 * within vblank area, counting down the number of lines until
785 	 * start of scanout.
786 	 */
787 	if (vbl_status & DRM_SCANOUTPOS_IN_VBLANK)
788 		ret |= DRM_VBLANKTIME_IN_VBLANK;
789 
790 	/* Convert scanout position into elapsed time at raw_time query
791 	 * since start of scanout at first display scanline. delta_ns
792 	 * can be negative if start of scanout hasn't happened yet.
793 	 */
794 	delta_ns = div_s64(1000000LL * (vpos * mode->crtc_htotal + hpos),
795 			   mode->crtc_clock);
796 
797 	if (!drm_timestamp_monotonic)
798 		etime = ktime_mono_to_real(etime);
799 
800 	/* save this only for debugging purposes */
801 	tv_etime = ktime_to_timeval(etime);
802 	/* Subtract time delta from raw timestamp to get final
803 	 * vblank_time timestamp for end of vblank.
804 	 */
805 	if (delta_ns < 0)
806 		etime = ktime_add_ns(etime, -delta_ns);
807 	else
808 		etime = ktime_sub_ns(etime, delta_ns);
809 	*vblank_time = ktime_to_timeval(etime);
810 
811 	DRM_DEBUG_VBL("crtc %u : v 0x%x p(%d,%d)@ %ld.%ld -> %ld.%ld [e %d us, %d rep]\n",
812 		      pipe, vbl_status, hpos, vpos,
813 		      (long)tv_etime.tv_sec, (long)tv_etime.tv_usec,
814 		      (long)vblank_time->tv_sec, (long)vblank_time->tv_usec,
815 		      duration_ns/1000, i);
816 
817 	return ret;
818 }
819 EXPORT_SYMBOL(drm_calc_vbltimestamp_from_scanoutpos);
820 
821 static struct timeval get_drm_timestamp(void)
822 {
823 	ktime_t now;
824 
825 	now = drm_timestamp_monotonic ? ktime_get() : ktime_get_real();
826 	return ktime_to_timeval(now);
827 }
828 
829 /**
830  * drm_get_last_vbltimestamp - retrieve raw timestamp for the most recent
831  *                             vblank interval
832  * @dev: DRM device
833  * @pipe: index of CRTC whose vblank timestamp to retrieve
834  * @tvblank: Pointer to target struct timeval which should receive the timestamp
835  * @flags: Flags to pass to driver:
836  *         0 = Default,
837  *         DRM_CALLED_FROM_VBLIRQ = If function is called from vbl IRQ handler
838  *
839  * Fetches the system timestamp corresponding to the time of the most recent
840  * vblank interval on specified CRTC. May call into kms-driver to
841  * compute the timestamp with a high-precision GPU specific method.
842  *
843  * Returns zero if timestamp originates from uncorrected do_gettimeofday()
844  * call, i.e., it isn't very precisely locked to the true vblank.
845  *
846  * Returns:
847  * True if timestamp is considered to be very precise, false otherwise.
848  */
849 static bool
850 drm_get_last_vbltimestamp(struct drm_device *dev, unsigned int pipe,
851 			  struct timeval *tvblank, unsigned flags)
852 {
853 	int ret;
854 
855 	/* Define requested maximum error on timestamps (nanoseconds). */
856 	int max_error = (int) drm_timestamp_precision * 1000;
857 
858 	/* Query driver if possible and precision timestamping enabled. */
859 	if (dev->driver->get_vblank_timestamp && (max_error > 0)) {
860 		ret = dev->driver->get_vblank_timestamp(dev, pipe, &max_error,
861 							tvblank, flags);
862 		if (ret > 0)
863 			return true;
864 	}
865 
866 	/* GPU high precision timestamp query unsupported or failed.
867 	 * Return current monotonic/gettimeofday timestamp as best estimate.
868 	 */
869 	*tvblank = get_drm_timestamp();
870 
871 	return false;
872 }
873 
874 /**
875  * drm_vblank_count - retrieve "cooked" vblank counter value
876  * @dev: DRM device
877  * @pipe: index of CRTC for which to retrieve the counter
878  *
879  * Fetches the "cooked" vblank count value that represents the number of
880  * vblank events since the system was booted, including lost events due to
881  * modesetting activity.
882  *
883  * This is the legacy version of drm_crtc_vblank_count().
884  *
885  * Returns:
886  * The software vblank counter.
887  */
888 u32 drm_vblank_count(struct drm_device *dev, unsigned int pipe)
889 {
890 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
891 
892 	if (WARN_ON(pipe >= dev->num_crtcs))
893 		return 0;
894 
895 	return vblank->count;
896 }
897 EXPORT_SYMBOL(drm_vblank_count);
898 
899 /**
900  * drm_crtc_vblank_count - retrieve "cooked" vblank counter value
901  * @crtc: which counter to retrieve
902  *
903  * Fetches the "cooked" vblank count value that represents the number of
904  * vblank events since the system was booted, including lost events due to
905  * modesetting activity.
906  *
907  * This is the native KMS version of drm_vblank_count().
908  *
909  * Returns:
910  * The software vblank counter.
911  */
912 u32 drm_crtc_vblank_count(struct drm_crtc *crtc)
913 {
914 	return drm_vblank_count(crtc->dev, drm_crtc_index(crtc));
915 }
916 EXPORT_SYMBOL(drm_crtc_vblank_count);
917 
918 /**
919  * drm_vblank_count_and_time - retrieve "cooked" vblank counter value and the
920  *     system timestamp corresponding to that vblank counter value.
921  * @dev: DRM device
922  * @pipe: index of CRTC whose counter to retrieve
923  * @vblanktime: Pointer to struct timeval to receive the vblank timestamp.
924  *
925  * Fetches the "cooked" vblank count value that represents the number of
926  * vblank events since the system was booted, including lost events due to
927  * modesetting activity. Returns corresponding system timestamp of the time
928  * of the vblank interval that corresponds to the current vblank counter value.
929  *
930  * This is the legacy version of drm_crtc_vblank_count_and_time().
931  */
932 u32 drm_vblank_count_and_time(struct drm_device *dev, unsigned int pipe,
933 			      struct timeval *vblanktime)
934 {
935 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
936 	int count = DRM_TIMESTAMP_MAXRETRIES;
937 	u32 cur_vblank;
938 
939 	if (WARN_ON(pipe >= dev->num_crtcs))
940 		return 0;
941 
942 	/*
943 	 * Vblank timestamps are read lockless. To ensure consistency the vblank
944 	 * counter is rechecked and ordering is ensured using memory barriers.
945 	 * This works like a seqlock. The write-side barriers are in store_vblank.
946 	 */
947 	do {
948 		cur_vblank = vblank->count;
949 		smp_rmb();
950 		*vblanktime = vblanktimestamp(dev, pipe, cur_vblank);
951 		smp_rmb();
952 	} while (cur_vblank != vblank->count && --count > 0);
953 
954 	return cur_vblank;
955 }
956 EXPORT_SYMBOL(drm_vblank_count_and_time);
957 
958 /**
959  * drm_crtc_vblank_count_and_time - retrieve "cooked" vblank counter value
960  *     and the system timestamp corresponding to that vblank counter value
961  * @crtc: which counter to retrieve
962  * @vblanktime: Pointer to struct timeval to receive the vblank timestamp.
963  *
964  * Fetches the "cooked" vblank count value that represents the number of
965  * vblank events since the system was booted, including lost events due to
966  * modesetting activity. Returns corresponding system timestamp of the time
967  * of the vblank interval that corresponds to the current vblank counter value.
968  *
969  * This is the native KMS version of drm_vblank_count_and_time().
970  */
971 u32 drm_crtc_vblank_count_and_time(struct drm_crtc *crtc,
972 				   struct timeval *vblanktime)
973 {
974 	return drm_vblank_count_and_time(crtc->dev, drm_crtc_index(crtc),
975 					 vblanktime);
976 }
977 EXPORT_SYMBOL(drm_crtc_vblank_count_and_time);
978 
979 static void send_vblank_event(struct drm_device *dev,
980 		struct drm_pending_vblank_event *e,
981 		unsigned long seq, struct timeval *now)
982 {
983 	WARN_ON_SMP(!spin_is_locked(&dev->event_lock));
984 	e->event.sequence = seq;
985 	e->event.tv_sec = now->tv_sec;
986 	e->event.tv_usec = now->tv_usec;
987 
988 	list_add_tail(&e->base.link,
989 		      &e->base.file_priv->event_list);
990 	wake_up_interruptible(&e->base.file_priv->event_wait);
991 	trace_drm_vblank_event_delivered(e->base.pid, e->pipe,
992 					 e->event.sequence);
993 }
994 
995 /**
996  * drm_send_vblank_event - helper to send vblank event after pageflip
997  * @dev: DRM device
998  * @pipe: CRTC index
999  * @e: the event to send
1000  *
1001  * Updates sequence # and timestamp on event, and sends it to userspace.
1002  * Caller must hold event lock.
1003  *
1004  * This is the legacy version of drm_crtc_send_vblank_event().
1005  */
1006 void drm_send_vblank_event(struct drm_device *dev, unsigned int pipe,
1007 			   struct drm_pending_vblank_event *e)
1008 {
1009 	struct timeval now;
1010 	unsigned int seq;
1011 
1012 	if (dev->num_crtcs > 0) {
1013 		seq = drm_vblank_count_and_time(dev, pipe, &now);
1014 	} else {
1015 		seq = 0;
1016 
1017 		now = get_drm_timestamp();
1018 	}
1019 	e->pipe = pipe;
1020 	send_vblank_event(dev, e, seq, &now);
1021 }
1022 EXPORT_SYMBOL(drm_send_vblank_event);
1023 
1024 /**
1025  * drm_crtc_send_vblank_event - helper to send vblank event after pageflip
1026  * @crtc: the source CRTC of the vblank event
1027  * @e: the event to send
1028  *
1029  * Updates sequence # and timestamp on event, and sends it to userspace.
1030  * Caller must hold event lock.
1031  *
1032  * This is the native KMS version of drm_send_vblank_event().
1033  */
1034 void drm_crtc_send_vblank_event(struct drm_crtc *crtc,
1035 				struct drm_pending_vblank_event *e)
1036 {
1037 	drm_send_vblank_event(crtc->dev, drm_crtc_index(crtc), e);
1038 }
1039 EXPORT_SYMBOL(drm_crtc_send_vblank_event);
1040 
1041 /**
1042  * drm_vblank_enable - enable the vblank interrupt on a CRTC
1043  * @dev: DRM device
1044  * @pipe: CRTC index
1045  *
1046  * Returns:
1047  * Zero on success or a negative error code on failure.
1048  */
1049 static int drm_vblank_enable(struct drm_device *dev, unsigned int pipe)
1050 {
1051 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1052 	int ret = 0;
1053 
1054 	assert_spin_locked(&dev->vbl_lock);
1055 
1056 	spin_lock(&dev->vblank_time_lock);
1057 
1058 	if (!vblank->enabled) {
1059 		/*
1060 		 * Enable vblank irqs under vblank_time_lock protection.
1061 		 * All vblank count & timestamp updates are held off
1062 		 * until we are done reinitializing master counter and
1063 		 * timestamps. Filtercode in drm_handle_vblank() will
1064 		 * prevent double-accounting of same vblank interval.
1065 		 */
1066 		ret = dev->driver->enable_vblank(dev, pipe);
1067 		DRM_DEBUG("enabling vblank on crtc %u, ret: %d\n", pipe, ret);
1068 		if (ret)
1069 			atomic_dec(&vblank->refcount);
1070 		else {
1071 			vblank->enabled = true;
1072 			drm_update_vblank_count(dev, pipe, 0);
1073 		}
1074 	}
1075 
1076 	spin_unlock(&dev->vblank_time_lock);
1077 
1078 	return ret;
1079 }
1080 
1081 /**
1082  * drm_vblank_get - get a reference count on vblank events
1083  * @dev: DRM device
1084  * @pipe: index of CRTC to own
1085  *
1086  * Acquire a reference count on vblank events to avoid having them disabled
1087  * while in use.
1088  *
1089  * This is the legacy version of drm_crtc_vblank_get().
1090  *
1091  * Returns:
1092  * Zero on success or a negative error code on failure.
1093  */
1094 int drm_vblank_get(struct drm_device *dev, unsigned int pipe)
1095 {
1096 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1097 	unsigned long irqflags;
1098 	int ret = 0;
1099 
1100 	if (!dev->num_crtcs)
1101 		return -EINVAL;
1102 
1103 	if (WARN_ON(pipe >= dev->num_crtcs))
1104 		return -EINVAL;
1105 
1106 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
1107 	/* Going from 0->1 means we have to enable interrupts again */
1108 	if (atomic_add_return(1, &vblank->refcount) == 1) {
1109 		ret = drm_vblank_enable(dev, pipe);
1110 	} else {
1111 		if (!vblank->enabled) {
1112 			atomic_dec(&vblank->refcount);
1113 			ret = -EINVAL;
1114 		}
1115 	}
1116 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
1117 
1118 	return ret;
1119 }
1120 EXPORT_SYMBOL(drm_vblank_get);
1121 
1122 /**
1123  * drm_crtc_vblank_get - get a reference count on vblank events
1124  * @crtc: which CRTC to own
1125  *
1126  * Acquire a reference count on vblank events to avoid having them disabled
1127  * while in use.
1128  *
1129  * This is the native kms version of drm_vblank_get().
1130  *
1131  * Returns:
1132  * Zero on success or a negative error code on failure.
1133  */
1134 int drm_crtc_vblank_get(struct drm_crtc *crtc)
1135 {
1136 	return drm_vblank_get(crtc->dev, drm_crtc_index(crtc));
1137 }
1138 EXPORT_SYMBOL(drm_crtc_vblank_get);
1139 
1140 /**
1141  * drm_vblank_put - release ownership of vblank events
1142  * @dev: DRM device
1143  * @pipe: index of CRTC to release
1144  *
1145  * Release ownership of a given vblank counter, turning off interrupts
1146  * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
1147  *
1148  * This is the legacy version of drm_crtc_vblank_put().
1149  */
1150 void drm_vblank_put(struct drm_device *dev, unsigned int pipe)
1151 {
1152 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1153 
1154 	if (WARN_ON(pipe >= dev->num_crtcs))
1155 		return;
1156 
1157 	if (WARN_ON(atomic_read(&vblank->refcount) == 0))
1158 		return;
1159 
1160 	/* Last user schedules interrupt disable */
1161 	if (atomic_dec_and_test(&vblank->refcount)) {
1162 		if (drm_vblank_offdelay == 0)
1163 			return;
1164 		else if (dev->vblank_disable_immediate || drm_vblank_offdelay < 0)
1165 			vblank_disable_fn((unsigned long)vblank);
1166 		else
1167 			mod_timer(&vblank->disable_timer,
1168 				  jiffies + ((drm_vblank_offdelay * HZ)/1000));
1169 	}
1170 }
1171 EXPORT_SYMBOL(drm_vblank_put);
1172 
1173 /**
1174  * drm_crtc_vblank_put - give up ownership of vblank events
1175  * @crtc: which counter to give up
1176  *
1177  * Release ownership of a given vblank counter, turning off interrupts
1178  * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
1179  *
1180  * This is the native kms version of drm_vblank_put().
1181  */
1182 void drm_crtc_vblank_put(struct drm_crtc *crtc)
1183 {
1184 	drm_vblank_put(crtc->dev, drm_crtc_index(crtc));
1185 }
1186 EXPORT_SYMBOL(drm_crtc_vblank_put);
1187 
1188 /**
1189  * drm_wait_one_vblank - wait for one vblank
1190  * @dev: DRM device
1191  * @pipe: CRTC index
1192  *
1193  * This waits for one vblank to pass on @pipe, using the irq driver interfaces.
1194  * It is a failure to call this when the vblank irq for @pipe is disabled, e.g.
1195  * due to lack of driver support or because the crtc is off.
1196  */
1197 void drm_wait_one_vblank(struct drm_device *dev, unsigned int pipe)
1198 {
1199 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1200 	int ret;
1201 	u32 last;
1202 
1203 	if (WARN_ON(pipe >= dev->num_crtcs))
1204 		return;
1205 
1206 	ret = drm_vblank_get(dev, pipe);
1207 	if (WARN(ret, "vblank not available on crtc %i, ret=%i\n", pipe, ret))
1208 		return;
1209 
1210 	last = drm_vblank_count(dev, pipe);
1211 
1212 	ret = wait_event_timeout(vblank->queue,
1213 				 last != drm_vblank_count(dev, pipe),
1214 				 msecs_to_jiffies(100));
1215 
1216 	WARN(ret == 0, "vblank wait timed out on crtc %i\n", pipe);
1217 
1218 	drm_vblank_put(dev, pipe);
1219 }
1220 EXPORT_SYMBOL(drm_wait_one_vblank);
1221 
1222 /**
1223  * drm_crtc_wait_one_vblank - wait for one vblank
1224  * @crtc: DRM crtc
1225  *
1226  * This waits for one vblank to pass on @crtc, using the irq driver interfaces.
1227  * It is a failure to call this when the vblank irq for @crtc is disabled, e.g.
1228  * due to lack of driver support or because the crtc is off.
1229  */
1230 void drm_crtc_wait_one_vblank(struct drm_crtc *crtc)
1231 {
1232 	drm_wait_one_vblank(crtc->dev, drm_crtc_index(crtc));
1233 }
1234 EXPORT_SYMBOL(drm_crtc_wait_one_vblank);
1235 
1236 /**
1237  * drm_vblank_off - disable vblank events on a CRTC
1238  * @dev: DRM device
1239  * @pipe: CRTC index
1240  *
1241  * Drivers can use this function to shut down the vblank interrupt handling when
1242  * disabling a crtc. This function ensures that the latest vblank frame count is
1243  * stored so that drm_vblank_on() can restore it again.
1244  *
1245  * Drivers must use this function when the hardware vblank counter can get
1246  * reset, e.g. when suspending.
1247  *
1248  * This is the legacy version of drm_crtc_vblank_off().
1249  */
1250 void drm_vblank_off(struct drm_device *dev, unsigned int pipe)
1251 {
1252 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1253 	struct drm_pending_vblank_event *e, *t;
1254 	struct timeval now;
1255 	unsigned long irqflags;
1256 	unsigned int seq;
1257 
1258 	if (WARN_ON(pipe >= dev->num_crtcs))
1259 		return;
1260 
1261 	spin_lock_irqsave(&dev->event_lock, irqflags);
1262 
1263 	spin_lock(&dev->vbl_lock);
1264 	vblank_disable_and_save(dev, pipe);
1265 	wake_up(&vblank->queue);
1266 
1267 	/*
1268 	 * Prevent subsequent drm_vblank_get() from re-enabling
1269 	 * the vblank interrupt by bumping the refcount.
1270 	 */
1271 	if (!vblank->inmodeset) {
1272 		atomic_inc(&vblank->refcount);
1273 		vblank->inmodeset = 1;
1274 	}
1275 	spin_unlock(&dev->vbl_lock);
1276 
1277 	/* Send any queued vblank events, lest the natives grow disquiet */
1278 	seq = drm_vblank_count_and_time(dev, pipe, &now);
1279 
1280 	list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
1281 		if (e->pipe != pipe)
1282 			continue;
1283 		DRM_DEBUG("Sending premature vblank event on disable: "
1284 			  "wanted %d, current %d\n",
1285 			  e->event.sequence, seq);
1286 		list_del(&e->base.link);
1287 		drm_vblank_put(dev, pipe);
1288 		send_vblank_event(dev, e, seq, &now);
1289 	}
1290 	spin_unlock_irqrestore(&dev->event_lock, irqflags);
1291 }
1292 EXPORT_SYMBOL(drm_vblank_off);
1293 
1294 /**
1295  * drm_crtc_vblank_off - disable vblank events on a CRTC
1296  * @crtc: CRTC in question
1297  *
1298  * Drivers can use this function to shut down the vblank interrupt handling when
1299  * disabling a crtc. This function ensures that the latest vblank frame count is
1300  * stored so that drm_vblank_on can restore it again.
1301  *
1302  * Drivers must use this function when the hardware vblank counter can get
1303  * reset, e.g. when suspending.
1304  *
1305  * This is the native kms version of drm_vblank_off().
1306  */
1307 void drm_crtc_vblank_off(struct drm_crtc *crtc)
1308 {
1309 	drm_vblank_off(crtc->dev, drm_crtc_index(crtc));
1310 }
1311 EXPORT_SYMBOL(drm_crtc_vblank_off);
1312 
1313 /**
1314  * drm_crtc_vblank_reset - reset vblank state to off on a CRTC
1315  * @crtc: CRTC in question
1316  *
1317  * Drivers can use this function to reset the vblank state to off at load time.
1318  * Drivers should use this together with the drm_crtc_vblank_off() and
1319  * drm_crtc_vblank_on() functions. The difference compared to
1320  * drm_crtc_vblank_off() is that this function doesn't save the vblank counter
1321  * and hence doesn't need to call any driver hooks.
1322  */
1323 void drm_crtc_vblank_reset(struct drm_crtc *crtc)
1324 {
1325 	struct drm_device *dev = crtc->dev;
1326 	unsigned long irqflags;
1327 	unsigned int pipe = drm_crtc_index(crtc);
1328 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1329 
1330 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
1331 	/*
1332 	 * Prevent subsequent drm_vblank_get() from enabling the vblank
1333 	 * interrupt by bumping the refcount.
1334 	 */
1335 	if (!vblank->inmodeset) {
1336 		atomic_inc(&vblank->refcount);
1337 		vblank->inmodeset = 1;
1338 	}
1339 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
1340 
1341 	WARN_ON(!list_empty(&dev->vblank_event_list));
1342 }
1343 EXPORT_SYMBOL(drm_crtc_vblank_reset);
1344 
1345 /**
1346  * drm_vblank_on - enable vblank events on a CRTC
1347  * @dev: DRM device
1348  * @pipe: CRTC index
1349  *
1350  * This functions restores the vblank interrupt state captured with
1351  * drm_vblank_off() again. Note that calls to drm_vblank_on() and
1352  * drm_vblank_off() can be unbalanced and so can also be unconditionally called
1353  * in driver load code to reflect the current hardware state of the crtc.
1354  *
1355  * This is the legacy version of drm_crtc_vblank_on().
1356  */
1357 void drm_vblank_on(struct drm_device *dev, unsigned int pipe)
1358 {
1359 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1360 	unsigned long irqflags;
1361 
1362 	if (WARN_ON(pipe >= dev->num_crtcs))
1363 		return;
1364 
1365 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
1366 	/* Drop our private "prevent drm_vblank_get" refcount */
1367 	if (vblank->inmodeset) {
1368 		atomic_dec(&vblank->refcount);
1369 		vblank->inmodeset = 0;
1370 	}
1371 
1372 	drm_reset_vblank_timestamp(dev, pipe);
1373 
1374 	/*
1375 	 * re-enable interrupts if there are users left, or the
1376 	 * user wishes vblank interrupts to be enabled all the time.
1377 	 */
1378 	if (atomic_read(&vblank->refcount) != 0 ||
1379 	    (!dev->vblank_disable_immediate && drm_vblank_offdelay == 0))
1380 		WARN_ON(drm_vblank_enable(dev, pipe));
1381 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
1382 }
1383 EXPORT_SYMBOL(drm_vblank_on);
1384 
1385 /**
1386  * drm_crtc_vblank_on - enable vblank events on a CRTC
1387  * @crtc: CRTC in question
1388  *
1389  * This functions restores the vblank interrupt state captured with
1390  * drm_vblank_off() again. Note that calls to drm_vblank_on() and
1391  * drm_vblank_off() can be unbalanced and so can also be unconditionally called
1392  * in driver load code to reflect the current hardware state of the crtc.
1393  *
1394  * This is the native kms version of drm_vblank_on().
1395  */
1396 void drm_crtc_vblank_on(struct drm_crtc *crtc)
1397 {
1398 	drm_vblank_on(crtc->dev, drm_crtc_index(crtc));
1399 }
1400 EXPORT_SYMBOL(drm_crtc_vblank_on);
1401 
1402 /**
1403  * drm_vblank_pre_modeset - account for vblanks across mode sets
1404  * @dev: DRM device
1405  * @pipe: CRTC index
1406  *
1407  * Account for vblank events across mode setting events, which will likely
1408  * reset the hardware frame counter.
1409  *
1410  * This is done by grabbing a temporary vblank reference to ensure that the
1411  * vblank interrupt keeps running across the modeset sequence. With this the
1412  * software-side vblank frame counting will ensure that there are no jumps or
1413  * discontinuities.
1414  *
1415  * Unfortunately this approach is racy and also doesn't work when the vblank
1416  * interrupt stops running, e.g. across system suspend resume. It is therefore
1417  * highly recommended that drivers use the newer drm_vblank_off() and
1418  * drm_vblank_on() instead. drm_vblank_pre_modeset() only works correctly when
1419  * using "cooked" software vblank frame counters and not relying on any hardware
1420  * counters.
1421  *
1422  * Drivers must call drm_vblank_post_modeset() when re-enabling the same crtc
1423  * again.
1424  */
1425 void drm_vblank_pre_modeset(struct drm_device *dev, unsigned int pipe)
1426 {
1427 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1428 
1429 	/* vblank is not initialized (IRQ not installed ?), or has been freed */
1430 	if (!dev->num_crtcs)
1431 		return;
1432 
1433 	if (WARN_ON(pipe >= dev->num_crtcs))
1434 		return;
1435 
1436 	/*
1437 	 * To avoid all the problems that might happen if interrupts
1438 	 * were enabled/disabled around or between these calls, we just
1439 	 * have the kernel take a reference on the CRTC (just once though
1440 	 * to avoid corrupting the count if multiple, mismatch calls occur),
1441 	 * so that interrupts remain enabled in the interim.
1442 	 */
1443 	if (!vblank->inmodeset) {
1444 		vblank->inmodeset = 0x1;
1445 		if (drm_vblank_get(dev, pipe) == 0)
1446 			vblank->inmodeset |= 0x2;
1447 	}
1448 }
1449 EXPORT_SYMBOL(drm_vblank_pre_modeset);
1450 
1451 /**
1452  * drm_vblank_post_modeset - undo drm_vblank_pre_modeset changes
1453  * @dev: DRM device
1454  * @pipe: CRTC index
1455  *
1456  * This function again drops the temporary vblank reference acquired in
1457  * drm_vblank_pre_modeset.
1458  */
1459 void drm_vblank_post_modeset(struct drm_device *dev, unsigned int pipe)
1460 {
1461 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1462 	unsigned long irqflags;
1463 
1464 	/* vblank is not initialized (IRQ not installed ?), or has been freed */
1465 	if (!dev->num_crtcs)
1466 		return;
1467 
1468 	if (WARN_ON(pipe >= dev->num_crtcs))
1469 		return;
1470 
1471 	if (vblank->inmodeset) {
1472 		spin_lock_irqsave(&dev->vbl_lock, irqflags);
1473 		dev->vblank_disable_allowed = true;
1474 		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
1475 
1476 		if (vblank->inmodeset & 0x2)
1477 			drm_vblank_put(dev, pipe);
1478 
1479 		vblank->inmodeset = 0;
1480 	}
1481 }
1482 EXPORT_SYMBOL(drm_vblank_post_modeset);
1483 
1484 /*
1485  * drm_modeset_ctl - handle vblank event counter changes across mode switch
1486  * @DRM_IOCTL_ARGS: standard ioctl arguments
1487  *
1488  * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET
1489  * ioctls around modesetting so that any lost vblank events are accounted for.
1490  *
1491  * Generally the counter will reset across mode sets.  If interrupts are
1492  * enabled around this call, we don't have to do anything since the counter
1493  * will have already been incremented.
1494  */
1495 int drm_modeset_ctl(struct drm_device *dev, void *data,
1496 		    struct drm_file *file_priv)
1497 {
1498 	struct drm_modeset_ctl *modeset = data;
1499 	unsigned int pipe;
1500 
1501 	/* If drm_vblank_init() hasn't been called yet, just no-op */
1502 	if (!dev->num_crtcs)
1503 		return 0;
1504 
1505 	/* KMS drivers handle this internally */
1506 	if (drm_core_check_feature(dev, DRIVER_MODESET))
1507 		return 0;
1508 
1509 	pipe = modeset->crtc;
1510 	if (pipe >= dev->num_crtcs)
1511 		return -EINVAL;
1512 
1513 	switch (modeset->cmd) {
1514 	case _DRM_PRE_MODESET:
1515 		drm_vblank_pre_modeset(dev, pipe);
1516 		break;
1517 	case _DRM_POST_MODESET:
1518 		drm_vblank_post_modeset(dev, pipe);
1519 		break;
1520 	default:
1521 		return -EINVAL;
1522 	}
1523 
1524 	return 0;
1525 }
1526 
1527 static int drm_queue_vblank_event(struct drm_device *dev, unsigned int pipe,
1528 				  union drm_wait_vblank *vblwait,
1529 				  struct drm_file *file_priv)
1530 {
1531 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1532 	struct drm_pending_vblank_event *e;
1533 	struct timeval now;
1534 	unsigned long flags;
1535 	unsigned int seq;
1536 	int ret;
1537 
1538 	e = kzalloc(sizeof(*e), GFP_KERNEL);
1539 	if (e == NULL) {
1540 		ret = -ENOMEM;
1541 		goto err_put;
1542 	}
1543 
1544 	e->pipe = pipe;
1545 	e->base.pid = current->pid;
1546 	e->event.base.type = DRM_EVENT_VBLANK;
1547 	e->event.base.length = sizeof(e->event);
1548 	e->event.user_data = vblwait->request.signal;
1549 	e->base.event = &e->event.base;
1550 	e->base.file_priv = file_priv;
1551 	e->base.destroy = (void (*) (struct drm_pending_event *)) kfree;
1552 
1553 	spin_lock_irqsave(&dev->event_lock, flags);
1554 
1555 	/*
1556 	 * drm_vblank_off() might have been called after we called
1557 	 * drm_vblank_get(). drm_vblank_off() holds event_lock
1558 	 * around the vblank disable, so no need for further locking.
1559 	 * The reference from drm_vblank_get() protects against
1560 	 * vblank disable from another source.
1561 	 */
1562 	if (!vblank->enabled) {
1563 		ret = -EINVAL;
1564 		goto err_unlock;
1565 	}
1566 
1567 	if (file_priv->event_space < sizeof(e->event)) {
1568 		ret = -EBUSY;
1569 		goto err_unlock;
1570 	}
1571 
1572 	file_priv->event_space -= sizeof(e->event);
1573 	seq = drm_vblank_count_and_time(dev, pipe, &now);
1574 
1575 	if ((vblwait->request.type & _DRM_VBLANK_NEXTONMISS) &&
1576 	    (seq - vblwait->request.sequence) <= (1 << 23)) {
1577 		vblwait->request.sequence = seq + 1;
1578 		vblwait->reply.sequence = vblwait->request.sequence;
1579 	}
1580 
1581 	DRM_DEBUG("event on vblank count %d, current %d, crtc %u\n",
1582 		  vblwait->request.sequence, seq, pipe);
1583 
1584 	trace_drm_vblank_event_queued(current->pid, pipe,
1585 				      vblwait->request.sequence);
1586 
1587 	e->event.sequence = vblwait->request.sequence;
1588 	if ((seq - vblwait->request.sequence) <= (1 << 23)) {
1589 		drm_vblank_put(dev, pipe);
1590 		send_vblank_event(dev, e, seq, &now);
1591 		vblwait->reply.sequence = seq;
1592 	} else {
1593 		/* drm_handle_vblank_events will call drm_vblank_put */
1594 		list_add_tail(&e->base.link, &dev->vblank_event_list);
1595 		vblwait->reply.sequence = vblwait->request.sequence;
1596 	}
1597 
1598 	spin_unlock_irqrestore(&dev->event_lock, flags);
1599 
1600 	return 0;
1601 
1602 err_unlock:
1603 	spin_unlock_irqrestore(&dev->event_lock, flags);
1604 	kfree(e);
1605 err_put:
1606 	drm_vblank_put(dev, pipe);
1607 	return ret;
1608 }
1609 
1610 /*
1611  * Wait for VBLANK.
1612  *
1613  * \param inode device inode.
1614  * \param file_priv DRM file private.
1615  * \param cmd command.
1616  * \param data user argument, pointing to a drm_wait_vblank structure.
1617  * \return zero on success or a negative number on failure.
1618  *
1619  * This function enables the vblank interrupt on the pipe requested, then
1620  * sleeps waiting for the requested sequence number to occur, and drops
1621  * the vblank interrupt refcount afterwards. (vblank IRQ disable follows that
1622  * after a timeout with no further vblank waits scheduled).
1623  */
1624 int drm_wait_vblank(struct drm_device *dev, void *data,
1625 		    struct drm_file *file_priv)
1626 {
1627 	struct drm_vblank_crtc *vblank;
1628 	union drm_wait_vblank *vblwait = data;
1629 	int ret;
1630 	unsigned int flags, seq, pipe, high_pipe;
1631 
1632 	if (!dev->irq_enabled)
1633 		return -EINVAL;
1634 
1635 	if (vblwait->request.type & _DRM_VBLANK_SIGNAL)
1636 		return -EINVAL;
1637 
1638 	if (vblwait->request.type &
1639 	    ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
1640 	      _DRM_VBLANK_HIGH_CRTC_MASK)) {
1641 		DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n",
1642 			  vblwait->request.type,
1643 			  (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
1644 			   _DRM_VBLANK_HIGH_CRTC_MASK));
1645 		return -EINVAL;
1646 	}
1647 
1648 	flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK;
1649 	high_pipe = (vblwait->request.type & _DRM_VBLANK_HIGH_CRTC_MASK);
1650 	if (high_pipe)
1651 		pipe = high_pipe >> _DRM_VBLANK_HIGH_CRTC_SHIFT;
1652 	else
1653 		pipe = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
1654 	if (pipe >= dev->num_crtcs)
1655 		return -EINVAL;
1656 
1657 	vblank = &dev->vblank[pipe];
1658 
1659 	ret = drm_vblank_get(dev, pipe);
1660 	if (ret) {
1661 		DRM_DEBUG("failed to acquire vblank counter, %d\n", ret);
1662 		return ret;
1663 	}
1664 	seq = drm_vblank_count(dev, pipe);
1665 
1666 	switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) {
1667 	case _DRM_VBLANK_RELATIVE:
1668 		vblwait->request.sequence += seq;
1669 		vblwait->request.type &= ~_DRM_VBLANK_RELATIVE;
1670 	case _DRM_VBLANK_ABSOLUTE:
1671 		break;
1672 	default:
1673 		ret = -EINVAL;
1674 		goto done;
1675 	}
1676 
1677 	if (flags & _DRM_VBLANK_EVENT) {
1678 		/* must hold on to the vblank ref until the event fires
1679 		 * drm_vblank_put will be called asynchronously
1680 		 */
1681 		return drm_queue_vblank_event(dev, pipe, vblwait, file_priv);
1682 	}
1683 
1684 	if ((flags & _DRM_VBLANK_NEXTONMISS) &&
1685 	    (seq - vblwait->request.sequence) <= (1<<23)) {
1686 		vblwait->request.sequence = seq + 1;
1687 	}
1688 
1689 	DRM_DEBUG("waiting on vblank count %d, crtc %u\n",
1690 		  vblwait->request.sequence, pipe);
1691 	vblank->last_wait = vblwait->request.sequence;
1692 	DRM_WAIT_ON(ret, vblank->queue, 3 * HZ,
1693 		    (((drm_vblank_count(dev, pipe) -
1694 		       vblwait->request.sequence) <= (1 << 23)) ||
1695 		     !vblank->enabled ||
1696 		     !dev->irq_enabled));
1697 
1698 	if (ret != -EINTR) {
1699 		struct timeval now;
1700 
1701 		vblwait->reply.sequence = drm_vblank_count_and_time(dev, pipe, &now);
1702 		vblwait->reply.tval_sec = now.tv_sec;
1703 		vblwait->reply.tval_usec = now.tv_usec;
1704 
1705 		DRM_DEBUG("returning %d to client\n",
1706 			  vblwait->reply.sequence);
1707 	} else {
1708 		DRM_DEBUG("vblank wait interrupted by signal\n");
1709 	}
1710 
1711 done:
1712 	drm_vblank_put(dev, pipe);
1713 	return ret;
1714 }
1715 
1716 static void drm_handle_vblank_events(struct drm_device *dev, unsigned int pipe)
1717 {
1718 	struct drm_pending_vblank_event *e, *t;
1719 	struct timeval now;
1720 	unsigned int seq;
1721 
1722 	assert_spin_locked(&dev->event_lock);
1723 
1724 	seq = drm_vblank_count_and_time(dev, pipe, &now);
1725 
1726 	list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
1727 		if (e->pipe != pipe)
1728 			continue;
1729 		if ((seq - e->event.sequence) > (1<<23))
1730 			continue;
1731 
1732 		DRM_DEBUG("vblank event on %d, current %d\n",
1733 			  e->event.sequence, seq);
1734 
1735 		list_del(&e->base.link);
1736 		drm_vblank_put(dev, pipe);
1737 		send_vblank_event(dev, e, seq, &now);
1738 	}
1739 
1740 	trace_drm_vblank_event(pipe, seq);
1741 }
1742 
1743 /**
1744  * drm_handle_vblank - handle a vblank event
1745  * @dev: DRM device
1746  * @pipe: index of CRTC where this event occurred
1747  *
1748  * Drivers should call this routine in their vblank interrupt handlers to
1749  * update the vblank counter and send any signals that may be pending.
1750  *
1751  * This is the legacy version of drm_crtc_handle_vblank().
1752  */
1753 bool drm_handle_vblank(struct drm_device *dev, unsigned int pipe)
1754 {
1755 	struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
1756 	unsigned long irqflags;
1757 
1758 	if (WARN_ON_ONCE(!dev->num_crtcs))
1759 		return false;
1760 
1761 	if (WARN_ON(pipe >= dev->num_crtcs))
1762 		return false;
1763 
1764 	spin_lock_irqsave(&dev->event_lock, irqflags);
1765 
1766 	/* Need timestamp lock to prevent concurrent execution with
1767 	 * vblank enable/disable, as this would cause inconsistent
1768 	 * or corrupted timestamps and vblank counts.
1769 	 */
1770 	spin_lock(&dev->vblank_time_lock);
1771 
1772 	/* Vblank irq handling disabled. Nothing to do. */
1773 	if (!vblank->enabled) {
1774 		spin_unlock(&dev->vblank_time_lock);
1775 		spin_unlock_irqrestore(&dev->event_lock, irqflags);
1776 		return false;
1777 	}
1778 
1779 	drm_update_vblank_count(dev, pipe, DRM_CALLED_FROM_VBLIRQ);
1780 
1781 	spin_unlock(&dev->vblank_time_lock);
1782 
1783 	wake_up(&vblank->queue);
1784 	drm_handle_vblank_events(dev, pipe);
1785 
1786 	spin_unlock_irqrestore(&dev->event_lock, irqflags);
1787 
1788 	return true;
1789 }
1790 EXPORT_SYMBOL(drm_handle_vblank);
1791 
1792 /**
1793  * drm_crtc_handle_vblank - handle a vblank event
1794  * @crtc: where this event occurred
1795  *
1796  * Drivers should call this routine in their vblank interrupt handlers to
1797  * update the vblank counter and send any signals that may be pending.
1798  *
1799  * This is the native KMS version of drm_handle_vblank().
1800  *
1801  * Returns:
1802  * True if the event was successfully handled, false on failure.
1803  */
1804 bool drm_crtc_handle_vblank(struct drm_crtc *crtc)
1805 {
1806 	return drm_handle_vblank(crtc->dev, drm_crtc_index(crtc));
1807 }
1808 EXPORT_SYMBOL(drm_crtc_handle_vblank);
1809 
1810 /**
1811  * drm_vblank_no_hw_counter - "No hw counter" implementation of .get_vblank_counter()
1812  * @dev: DRM device
1813  * @pipe: CRTC for which to read the counter
1814  *
1815  * Drivers can plug this into the .get_vblank_counter() function if
1816  * there is no useable hardware frame counter available.
1817  *
1818  * Returns:
1819  * 0
1820  */
1821 u32 drm_vblank_no_hw_counter(struct drm_device *dev, unsigned int pipe)
1822 {
1823 	return 0;
1824 }
1825 EXPORT_SYMBOL(drm_vblank_no_hw_counter);
1826