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