linux-core/drm_irq.c

   1 /**
   2  * \file drm_irq.c
   3  * IRQ support
   4  *
   5  * \author Rickard E. (Rik) Faith <faith@valinux.com>
   6  * \author Gareth Hughes <gareth@valinux.com>
   7  */
   8
   9 /*
  10  * Created: Fri Mar 19 14:30:16 1999 by faith@valinux.com
  11  *
  12  * Copyright 1999, 2000 Precision Insight, Inc., Cedar Park, Texas.
  13  * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
  14  * All Rights Reserved.
  15  *
  16  * Permission is hereby granted, free of charge, to any person obtaining a
  17  * copy of this software and associated documentation files (the "Software"),
  18  * to deal in the Software without restriction, including without limitation
  19  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  20  * and/or sell copies of the Software, and to permit persons to whom the
  21  * Software is furnished to do so, subject to the following conditions:
  22  *
  23  * The above copyright notice and this permission notice (including the next
  24  * paragraph) shall be included in all copies or substantial portions of the
  25  * Software.
  26  *
  27  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  28  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  29  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  30  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  31  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  32  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  33  * OTHER DEALINGS IN THE SOFTWARE.
  34  */
  35
  36 #include "drmP.h"
  37
  38 #include <linux/interrupt.h>    /* For task queue support */
  39
  40 /**
  41  * Get interrupt from bus id.
  42  *
  43  * \param inode device inode.
  44  * \param file_priv DRM file private.
  45  * \param cmd command.
  46  * \param arg user argument, pointing to a drm_irq_busid structure.
  47  * \return zero on success or a negative number on failure.
  48  *
  49  * Finds the PCI device with the specified bus id and gets its IRQ number.
  50  * This IOCTL is deprecated, and will now return EINVAL for any busid not equal
  51  * to that of the device that this DRM instance attached to.
  52  */
  53 int drm_irq_by_busid(struct drm_device *dev, void *data,
  54                      struct drm_file *file_priv)
  55 {
  56         struct drm_irq_busid *p = data;
  57
  58         if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
  59                 return -EINVAL;
  60
  61         if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
  62             (p->busnum & 0xff) != dev->pdev->bus->number ||
  63             p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
  64                 return -EINVAL;
  65
  66         p->irq = dev->irq;
  67
  68         DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
  69                   p->irq);
  70
  71         return 0;
  72 }
  73
  74 static void vblank_disable_fn(unsigned long arg)
  75 {
  76         struct drm_device *dev = (struct drm_device *)arg;
  77         unsigned long irqflags;
  78         int i;
  79
  80         if (!dev->vblank_disable_allowed)
  81                 return;
  82
  83         for (i = 0; i < dev->num_crtcs; i++) {
  84                 spin_lock_irqsave(&dev->vbl_lock, irqflags);
  85                 if (atomic_read(&dev->vblank_refcount[i]) == 0 &&
  86                     dev->vblank_enabled[i]) {
  87                         DRM_DEBUG("disabling vblank on crtc %d\n", i);
  88                         dev->last_vblank[i] =
  89                                 dev->driver->get_vblank_counter(dev, i);
  90                         dev->driver->disable_vblank(dev, i);
  91                         dev->vblank_enabled[i] = 0;
  92                 }
  93                 spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  94         }
  95 }
  96
  97 static void drm_vblank_cleanup(struct drm_device *dev)
  98 {
  99         /* Bail if the driver didn't call drm_vblank_init() */
 100         if (dev->num_crtcs == 0)
 101                 return;
 102
 103         del_timer(&dev->vblank_disable_timer);
 104
 105         vblank_disable_fn((unsigned long)dev);
 106
 107         drm_free(dev->vbl_queue, sizeof(*dev->vbl_queue) * dev->num_crtcs,
 108                  DRM_MEM_DRIVER);
 109         drm_free(dev->vbl_sigs, sizeof(*dev->vbl_sigs) * dev->num_crtcs,
 110                  DRM_MEM_DRIVER);
 111         drm_free(dev->_vblank_count, sizeof(*dev->_vblank_count) *
 112                  dev->num_crtcs, DRM_MEM_DRIVER);
 113         drm_free(dev->vblank_refcount, sizeof(*dev->vblank_refcount) *
 114                  dev->num_crtcs, DRM_MEM_DRIVER);
 115         drm_free(dev->vblank_enabled, sizeof(*dev->vblank_enabled) *
 116                  dev->num_crtcs, DRM_MEM_DRIVER);
 117         drm_free(dev->last_vblank, sizeof(*dev->last_vblank) * dev->num_crtcs,
 118                  DRM_MEM_DRIVER);
 119         drm_free(dev->vblank_inmodeset, sizeof(*dev->vblank_inmodeset) *
 120                  dev->num_crtcs, DRM_MEM_DRIVER);
 121
 122         dev->num_crtcs = 0;
 123 }
 124
 125 int drm_vblank_init(struct drm_device *dev, int num_crtcs)
 126 {
 127         int i, ret = -ENOMEM;
 128
 129         setup_timer(&dev->vblank_disable_timer, vblank_disable_fn,
 130                     (unsigned long)dev);
 131         spin_lock_init(&dev->vbl_lock);
 132         atomic_set(&dev->vbl_signal_pending, 0);
 133         dev->num_crtcs = num_crtcs;
 134
 135         dev->vbl_queue = drm_alloc(sizeof(wait_queue_head_t) * num_crtcs,
 136                                    DRM_MEM_DRIVER);
 137         if (!dev->vbl_queue)
 138                 goto err;
 139
 140         dev->vbl_sigs = drm_alloc(sizeof(struct list_head) * num_crtcs,
 141                                   DRM_MEM_DRIVER);
 142         if (!dev->vbl_sigs)
 143                 goto err;
 144
 145         dev->_vblank_count = drm_alloc(sizeof(atomic_t) * num_crtcs,
 146                                       DRM_MEM_DRIVER);
 147         if (!dev->_vblank_count)
 148                 goto err;
 149
 150         dev->vblank_refcount = drm_alloc(sizeof(atomic_t) * num_crtcs,
 151                                          DRM_MEM_DRIVER);
 152         if (!dev->vblank_refcount)
 153                 goto err;
 154
 155         dev->vblank_enabled = drm_calloc(num_crtcs, sizeof(int),
 156                                          DRM_MEM_DRIVER);
 157         if (!dev->vblank_enabled)
 158                 goto err;
 159
 160         dev->last_vblank = drm_calloc(num_crtcs, sizeof(u32), DRM_MEM_DRIVER);
 161         if (!dev->last_vblank)
 162                 goto err;
 163
 164         dev->vblank_inmodeset = drm_calloc(num_crtcs, sizeof(int),
 165                                          DRM_MEM_DRIVER);
 166         if (!dev->vblank_inmodeset)
 167                 goto err;
 168
 169         /* Zero per-crtc vblank stuff */
 170         for (i = 0; i < num_crtcs; i++) {
 171                 init_waitqueue_head(&dev->vbl_queue[i]);
 172                 INIT_LIST_HEAD(&dev->vbl_sigs[i]);
 173                 atomic_set(&dev->_vblank_count[i], 0);
 174                 atomic_set(&dev->vblank_refcount[i], 0);
 175         }
 176
 177         dev->vblank_disable_allowed = 0;
 178
 179         return 0;
 180
 181 err:
 182         drm_vblank_cleanup(dev);
 183         return ret;
 184 }
 185 EXPORT_SYMBOL(drm_vblank_init);
 186
 187 /**
 188  * Install IRQ handler.
 189  *
 190  * \param dev DRM device.
 191  *
 192  * Initializes the IRQ related data. Installs the handler, calling the driver
 193  * \c drm_driver_irq_preinstall() and \c drm_driver_irq_postinstall() functions
 194  * before and after the installation.
 195  */
 196 int drm_irq_install(struct drm_device * dev)
 197 {
 198         int ret = 0;
 199         unsigned long sh_flags = 0;
 200
 201         if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
 202                 return -EINVAL;
 203
 204         if (dev->irq == 0)
 205                 return -EINVAL;
 206
 207         mutex_lock(&dev->struct_mutex);
 208
 209         /* Driver must have been initialized */
 210         if (!dev->dev_private) {
 211                 mutex_unlock(&dev->struct_mutex);
 212                 return -EINVAL;
 213         }
 214
 215         if (dev->irq_enabled) {
 216                 mutex_unlock(&dev->struct_mutex);
 217                 return -EBUSY;
 218         }
 219         dev->irq_enabled = 1;
 220         mutex_unlock(&dev->struct_mutex);
 221
 222         DRM_DEBUG("irq=%d\n", dev->irq);
 223
 224         /* Before installing handler */
 225         dev->driver->irq_preinstall(dev);
 226
 227         /* Install handler */
 228         if (drm_core_check_feature(dev, DRIVER_IRQ_SHARED))
 229                 sh_flags = IRQF_SHARED;
 230
 231         ret = request_irq(dev->irq, dev->driver->irq_handler,
 232                           sh_flags, dev->devname, dev);
 233         if (ret < 0) {
 234                 mutex_lock(&dev->struct_mutex);
 235                 dev->irq_enabled = 0;
 236                 mutex_unlock(&dev->struct_mutex);
 237                 return ret;
 238         }
 239
 240         /* After installing handler */
 241         ret = dev->driver->irq_postinstall(dev);
 242         if (ret < 0) {
 243                 mutex_lock(&dev->struct_mutex);
 244                 dev->irq_enabled = 0;
 245                 mutex_unlock(&dev->struct_mutex);
 246         }
 247
 248         return ret;
 249 }
 250 EXPORT_SYMBOL(drm_irq_install);
 251
 252 /**
 253  * Uninstall the IRQ handler.
 254  *
 255  * \param dev DRM device.
 256  *
 257  * Calls the driver's \c drm_driver_irq_uninstall() function, and stops the irq.
 258  */
 259 int drm_irq_uninstall(struct drm_device * dev)
 260 {
 261         int irq_enabled;
 262
 263         if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
 264                 return -EINVAL;
 265
 266         mutex_lock(&dev->struct_mutex);
 267         irq_enabled = dev->irq_enabled;
 268         dev->irq_enabled = 0;
 269         mutex_unlock(&dev->struct_mutex);
 270
 271         if (!irq_enabled)
 272                 return -EINVAL;
 273
 274         DRM_DEBUG("irq=%d\n", dev->irq);
 275
 276         dev->driver->irq_uninstall(dev);
 277
 278         free_irq(dev->irq, dev);
 279
 280         drm_vblank_cleanup(dev);
 281
 282         dev->locked_tasklet_func = NULL;
 283
 284         return 0;
 285 }
 286 EXPORT_SYMBOL(drm_irq_uninstall);
 287
 288 /**
 289  * IRQ control ioctl.
 290  *
 291  * \param inode device inode.
 292  * \param file_priv DRM file private.
 293  * \param cmd command.
 294  * \param arg user argument, pointing to a drm_control structure.
 295  * \return zero on success or a negative number on failure.
 296  *
 297  * Calls irq_install() or irq_uninstall() according to \p arg.
 298  */
 299 int drm_control(struct drm_device *dev, void *data,
 300                 struct drm_file *file_priv)
 301 {
 302         struct drm_control *ctl = data;
 303
 304         /* if we haven't irq we fallback for compatibility reasons - this used to be a separate function in drm_dma.h */
 305
 306
 307         switch (ctl->func) {
 308         case DRM_INST_HANDLER:
 309                 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
 310                         return 0;
 311                 if (dev->if_version < DRM_IF_VERSION(1, 2) &&
 312                     ctl->irq != dev->irq)
 313                         return -EINVAL;
 314                 return drm_irq_install(dev);
 315         case DRM_UNINST_HANDLER:
 316                 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
 317                         return 0;
 318                 return drm_irq_uninstall(dev);
 319         default:
 320                 return -EINVAL;
 321         }
 322 }
 323
 324 /**
 325  * drm_vblank_count - retrieve "cooked" vblank counter value
 326  * @dev: DRM device
 327  * @crtc: which counter to retrieve
 328  *
 329  * Fetches the "cooked" vblank count value that represents the number of
 330  * vblank events since the system was booted, including lost events due to
 331  * modesetting activity.
 332  */
 333 u32 drm_vblank_count(struct drm_device *dev, int crtc)
 334 {
 335         return atomic_read(&dev->_vblank_count[crtc]);
 336 }
 337 EXPORT_SYMBOL(drm_vblank_count);
 338
 339 /**
 340  * drm_update_vblank_count - update the master vblank counter
 341  * @dev: DRM device
 342  * @crtc: counter to update
 343  *
 344  * Call back into the driver to update the appropriate vblank counter
 345  * (specified by @crtc).  Deal with wraparound, if it occurred, and
 346  * update the last read value so we can deal with wraparound on the next
 347  * call if necessary.
 348  *
 349  * Only necessary when going from off->on, to account for frames we
 350  * didn't get an interrupt for.
 351  *
 352  * Note: caller must hold dev->vbl_lock since this reads & writes
 353  * device vblank fields.
 354  */
 355 static void drm_update_vblank_count(struct drm_device *dev, int crtc)
 356 {
 357         u32 cur_vblank, diff;
 358
 359         /*
 360          * Interrupts were disabled prior to this call, so deal with counter
 361          * wrap if needed.
 362          * NOTE!  It's possible we lost a full dev->max_vblank_count events
 363          * here if the register is small or we had vblank interrupts off for
 364          * a long time.
 365          */
 366         cur_vblank = dev->driver->get_vblank_counter(dev, crtc);
 367         diff = cur_vblank - dev->last_vblank[crtc];
 368         if (cur_vblank < dev->last_vblank[crtc]) {
 369                 diff += dev->max_vblank_count;
 370
 371                 DRM_DEBUG("last_vblank[%d]=0x%x, cur_vblank=0x%x => diff=0x%x\n",
 372                           crtc, dev->last_vblank[crtc], cur_vblank, diff);
 373         }
 374
 375         DRM_DEBUG("enabling vblank interrupts on crtc %d, missed %d\n",
 376                   crtc, diff);
 377
 378         atomic_add(diff, &dev->_vblank_count[crtc]);
 379 }
 380
 381 /**
 382  * drm_vblank_get - get a reference count on vblank events
 383  * @dev: DRM device
 384  * @crtc: which CRTC to own
 385  *
 386  * Acquire a reference count on vblank events to avoid having them disabled
 387  * while in use.
 388  *
 389  * RETURNS
 390  * Zero on success, nonzero on failure.
 391  */
 392 int drm_vblank_get(struct drm_device *dev, int crtc)
 393 {
 394         unsigned long irqflags;
 395         int ret = 0;
 396
 397         spin_lock_irqsave(&dev->vbl_lock, irqflags);
 398         /* Going from 0->1 means we have to enable interrupts again */
 399         if (atomic_add_return(1, &dev->vblank_refcount[crtc]) == 1 &&
 400             !dev->vblank_enabled[crtc]) {
 401                 ret = dev->driver->enable_vblank(dev, crtc);
 402                 if (ret)
 403                         atomic_dec(&dev->vblank_refcount[crtc]);
 404                 else {
 405                         dev->vblank_enabled[crtc] = 1;
 406                         drm_update_vblank_count(dev, crtc);
 407                 }
 408         }
 409         spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
 410
 411         return ret;
 412 }
 413 EXPORT_SYMBOL(drm_vblank_get);
 414
 415 /**
 416  * drm_vblank_put - give up ownership of vblank events
 417  * @dev: DRM device
 418  * @crtc: which counter to give up
 419  *
 420  * Release ownership of a given vblank counter, turning off interrupts
 421  * if possible.
 422  */
 423 void drm_vblank_put(struct drm_device *dev, int crtc)
 424 {
 425         /* Last user schedules interrupt disable */
 426         if (atomic_dec_and_test(&dev->vblank_refcount[crtc]))
 427             mod_timer(&dev->vblank_disable_timer, jiffies + 5*DRM_HZ);
 428 }
 429 EXPORT_SYMBOL(drm_vblank_put);
 430
 431 /**
 432  * drm_modeset_ctl - handle vblank event counter changes across mode switch
 433  * @DRM_IOCTL_ARGS: standard ioctl arguments
 434  *
 435  * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET
 436  * ioctls around modesetting so that any lost vblank events are accounted for.
 437  *
 438  * Generally the counter will reset across mode sets.  If interrupts are
 439  * enabled around this call, we don't have to do anything since the counter
 440  * will have already been incremented.
 441  */
 442 int drm_modeset_ctl(struct drm_device *dev, void *data,
 443                     struct drm_file *file_priv)
 444 {
 445         struct drm_modeset_ctl *modeset = data;
 446         unsigned long irqflags;
 447         int crtc, ret = 0;
 448
 449         /* If drm_vblank_init() hasn't been called yet, just no-op */
 450         if (!dev->num_crtcs)
 451                 goto out;
 452
 453         crtc = modeset->crtc;
 454         if (crtc >= dev->num_crtcs) {
 455                 ret = -EINVAL;
 456                 goto out;
 457         }
 458
 459         /*
 460          * To avoid all the problems that might happen if interrupts
 461          * were enabled/disabled around or between these calls, we just
 462          * have the kernel take a reference on the CRTC (just once though
 463          * to avoid corrupting the count if multiple, mismatch calls occur),
 464          * so that interrupts remain enabled in the interim.
 465          */
 466         switch (modeset->cmd) {
 467         case _DRM_PRE_MODESET:
 468                 if (!dev->vblank_inmodeset[crtc]) {
 469                         dev->vblank_inmodeset[crtc] = 1;
 470                         drm_vblank_get(dev, crtc);
 471                 }
 472                 break;
 473         case _DRM_POST_MODESET:
 474                 if (dev->vblank_inmodeset[crtc]) {
 475                         spin_lock_irqsave(&dev->vbl_lock, irqflags);
 476                         dev->vblank_disable_allowed = 1;
 477                         dev->vblank_inmodeset[crtc] = 0;
 478                         spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
 479                         drm_vblank_put(dev, crtc);
 480                 }
 481                 break;
 482         default:
 483                 ret = -EINVAL;
 484                 break;
 485         }
 486
 487 out:
 488         return ret;
 489 }
 490
 491 /**
 492  * Wait for VBLANK.
 493  *
 494  * \param inode device inode.
 495  * \param file_priv DRM file private.
 496  * \param cmd command.
 497  * \param data user argument, pointing to a drm_wait_vblank structure.
 498  * \return zero on success or a negative number on failure.
 499  *
 500  * Verifies the IRQ is installed.
 501  *
 502  * If a signal is requested checks if this task has already scheduled the same signal
 503  * for the same vblank sequence number - nothing to be done in
 504  * that case. If the number of tasks waiting for the interrupt exceeds 100 the
 505  * function fails. Otherwise adds a new entry to drm_device::vbl_sigs for this
 506  * task.
 507  *
 508  * If a signal is not requested, then calls vblank_wait().
 509  */
 510 int drm_wait_vblank(struct drm_device *dev, void *data,
 511                     struct drm_file *file_priv)
 512 {
 513         union drm_wait_vblank *vblwait = data;
 514         int ret = 0;
 515         unsigned int flags, seq, crtc;
 516
 517         if ((!dev->irq) || (!dev->irq_enabled))
 518                 return -EINVAL;
 519
 520         if (vblwait->request.type &
 521             ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK)) {
 522                 DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n",
 523                           vblwait->request.type,
 524                           (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK));
 525                 return -EINVAL;
 526         }
 527
 528         flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK;
 529         crtc = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
 530
 531         if (crtc >= dev->num_crtcs)
 532                 return -EINVAL;
 533
 534         ret = drm_vblank_get(dev, crtc);
 535         if (ret)
 536                 return ret;
 537         seq = drm_vblank_count(dev, crtc);
 538
 539         switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) {
 540         case _DRM_VBLANK_RELATIVE:
 541                 vblwait->request.sequence += seq;
 542                 vblwait->request.type &= ~_DRM_VBLANK_RELATIVE;
 543         case _DRM_VBLANK_ABSOLUTE:
 544                 break;
 545         default:
 546                 ret = -EINVAL;
 547                 goto done;
 548         }
 549
 550         if ((flags & _DRM_VBLANK_NEXTONMISS) &&
 551             (seq - vblwait->request.sequence) <= (1<<23)) {
 552                 vblwait->request.sequence = seq + 1;
 553         }
 554
 555         if (flags & _DRM_VBLANK_SIGNAL) {
 556                 unsigned long irqflags;
 557                 struct list_head *vbl_sigs = &dev->vbl_sigs[crtc];
 558                 struct drm_vbl_sig *vbl_sig;
 559
 560                 spin_lock_irqsave(&dev->vbl_lock, irqflags);
 561
 562                 /* Check if this task has already scheduled the same signal
 563                  * for the same vblank sequence number; nothing to be done in
 564                  * that case
 565                  */
 566                 list_for_each_entry(vbl_sig, vbl_sigs, head) {
 567                         if (vbl_sig->sequence == vblwait->request.sequence
 568                             && vbl_sig->info.si_signo ==
 569                             vblwait->request.signal
 570                             && vbl_sig->task == current) {
 571                                 spin_unlock_irqrestore(&dev->vbl_lock,
 572                                                        irqflags);
 573                                 vblwait->reply.sequence = seq;
 574                                 goto done;
 575                         }
 576                 }
 577
 578                 if (atomic_read(&dev->vbl_signal_pending) >= 100) {
 579                         spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
 580                         ret = -EBUSY;
 581                         goto done;
 582                 }
 583
 584                 spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
 585
 586                 vbl_sig = drm_calloc(1, sizeof(struct drm_vbl_sig),
 587                                      DRM_MEM_DRIVER);
 588                 if (!vbl_sig) {
 589                         ret = -ENOMEM;
 590                         goto done;
 591                 }
 592
 593                 ret = drm_vblank_get(dev, crtc);
 594                 if (ret) {
 595                         drm_free(vbl_sig, sizeof(struct drm_vbl_sig),
 596                                  DRM_MEM_DRIVER);
 597                         return ret;
 598                 }
 599
 600                 atomic_inc(&dev->vbl_signal_pending);
 601
 602                 vbl_sig->sequence = vblwait->request.sequence;
 603                 vbl_sig->info.si_signo = vblwait->request.signal;
 604                 vbl_sig->task = current;
 605
 606                 spin_lock_irqsave(&dev->vbl_lock, irqflags);
 607
 608                 list_add_tail(&vbl_sig->head, vbl_sigs);
 609
 610                 spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
 611
 612                 vblwait->reply.sequence = seq;
 613         } else {
 614                 DRM_WAIT_ON(ret, dev->vbl_queue[crtc], 3 * DRM_HZ,
 615                             ((drm_vblank_count(dev, crtc)
 616                               - vblwait->request.sequence) <= (1 << 23)));
 617
 618                 if (ret != -EINTR) {
 619                         struct timeval now;
 620
 621                         do_gettimeofday(&now);
 622
 623                         vblwait->reply.tval_sec = now.tv_sec;
 624                         vblwait->reply.tval_usec = now.tv_usec;
 625                         vblwait->reply.sequence = drm_vblank_count(dev, crtc);
 626                 }
 627         }
 628
 629 done:
 630         drm_vblank_put(dev, crtc);
 631         return ret;
 632 }
 633
 634 /**
 635  * Send the VBLANK signals.
 636  *
 637  * \param dev DRM device.
 638  * \param crtc CRTC where the vblank event occurred
 639  *
 640  * Sends a signal for each task in drm_device::vbl_sigs and empties the list.
 641  *
 642  * If a signal is not requested, then calls vblank_wait().
 643  */
 644 static void drm_vbl_send_signals(struct drm_device * dev, int crtc)
 645 {
 646         struct drm_vbl_sig *vbl_sig, *tmp;
 647         struct list_head *vbl_sigs;
 648         unsigned int vbl_seq;
 649         unsigned long flags;
 650
 651         spin_lock_irqsave(&dev->vbl_lock, flags);
 652
 653         vbl_sigs = &dev->vbl_sigs[crtc];
 654         vbl_seq = drm_vblank_count(dev, crtc);
 655
 656         list_for_each_entry_safe(vbl_sig, tmp, vbl_sigs, head) {
 657             if ((vbl_seq - vbl_sig->sequence) <= (1 << 23)) {
 658                 vbl_sig->info.si_code = vbl_seq;
 659                 send_sig_info(vbl_sig->info.si_signo,
 660                               &vbl_sig->info, vbl_sig->task);
 661
 662                 list_del(&vbl_sig->head);
 663
 664                 drm_free(vbl_sig, sizeof(*vbl_sig),
 665                          DRM_MEM_DRIVER);
 666                 atomic_dec(&dev->vbl_signal_pending);
 667                 drm_vblank_put(dev, crtc);
 668             }
 669         }
 670
 671         spin_unlock_irqrestore(&dev->vbl_lock, flags);
 672 }
 673
 674 /**
 675  * drm_handle_vblank - handle a vblank event
 676  * @dev: DRM device
 677  * @crtc: where this event occurred
 678  *
 679  * Drivers should call this routine in their vblank interrupt handlers to
 680  * update the vblank counter and send any signals that may be pending.
 681  */
 682 void drm_handle_vblank(struct drm_device *dev, int crtc)
 683 {
 684         atomic_inc(&dev->_vblank_count[crtc]);
 685         DRM_WAKEUP(&dev->vbl_queue[crtc]);
 686         drm_vbl_send_signals(dev, crtc);
 687 }
 688 EXPORT_SYMBOL(drm_handle_vblank);
 689
 690 /**
 691  * Tasklet wrapper function.
 692  *
 693  * \param data DRM device in disguise.
 694  *
 695  * Attempts to grab the HW lock and calls the driver callback on success. On
 696  * failure, leave the lock marked as contended so the callback can be called
 697  * from drm_unlock().
 698  */
 699 static void drm_locked_tasklet_func(unsigned long data)
 700 {
 701         struct drm_device *dev = (struct drm_device *)data;
 702         unsigned long irqflags;
 703
 704         spin_lock_irqsave(&dev->tasklet_lock, irqflags);
 705
 706         if (!dev->locked_tasklet_func ||
 707             !drm_lock_take(&dev->lock,
 708                            DRM_KERNEL_CONTEXT)) {
 709                 spin_unlock_irqrestore(&dev->tasklet_lock, irqflags);
 710                 return;
 711         }
 712
 713         dev->lock.lock_time = jiffies;
 714         atomic_inc(&dev->counts[_DRM_STAT_LOCKS]);
 715
 716         dev->locked_tasklet_func(dev);
 717
 718         drm_lock_free(&dev->lock,
 719                       DRM_KERNEL_CONTEXT);
 720
 721         dev->locked_tasklet_func = NULL;
 722
 723         spin_unlock_irqrestore(&dev->tasklet_lock, irqflags);
 724 }
 725
 726 /**
 727  * Schedule a tasklet to call back a driver hook with the HW lock held.
 728  *
 729  * \param dev DRM device.
 730  * \param func Driver callback.
 731  *
 732  * This is intended for triggering actions that require the HW lock from an
 733  * interrupt handler. The lock will be grabbed ASAP after the interrupt handler
 734  * completes. Note that the callback may be called from interrupt or process
 735  * context, it must not make any assumptions about this. Also, the HW lock will
 736  * be held with the kernel context or any client context.
 737  */
 738 void drm_locked_tasklet(struct drm_device *dev, void (*func)(struct drm_device *))
 739 {
 740         unsigned long irqflags;
 741         static DECLARE_TASKLET(drm_tasklet, drm_locked_tasklet_func, 0);
 742
 743         if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ) ||
 744             test_bit(TASKLET_STATE_SCHED, &drm_tasklet.state))
 745                 return;
 746
 747         spin_lock_irqsave(&dev->tasklet_lock, irqflags);
 748
 749         if (dev->locked_tasklet_func) {
 750                 spin_unlock_irqrestore(&dev->tasklet_lock, irqflags);
 751                 return;
 752         }
 753
 754         dev->locked_tasklet_func = func;
 755
 756         spin_unlock_irqrestore(&dev->tasklet_lock, irqflags);
 757
 758         drm_tasklet.data = (unsigned long)dev;
 759
 760         tasklet_hi_schedule(&drm_tasklet);
 761 }
 762 EXPORT_SYMBOL(drm_locked_tasklet);