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_LEGACY)) 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_LEGACY)) 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 * issues 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_LEGACY)) 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_LEGACY)) 596 return 0; 597 /* UMS was only ever supported 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 static 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 967 /** 968 * drm_crtc_vblank_count_and_time - retrieve "cooked" vblank counter value 969 * and the system timestamp corresponding to that vblank counter value 970 * @crtc: which counter to retrieve 971 * @vblanktime: Pointer to struct timeval to receive the vblank timestamp. 972 * 973 * Fetches the "cooked" vblank count value that represents the number of 974 * vblank events since the system was booted, including lost events due to 975 * modesetting activity. Returns corresponding system timestamp of the time 976 * of the vblank interval that corresponds to the current vblank counter value. 977 */ 978 u32 drm_crtc_vblank_count_and_time(struct drm_crtc *crtc, 979 struct timeval *vblanktime) 980 { 981 return drm_vblank_count_and_time(crtc->dev, drm_crtc_index(crtc), 982 vblanktime); 983 } 984 EXPORT_SYMBOL(drm_crtc_vblank_count_and_time); 985 986 static void send_vblank_event(struct drm_device *dev, 987 struct drm_pending_vblank_event *e, 988 unsigned long seq, struct timeval *now) 989 { 990 e->event.sequence = seq; 991 e->event.tv_sec = now->tv_sec; 992 e->event.tv_usec = now->tv_usec; 993 994 trace_drm_vblank_event_delivered(e->base.pid, e->pipe, 995 e->event.sequence); 996 997 drm_send_event_locked(dev, &e->base); 998 } 999 1000 /** 1001 * drm_crtc_arm_vblank_event - arm vblank event after pageflip 1002 * @crtc: the source CRTC of the vblank event 1003 * @e: the event to send 1004 * 1005 * A lot of drivers need to generate vblank events for the very next vblank 1006 * interrupt. For example when the page flip interrupt happens when the page 1007 * flip gets armed, but not when it actually executes within the next vblank 1008 * period. This helper function implements exactly the required vblank arming 1009 * behaviour. 1010 * 1011 * NOTE: Drivers using this to send out the event in struct &drm_crtc_state 1012 * as part of an atomic commit must ensure that the next vblank happens at 1013 * exactly the same time as the atomic commit is committed to the hardware. This 1014 * function itself does **not** protect again the next vblank interrupt racing 1015 * with either this function call or the atomic commit operation. A possible 1016 * sequence could be: 1017 * 1018 * 1. Driver commits new hardware state into vblank-synchronized registers. 1019 * 2. A vblank happens, committing the hardware state. Also the corresponding 1020 * vblank interrupt is fired off and fully processed by the interrupt 1021 * handler. 1022 * 3. The atomic commit operation proceeds to call drm_crtc_arm_vblank_event(). 1023 * 4. The event is only send out for the next vblank, which is wrong. 1024 * 1025 * An equivalent race can happen when the driver calls 1026 * drm_crtc_arm_vblank_event() before writing out the new hardware state. 1027 * 1028 * The only way to make this work safely is to prevent the vblank from firing 1029 * (and the hardware from committing anything else) until the entire atomic 1030 * commit sequence has run to completion. If the hardware does not have such a 1031 * feature (e.g. using a "go" bit), then it is unsafe to use this functions. 1032 * Instead drivers need to manually send out the event from their interrupt 1033 * handler by calling drm_crtc_send_vblank_event() and make sure that there's no 1034 * possible race with the hardware committing the atomic update. 1035 * 1036 * Caller must hold event lock. Caller must also hold a vblank reference for 1037 * the event @e, which will be dropped when the next vblank arrives. 1038 */ 1039 void drm_crtc_arm_vblank_event(struct drm_crtc *crtc, 1040 struct drm_pending_vblank_event *e) 1041 { 1042 struct drm_device *dev = crtc->dev; 1043 unsigned int pipe = drm_crtc_index(crtc); 1044 1045 assert_spin_locked(&dev->event_lock); 1046 1047 e->pipe = pipe; 1048 e->event.sequence = drm_vblank_count(dev, pipe); 1049 list_add_tail(&e->base.link, &dev->vblank_event_list); 1050 } 1051 EXPORT_SYMBOL(drm_crtc_arm_vblank_event); 1052 1053 /** 1054 * drm_crtc_send_vblank_event - helper to send vblank event after pageflip 1055 * @crtc: the source CRTC of the vblank event 1056 * @e: the event to send 1057 * 1058 * Updates sequence # and timestamp on event for the most recently processed 1059 * vblank, and sends it to userspace. Caller must hold event lock. 1060 * 1061 * See drm_crtc_arm_vblank_event() for a helper which can be used in certain 1062 * situation, especially to send out events for atomic commit operations. 1063 */ 1064 void drm_crtc_send_vblank_event(struct drm_crtc *crtc, 1065 struct drm_pending_vblank_event *e) 1066 { 1067 struct drm_device *dev = crtc->dev; 1068 unsigned int seq, pipe = drm_crtc_index(crtc); 1069 struct timeval now; 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_crtc_send_vblank_event); 1082 1083 /** 1084 * drm_vblank_enable - enable the vblank interrupt on a CRTC 1085 * @dev: DRM device 1086 * @pipe: CRTC index 1087 * 1088 * Returns: 1089 * Zero on success or a negative error code on failure. 1090 */ 1091 static int drm_vblank_enable(struct drm_device *dev, unsigned int pipe) 1092 { 1093 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1094 int ret = 0; 1095 1096 assert_spin_locked(&dev->vbl_lock); 1097 1098 spin_lock(&dev->vblank_time_lock); 1099 1100 if (!vblank->enabled) { 1101 /* 1102 * Enable vblank irqs under vblank_time_lock protection. 1103 * All vblank count & timestamp updates are held off 1104 * until we are done reinitializing master counter and 1105 * timestamps. Filtercode in drm_handle_vblank() will 1106 * prevent double-accounting of same vblank interval. 1107 */ 1108 ret = dev->driver->enable_vblank(dev, pipe); 1109 DRM_DEBUG("enabling vblank on crtc %u, ret: %d\n", pipe, ret); 1110 if (ret) 1111 atomic_dec(&vblank->refcount); 1112 else { 1113 vblank->enabled = true; 1114 drm_update_vblank_count(dev, pipe, 0); 1115 } 1116 } 1117 1118 spin_unlock(&dev->vblank_time_lock); 1119 1120 return ret; 1121 } 1122 1123 /** 1124 * drm_vblank_get - get a reference count on vblank events 1125 * @dev: DRM device 1126 * @pipe: index of CRTC to own 1127 * 1128 * Acquire a reference count on vblank events to avoid having them disabled 1129 * while in use. 1130 * 1131 * This is the legacy version of drm_crtc_vblank_get(). 1132 * 1133 * Returns: 1134 * Zero on success or a negative error code on failure. 1135 */ 1136 static int drm_vblank_get(struct drm_device *dev, unsigned int pipe) 1137 { 1138 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1139 unsigned long irqflags; 1140 int ret = 0; 1141 1142 if (!dev->num_crtcs) 1143 return -EINVAL; 1144 1145 if (WARN_ON(pipe >= dev->num_crtcs)) 1146 return -EINVAL; 1147 1148 spin_lock_irqsave(&dev->vbl_lock, irqflags); 1149 /* Going from 0->1 means we have to enable interrupts again */ 1150 if (atomic_add_return(1, &vblank->refcount) == 1) { 1151 ret = drm_vblank_enable(dev, pipe); 1152 } else { 1153 if (!vblank->enabled) { 1154 atomic_dec(&vblank->refcount); 1155 ret = -EINVAL; 1156 } 1157 } 1158 spin_unlock_irqrestore(&dev->vbl_lock, irqflags); 1159 1160 return ret; 1161 } 1162 1163 /** 1164 * drm_crtc_vblank_get - get a reference count on vblank events 1165 * @crtc: which CRTC to own 1166 * 1167 * Acquire a reference count on vblank events to avoid having them disabled 1168 * while in use. 1169 * 1170 * Returns: 1171 * Zero on success or a negative error code on failure. 1172 */ 1173 int drm_crtc_vblank_get(struct drm_crtc *crtc) 1174 { 1175 return drm_vblank_get(crtc->dev, drm_crtc_index(crtc)); 1176 } 1177 EXPORT_SYMBOL(drm_crtc_vblank_get); 1178 1179 /** 1180 * drm_vblank_put - release ownership of vblank events 1181 * @dev: DRM device 1182 * @pipe: index of CRTC to release 1183 * 1184 * Release ownership of a given vblank counter, turning off interrupts 1185 * if possible. Disable interrupts after drm_vblank_offdelay milliseconds. 1186 * 1187 * This is the legacy version of drm_crtc_vblank_put(). 1188 */ 1189 static void drm_vblank_put(struct drm_device *dev, unsigned int pipe) 1190 { 1191 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1192 1193 if (WARN_ON(pipe >= dev->num_crtcs)) 1194 return; 1195 1196 if (WARN_ON(atomic_read(&vblank->refcount) == 0)) 1197 return; 1198 1199 /* Last user schedules interrupt disable */ 1200 if (atomic_dec_and_test(&vblank->refcount)) { 1201 if (drm_vblank_offdelay == 0) 1202 return; 1203 else if (dev->vblank_disable_immediate || drm_vblank_offdelay < 0) 1204 vblank_disable_fn((unsigned long)vblank); 1205 else 1206 mod_timer(&vblank->disable_timer, 1207 jiffies + ((drm_vblank_offdelay * HZ)/1000)); 1208 } 1209 } 1210 1211 /** 1212 * drm_crtc_vblank_put - give up ownership of vblank events 1213 * @crtc: which counter to give up 1214 * 1215 * Release ownership of a given vblank counter, turning off interrupts 1216 * if possible. Disable interrupts after drm_vblank_offdelay milliseconds. 1217 */ 1218 void drm_crtc_vblank_put(struct drm_crtc *crtc) 1219 { 1220 drm_vblank_put(crtc->dev, drm_crtc_index(crtc)); 1221 } 1222 EXPORT_SYMBOL(drm_crtc_vblank_put); 1223 1224 /** 1225 * drm_wait_one_vblank - wait for one vblank 1226 * @dev: DRM device 1227 * @pipe: CRTC index 1228 * 1229 * This waits for one vblank to pass on @pipe, using the irq driver interfaces. 1230 * It is a failure to call this when the vblank irq for @pipe is disabled, e.g. 1231 * due to lack of driver support or because the crtc is off. 1232 */ 1233 void drm_wait_one_vblank(struct drm_device *dev, unsigned int pipe) 1234 { 1235 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1236 int ret; 1237 u32 last; 1238 1239 if (WARN_ON(pipe >= dev->num_crtcs)) 1240 return; 1241 1242 ret = drm_vblank_get(dev, pipe); 1243 if (WARN(ret, "vblank not available on crtc %i, ret=%i\n", pipe, ret)) 1244 return; 1245 1246 last = drm_vblank_count(dev, pipe); 1247 1248 ret = wait_event_timeout(vblank->queue, 1249 last != drm_vblank_count(dev, pipe), 1250 msecs_to_jiffies(100)); 1251 1252 WARN(ret == 0, "vblank wait timed out on crtc %i\n", pipe); 1253 1254 drm_vblank_put(dev, pipe); 1255 } 1256 EXPORT_SYMBOL(drm_wait_one_vblank); 1257 1258 /** 1259 * drm_crtc_wait_one_vblank - wait for one vblank 1260 * @crtc: DRM crtc 1261 * 1262 * This waits for one vblank to pass on @crtc, using the irq driver interfaces. 1263 * It is a failure to call this when the vblank irq for @crtc is disabled, e.g. 1264 * due to lack of driver support or because the crtc is off. 1265 */ 1266 void drm_crtc_wait_one_vblank(struct drm_crtc *crtc) 1267 { 1268 drm_wait_one_vblank(crtc->dev, drm_crtc_index(crtc)); 1269 } 1270 EXPORT_SYMBOL(drm_crtc_wait_one_vblank); 1271 1272 /** 1273 * drm_vblank_off - disable vblank events on a CRTC 1274 * @dev: DRM device 1275 * @pipe: CRTC index 1276 * 1277 * Drivers can use this function to shut down the vblank interrupt handling when 1278 * disabling a crtc. This function ensures that the latest vblank frame count is 1279 * stored so that drm_vblank_on() can restore it again. 1280 * 1281 * Drivers must use this function when the hardware vblank counter can get 1282 * reset, e.g. when suspending. 1283 * 1284 * This is the legacy version of drm_crtc_vblank_off(). 1285 */ 1286 void drm_vblank_off(struct drm_device *dev, unsigned int pipe) 1287 { 1288 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1289 struct drm_pending_vblank_event *e, *t; 1290 struct timeval now; 1291 unsigned long irqflags; 1292 unsigned int seq; 1293 1294 if (WARN_ON(pipe >= dev->num_crtcs)) 1295 return; 1296 1297 spin_lock_irqsave(&dev->event_lock, irqflags); 1298 1299 spin_lock(&dev->vbl_lock); 1300 DRM_DEBUG_VBL("crtc %d, vblank enabled %d, inmodeset %d\n", 1301 pipe, vblank->enabled, vblank->inmodeset); 1302 1303 /* Avoid redundant vblank disables without previous drm_vblank_on(). */ 1304 if (drm_core_check_feature(dev, DRIVER_ATOMIC) || !vblank->inmodeset) 1305 vblank_disable_and_save(dev, pipe); 1306 1307 wake_up(&vblank->queue); 1308 1309 /* 1310 * Prevent subsequent drm_vblank_get() from re-enabling 1311 * the vblank interrupt by bumping the refcount. 1312 */ 1313 if (!vblank->inmodeset) { 1314 atomic_inc(&vblank->refcount); 1315 vblank->inmodeset = 1; 1316 } 1317 spin_unlock(&dev->vbl_lock); 1318 1319 /* Send any queued vblank events, lest the natives grow disquiet */ 1320 seq = drm_vblank_count_and_time(dev, pipe, &now); 1321 1322 list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) { 1323 if (e->pipe != pipe) 1324 continue; 1325 DRM_DEBUG("Sending premature vblank event on disable: " 1326 "wanted %u, current %u\n", 1327 e->event.sequence, seq); 1328 list_del(&e->base.link); 1329 drm_vblank_put(dev, pipe); 1330 send_vblank_event(dev, e, seq, &now); 1331 } 1332 spin_unlock_irqrestore(&dev->event_lock, irqflags); 1333 } 1334 EXPORT_SYMBOL(drm_vblank_off); 1335 1336 /** 1337 * drm_crtc_vblank_off - disable vblank events on a CRTC 1338 * @crtc: CRTC in question 1339 * 1340 * Drivers can use this function to shut down the vblank interrupt handling when 1341 * disabling a crtc. This function ensures that the latest vblank frame count is 1342 * stored so that drm_vblank_on can restore it again. 1343 * 1344 * Drivers must use this function when the hardware vblank counter can get 1345 * reset, e.g. when suspending. 1346 * 1347 * This is the native kms version of drm_vblank_off(). 1348 */ 1349 void drm_crtc_vblank_off(struct drm_crtc *crtc) 1350 { 1351 drm_vblank_off(crtc->dev, drm_crtc_index(crtc)); 1352 } 1353 EXPORT_SYMBOL(drm_crtc_vblank_off); 1354 1355 /** 1356 * drm_crtc_vblank_reset - reset vblank state to off on a CRTC 1357 * @crtc: CRTC in question 1358 * 1359 * Drivers can use this function to reset the vblank state to off at load time. 1360 * Drivers should use this together with the drm_crtc_vblank_off() and 1361 * drm_crtc_vblank_on() functions. The difference compared to 1362 * drm_crtc_vblank_off() is that this function doesn't save the vblank counter 1363 * and hence doesn't need to call any driver hooks. 1364 */ 1365 void drm_crtc_vblank_reset(struct drm_crtc *crtc) 1366 { 1367 struct drm_device *dev = crtc->dev; 1368 unsigned long irqflags; 1369 unsigned int pipe = drm_crtc_index(crtc); 1370 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1371 1372 spin_lock_irqsave(&dev->vbl_lock, irqflags); 1373 /* 1374 * Prevent subsequent drm_vblank_get() from enabling the vblank 1375 * interrupt by bumping the refcount. 1376 */ 1377 if (!vblank->inmodeset) { 1378 atomic_inc(&vblank->refcount); 1379 vblank->inmodeset = 1; 1380 } 1381 spin_unlock_irqrestore(&dev->vbl_lock, irqflags); 1382 1383 WARN_ON(!list_empty(&dev->vblank_event_list)); 1384 } 1385 EXPORT_SYMBOL(drm_crtc_vblank_reset); 1386 1387 /** 1388 * drm_vblank_on - enable vblank events on a CRTC 1389 * @dev: DRM device 1390 * @pipe: CRTC index 1391 * 1392 * This functions restores the vblank interrupt state captured with 1393 * drm_vblank_off() again. Note that calls to drm_vblank_on() and 1394 * drm_vblank_off() can be unbalanced and so can also be unconditionally called 1395 * in driver load code to reflect the current hardware state of the crtc. 1396 * 1397 * This is the legacy version of drm_crtc_vblank_on(). 1398 */ 1399 void drm_vblank_on(struct drm_device *dev, unsigned int pipe) 1400 { 1401 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1402 unsigned long irqflags; 1403 1404 if (WARN_ON(pipe >= dev->num_crtcs)) 1405 return; 1406 1407 spin_lock_irqsave(&dev->vbl_lock, irqflags); 1408 DRM_DEBUG_VBL("crtc %d, vblank enabled %d, inmodeset %d\n", 1409 pipe, vblank->enabled, vblank->inmodeset); 1410 1411 /* Drop our private "prevent drm_vblank_get" refcount */ 1412 if (vblank->inmodeset) { 1413 atomic_dec(&vblank->refcount); 1414 vblank->inmodeset = 0; 1415 } 1416 1417 drm_reset_vblank_timestamp(dev, pipe); 1418 1419 /* 1420 * re-enable interrupts if there are users left, or the 1421 * user wishes vblank interrupts to be enabled all the time. 1422 */ 1423 if (atomic_read(&vblank->refcount) != 0 || drm_vblank_offdelay == 0) 1424 WARN_ON(drm_vblank_enable(dev, pipe)); 1425 spin_unlock_irqrestore(&dev->vbl_lock, irqflags); 1426 } 1427 EXPORT_SYMBOL(drm_vblank_on); 1428 1429 /** 1430 * drm_crtc_vblank_on - enable vblank events on a CRTC 1431 * @crtc: CRTC in question 1432 * 1433 * This functions restores the vblank interrupt state captured with 1434 * drm_vblank_off() again. Note that calls to drm_vblank_on() and 1435 * drm_vblank_off() can be unbalanced and so can also be unconditionally called 1436 * in driver load code to reflect the current hardware state of the crtc. 1437 * 1438 * This is the native kms version of drm_vblank_on(). 1439 */ 1440 void drm_crtc_vblank_on(struct drm_crtc *crtc) 1441 { 1442 drm_vblank_on(crtc->dev, drm_crtc_index(crtc)); 1443 } 1444 EXPORT_SYMBOL(drm_crtc_vblank_on); 1445 1446 /** 1447 * drm_vblank_pre_modeset - account for vblanks across mode sets 1448 * @dev: DRM device 1449 * @pipe: CRTC index 1450 * 1451 * Account for vblank events across mode setting events, which will likely 1452 * reset the hardware frame counter. 1453 * 1454 * This is done by grabbing a temporary vblank reference to ensure that the 1455 * vblank interrupt keeps running across the modeset sequence. With this the 1456 * software-side vblank frame counting will ensure that there are no jumps or 1457 * discontinuities. 1458 * 1459 * Unfortunately this approach is racy and also doesn't work when the vblank 1460 * interrupt stops running, e.g. across system suspend resume. It is therefore 1461 * highly recommended that drivers use the newer drm_vblank_off() and 1462 * drm_vblank_on() instead. drm_vblank_pre_modeset() only works correctly when 1463 * using "cooked" software vblank frame counters and not relying on any hardware 1464 * counters. 1465 * 1466 * Drivers must call drm_vblank_post_modeset() when re-enabling the same crtc 1467 * again. 1468 */ 1469 void drm_vblank_pre_modeset(struct drm_device *dev, unsigned int pipe) 1470 { 1471 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1472 1473 /* vblank is not initialized (IRQ not installed ?), or has been freed */ 1474 if (!dev->num_crtcs) 1475 return; 1476 1477 if (WARN_ON(pipe >= dev->num_crtcs)) 1478 return; 1479 1480 /* 1481 * To avoid all the problems that might happen if interrupts 1482 * were enabled/disabled around or between these calls, we just 1483 * have the kernel take a reference on the CRTC (just once though 1484 * to avoid corrupting the count if multiple, mismatch calls occur), 1485 * so that interrupts remain enabled in the interim. 1486 */ 1487 if (!vblank->inmodeset) { 1488 vblank->inmodeset = 0x1; 1489 if (drm_vblank_get(dev, pipe) == 0) 1490 vblank->inmodeset |= 0x2; 1491 } 1492 } 1493 EXPORT_SYMBOL(drm_vblank_pre_modeset); 1494 1495 /** 1496 * drm_vblank_post_modeset - undo drm_vblank_pre_modeset changes 1497 * @dev: DRM device 1498 * @pipe: CRTC index 1499 * 1500 * This function again drops the temporary vblank reference acquired in 1501 * drm_vblank_pre_modeset. 1502 */ 1503 void drm_vblank_post_modeset(struct drm_device *dev, unsigned int pipe) 1504 { 1505 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1506 unsigned long irqflags; 1507 1508 /* vblank is not initialized (IRQ not installed ?), or has been freed */ 1509 if (!dev->num_crtcs) 1510 return; 1511 1512 if (WARN_ON(pipe >= dev->num_crtcs)) 1513 return; 1514 1515 if (vblank->inmodeset) { 1516 spin_lock_irqsave(&dev->vbl_lock, irqflags); 1517 drm_reset_vblank_timestamp(dev, pipe); 1518 spin_unlock_irqrestore(&dev->vbl_lock, irqflags); 1519 1520 if (vblank->inmodeset & 0x2) 1521 drm_vblank_put(dev, pipe); 1522 1523 vblank->inmodeset = 0; 1524 } 1525 } 1526 EXPORT_SYMBOL(drm_vblank_post_modeset); 1527 1528 /* 1529 * drm_modeset_ctl - handle vblank event counter changes across mode switch 1530 * @DRM_IOCTL_ARGS: standard ioctl arguments 1531 * 1532 * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET 1533 * ioctls around modesetting so that any lost vblank events are accounted for. 1534 * 1535 * Generally the counter will reset across mode sets. If interrupts are 1536 * enabled around this call, we don't have to do anything since the counter 1537 * will have already been incremented. 1538 */ 1539 int drm_modeset_ctl(struct drm_device *dev, void *data, 1540 struct drm_file *file_priv) 1541 { 1542 struct drm_modeset_ctl *modeset = data; 1543 unsigned int pipe; 1544 1545 /* If drm_vblank_init() hasn't been called yet, just no-op */ 1546 if (!dev->num_crtcs) 1547 return 0; 1548 1549 /* KMS drivers handle this internally */ 1550 if (!drm_core_check_feature(dev, DRIVER_LEGACY)) 1551 return 0; 1552 1553 pipe = modeset->crtc; 1554 if (pipe >= dev->num_crtcs) 1555 return -EINVAL; 1556 1557 switch (modeset->cmd) { 1558 case _DRM_PRE_MODESET: 1559 drm_vblank_pre_modeset(dev, pipe); 1560 break; 1561 case _DRM_POST_MODESET: 1562 drm_vblank_post_modeset(dev, pipe); 1563 break; 1564 default: 1565 return -EINVAL; 1566 } 1567 1568 return 0; 1569 } 1570 1571 static int drm_queue_vblank_event(struct drm_device *dev, unsigned int pipe, 1572 union drm_wait_vblank *vblwait, 1573 struct drm_file *file_priv) 1574 { 1575 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1576 struct drm_pending_vblank_event *e; 1577 struct timeval now; 1578 unsigned long flags; 1579 unsigned int seq; 1580 int ret; 1581 1582 e = kzalloc(sizeof(*e), GFP_KERNEL); 1583 if (e == NULL) { 1584 ret = -ENOMEM; 1585 goto err_put; 1586 } 1587 1588 e->pipe = pipe; 1589 e->base.pid = current->pid; 1590 e->event.base.type = DRM_EVENT_VBLANK; 1591 e->event.base.length = sizeof(e->event); 1592 e->event.user_data = vblwait->request.signal; 1593 1594 spin_lock_irqsave(&dev->event_lock, flags); 1595 1596 /* 1597 * drm_vblank_off() might have been called after we called 1598 * drm_vblank_get(). drm_vblank_off() holds event_lock 1599 * around the vblank disable, so no need for further locking. 1600 * The reference from drm_vblank_get() protects against 1601 * vblank disable from another source. 1602 */ 1603 if (!vblank->enabled) { 1604 ret = -EINVAL; 1605 goto err_unlock; 1606 } 1607 1608 ret = drm_event_reserve_init_locked(dev, file_priv, &e->base, 1609 &e->event.base); 1610 1611 if (ret) 1612 goto err_unlock; 1613 1614 seq = drm_vblank_count_and_time(dev, pipe, &now); 1615 1616 DRM_DEBUG("event on vblank count %u, current %u, crtc %u\n", 1617 vblwait->request.sequence, seq, pipe); 1618 1619 trace_drm_vblank_event_queued(current->pid, pipe, 1620 vblwait->request.sequence); 1621 1622 e->event.sequence = vblwait->request.sequence; 1623 if ((seq - vblwait->request.sequence) <= (1 << 23)) { 1624 drm_vblank_put(dev, pipe); 1625 send_vblank_event(dev, e, seq, &now); 1626 vblwait->reply.sequence = seq; 1627 } else { 1628 /* drm_handle_vblank_events will call drm_vblank_put */ 1629 list_add_tail(&e->base.link, &dev->vblank_event_list); 1630 vblwait->reply.sequence = vblwait->request.sequence; 1631 } 1632 1633 spin_unlock_irqrestore(&dev->event_lock, flags); 1634 1635 return 0; 1636 1637 err_unlock: 1638 spin_unlock_irqrestore(&dev->event_lock, flags); 1639 kfree(e); 1640 err_put: 1641 drm_vblank_put(dev, pipe); 1642 return ret; 1643 } 1644 1645 /* 1646 * Wait for VBLANK. 1647 * 1648 * \param inode device inode. 1649 * \param file_priv DRM file private. 1650 * \param cmd command. 1651 * \param data user argument, pointing to a drm_wait_vblank structure. 1652 * \return zero on success or a negative number on failure. 1653 * 1654 * This function enables the vblank interrupt on the pipe requested, then 1655 * sleeps waiting for the requested sequence number to occur, and drops 1656 * the vblank interrupt refcount afterwards. (vblank IRQ disable follows that 1657 * after a timeout with no further vblank waits scheduled). 1658 */ 1659 int drm_wait_vblank(struct drm_device *dev, void *data, 1660 struct drm_file *file_priv) 1661 { 1662 struct drm_vblank_crtc *vblank; 1663 union drm_wait_vblank *vblwait = data; 1664 int ret; 1665 unsigned int flags, seq, pipe, high_pipe; 1666 1667 if (!dev->irq_enabled) 1668 return -EINVAL; 1669 1670 if (vblwait->request.type & _DRM_VBLANK_SIGNAL) 1671 return -EINVAL; 1672 1673 if (vblwait->request.type & 1674 ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK | 1675 _DRM_VBLANK_HIGH_CRTC_MASK)) { 1676 DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n", 1677 vblwait->request.type, 1678 (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK | 1679 _DRM_VBLANK_HIGH_CRTC_MASK)); 1680 return -EINVAL; 1681 } 1682 1683 flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK; 1684 high_pipe = (vblwait->request.type & _DRM_VBLANK_HIGH_CRTC_MASK); 1685 if (high_pipe) 1686 pipe = high_pipe >> _DRM_VBLANK_HIGH_CRTC_SHIFT; 1687 else 1688 pipe = flags & _DRM_VBLANK_SECONDARY ? 1 : 0; 1689 if (pipe >= dev->num_crtcs) 1690 return -EINVAL; 1691 1692 vblank = &dev->vblank[pipe]; 1693 1694 ret = drm_vblank_get(dev, pipe); 1695 if (ret) { 1696 DRM_DEBUG("failed to acquire vblank counter, %d\n", ret); 1697 return ret; 1698 } 1699 seq = drm_vblank_count(dev, pipe); 1700 1701 switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) { 1702 case _DRM_VBLANK_RELATIVE: 1703 vblwait->request.sequence += seq; 1704 vblwait->request.type &= ~_DRM_VBLANK_RELATIVE; 1705 case _DRM_VBLANK_ABSOLUTE: 1706 break; 1707 default: 1708 ret = -EINVAL; 1709 goto done; 1710 } 1711 1712 if ((flags & _DRM_VBLANK_NEXTONMISS) && 1713 (seq - vblwait->request.sequence) <= (1 << 23)) { 1714 vblwait->request.sequence = seq + 1; 1715 } 1716 1717 if (flags & _DRM_VBLANK_EVENT) { 1718 /* must hold on to the vblank ref until the event fires 1719 * drm_vblank_put will be called asynchronously 1720 */ 1721 return drm_queue_vblank_event(dev, pipe, vblwait, file_priv); 1722 } 1723 1724 DRM_DEBUG("waiting on vblank count %u, crtc %u\n", 1725 vblwait->request.sequence, pipe); 1726 DRM_WAIT_ON(ret, vblank->queue, 3 * HZ, 1727 (((drm_vblank_count(dev, pipe) - 1728 vblwait->request.sequence) <= (1 << 23)) || 1729 !vblank->enabled || 1730 !dev->irq_enabled)); 1731 1732 if (ret != -EINTR) { 1733 struct timeval now; 1734 1735 vblwait->reply.sequence = drm_vblank_count_and_time(dev, pipe, &now); 1736 vblwait->reply.tval_sec = now.tv_sec; 1737 vblwait->reply.tval_usec = now.tv_usec; 1738 1739 DRM_DEBUG("returning %u to client\n", 1740 vblwait->reply.sequence); 1741 } else { 1742 DRM_DEBUG("vblank wait interrupted by signal\n"); 1743 } 1744 1745 done: 1746 drm_vblank_put(dev, pipe); 1747 return ret; 1748 } 1749 1750 static void drm_handle_vblank_events(struct drm_device *dev, unsigned int pipe) 1751 { 1752 struct drm_pending_vblank_event *e, *t; 1753 struct timeval now; 1754 unsigned int seq; 1755 1756 assert_spin_locked(&dev->event_lock); 1757 1758 seq = drm_vblank_count_and_time(dev, pipe, &now); 1759 1760 list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) { 1761 if (e->pipe != pipe) 1762 continue; 1763 if ((seq - e->event.sequence) > (1<<23)) 1764 continue; 1765 1766 DRM_DEBUG("vblank event on %u, current %u\n", 1767 e->event.sequence, seq); 1768 1769 list_del(&e->base.link); 1770 drm_vblank_put(dev, pipe); 1771 send_vblank_event(dev, e, seq, &now); 1772 } 1773 1774 trace_drm_vblank_event(pipe, seq); 1775 } 1776 1777 /** 1778 * drm_handle_vblank - handle a vblank event 1779 * @dev: DRM device 1780 * @pipe: index of CRTC where this event occurred 1781 * 1782 * Drivers should call this routine in their vblank interrupt handlers to 1783 * update the vblank counter and send any signals that may be pending. 1784 * 1785 * This is the legacy version of drm_crtc_handle_vblank(). 1786 */ 1787 bool drm_handle_vblank(struct drm_device *dev, unsigned int pipe) 1788 { 1789 struct drm_vblank_crtc *vblank = &dev->vblank[pipe]; 1790 unsigned long irqflags; 1791 1792 if (WARN_ON_ONCE(!dev->num_crtcs)) 1793 return false; 1794 1795 if (WARN_ON(pipe >= dev->num_crtcs)) 1796 return false; 1797 1798 spin_lock_irqsave(&dev->event_lock, irqflags); 1799 1800 /* Need timestamp lock to prevent concurrent execution with 1801 * vblank enable/disable, as this would cause inconsistent 1802 * or corrupted timestamps and vblank counts. 1803 */ 1804 spin_lock(&dev->vblank_time_lock); 1805 1806 /* Vblank irq handling disabled. Nothing to do. */ 1807 if (!vblank->enabled) { 1808 spin_unlock(&dev->vblank_time_lock); 1809 spin_unlock_irqrestore(&dev->event_lock, irqflags); 1810 return false; 1811 } 1812 1813 drm_update_vblank_count(dev, pipe, DRM_CALLED_FROM_VBLIRQ); 1814 1815 spin_unlock(&dev->vblank_time_lock); 1816 1817 wake_up(&vblank->queue); 1818 drm_handle_vblank_events(dev, pipe); 1819 1820 spin_unlock_irqrestore(&dev->event_lock, irqflags); 1821 1822 return true; 1823 } 1824 EXPORT_SYMBOL(drm_handle_vblank); 1825 1826 /** 1827 * drm_crtc_handle_vblank - handle a vblank event 1828 * @crtc: where this event occurred 1829 * 1830 * Drivers should call this routine in their vblank interrupt handlers to 1831 * update the vblank counter and send any signals that may be pending. 1832 * 1833 * This is the native KMS version of drm_handle_vblank(). 1834 * 1835 * Returns: 1836 * True if the event was successfully handled, false on failure. 1837 */ 1838 bool drm_crtc_handle_vblank(struct drm_crtc *crtc) 1839 { 1840 return drm_handle_vblank(crtc->dev, drm_crtc_index(crtc)); 1841 } 1842 EXPORT_SYMBOL(drm_crtc_handle_vblank); 1843 1844 /** 1845 * drm_vblank_no_hw_counter - "No hw counter" implementation of .get_vblank_counter() 1846 * @dev: DRM device 1847 * @pipe: CRTC for which to read the counter 1848 * 1849 * Drivers can plug this into the .get_vblank_counter() function if 1850 * there is no useable hardware frame counter available. 1851 * 1852 * Returns: 1853 * 0 1854 */ 1855 u32 drm_vblank_no_hw_counter(struct drm_device *dev, unsigned int pipe) 1856 { 1857 WARN_ON_ONCE(dev->max_vblank_count != 0); 1858 return 0; 1859 } 1860 EXPORT_SYMBOL(drm_vblank_no_hw_counter); 1861