Home | History | Annotate | Line # | Download | only in drm
drm_irq.c revision 1.4
      1  1.1  riastrad /**
      2  1.1  riastrad  * \file drm_irq.c
      3  1.1  riastrad  * IRQ support
      4  1.1  riastrad  *
      5  1.1  riastrad  * \author Rickard E. (Rik) Faith <faith (at) valinux.com>
      6  1.1  riastrad  * \author Gareth Hughes <gareth (at) valinux.com>
      7  1.1  riastrad  */
      8  1.1  riastrad 
      9  1.1  riastrad /*
     10  1.1  riastrad  * Created: Fri Mar 19 14:30:16 1999 by faith (at) valinux.com
     11  1.1  riastrad  *
     12  1.1  riastrad  * Copyright 1999, 2000 Precision Insight, Inc., Cedar Park, Texas.
     13  1.1  riastrad  * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
     14  1.1  riastrad  * All Rights Reserved.
     15  1.1  riastrad  *
     16  1.1  riastrad  * Permission is hereby granted, free of charge, to any person obtaining a
     17  1.1  riastrad  * copy of this software and associated documentation files (the "Software"),
     18  1.1  riastrad  * to deal in the Software without restriction, including without limitation
     19  1.1  riastrad  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
     20  1.1  riastrad  * and/or sell copies of the Software, and to permit persons to whom the
     21  1.1  riastrad  * Software is furnished to do so, subject to the following conditions:
     22  1.1  riastrad  *
     23  1.1  riastrad  * The above copyright notice and this permission notice (including the next
     24  1.1  riastrad  * paragraph) shall be included in all copies or substantial portions of the
     25  1.1  riastrad  * Software.
     26  1.1  riastrad  *
     27  1.1  riastrad  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     28  1.1  riastrad  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     29  1.1  riastrad  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
     30  1.1  riastrad  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
     31  1.1  riastrad  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
     32  1.1  riastrad  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
     33  1.1  riastrad  * OTHER DEALINGS IN THE SOFTWARE.
     34  1.1  riastrad  */
     35  1.1  riastrad 
     36  1.1  riastrad #include <drm/drmP.h>
     37  1.1  riastrad #include "drm_trace.h"
     38  1.1  riastrad 
     39  1.1  riastrad #include <linux/interrupt.h>	/* For task queue support */
     40  1.1  riastrad #include <linux/slab.h>
     41  1.1  riastrad 
     42  1.1  riastrad #include <linux/vgaarb.h>
     43  1.1  riastrad #include <linux/export.h>
     44  1.1  riastrad 
     45  1.2  riastrad #include <linux/atomic.h>
     46  1.2  riastrad #include <linux/ktime.h>
     47  1.2  riastrad #include <linux/math64.h>
     48  1.2  riastrad #include <linux/preempt.h>
     49  1.2  riastrad #include <linux/sched.h>
     50  1.2  riastrad 
     51  1.2  riastrad #include <asm/bug.h>
     52  1.2  riastrad 
     53  1.2  riastrad #ifdef __NetBSD__		/* XXX hurk -- selnotify &c. */
     54  1.2  riastrad #include <sys/poll.h>
     55  1.2  riastrad #include <sys/select.h>
     56  1.2  riastrad #endif
     57  1.2  riastrad 
     58  1.1  riastrad /* Access macro for slots in vblank timestamp ringbuffer. */
     59  1.4  riastrad #define vblanktimestamp(dev, crtc, count) \
     60  1.4  riastrad 	((dev)->vblank[crtc].time[(count) % DRM_VBLANKTIME_RBSIZE])
     61  1.1  riastrad 
     62  1.1  riastrad /* Retry timestamp calculation up to 3 times to satisfy
     63  1.1  riastrad  * drm_timestamp_precision before giving up.
     64  1.1  riastrad  */
     65  1.1  riastrad #define DRM_TIMESTAMP_MAXRETRIES 3
     66  1.1  riastrad 
     67  1.1  riastrad /* Threshold in nanoseconds for detection of redundant
     68  1.1  riastrad  * vblank irq in drm_handle_vblank(). 1 msec should be ok.
     69  1.1  riastrad  */
     70  1.1  riastrad #define DRM_REDUNDANT_VBLIRQ_THRESH_NS 1000000
     71  1.1  riastrad 
     72  1.1  riastrad /**
     73  1.1  riastrad  * Get interrupt from bus id.
     74  1.1  riastrad  *
     75  1.1  riastrad  * \param inode device inode.
     76  1.1  riastrad  * \param file_priv DRM file private.
     77  1.1  riastrad  * \param cmd command.
     78  1.1  riastrad  * \param arg user argument, pointing to a drm_irq_busid structure.
     79  1.1  riastrad  * \return zero on success or a negative number on failure.
     80  1.1  riastrad  *
     81  1.1  riastrad  * Finds the PCI device with the specified bus id and gets its IRQ number.
     82  1.1  riastrad  * This IOCTL is deprecated, and will now return EINVAL for any busid not equal
     83  1.1  riastrad  * to that of the device that this DRM instance attached to.
     84  1.1  riastrad  */
     85  1.1  riastrad int drm_irq_by_busid(struct drm_device *dev, void *data,
     86  1.1  riastrad 		     struct drm_file *file_priv)
     87  1.1  riastrad {
     88  1.1  riastrad 	struct drm_irq_busid *p = data;
     89  1.1  riastrad 
     90  1.1  riastrad 	if (!dev->driver->bus->irq_by_busid)
     91  1.1  riastrad 		return -EINVAL;
     92  1.1  riastrad 
     93  1.1  riastrad 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
     94  1.1  riastrad 		return -EINVAL;
     95  1.1  riastrad 
     96  1.1  riastrad 	return dev->driver->bus->irq_by_busid(dev, p);
     97  1.1  riastrad }
     98  1.1  riastrad 
     99  1.1  riastrad /*
    100  1.1  riastrad  * Clear vblank timestamp buffer for a crtc.
    101  1.1  riastrad  */
    102  1.1  riastrad static void clear_vblank_timestamps(struct drm_device *dev, int crtc)
    103  1.1  riastrad {
    104  1.4  riastrad 	memset(dev->vblank[crtc].time, 0, sizeof(dev->vblank[crtc].time));
    105  1.1  riastrad }
    106  1.1  riastrad 
    107  1.1  riastrad /*
    108  1.1  riastrad  * Disable vblank irq's on crtc, make sure that last vblank count
    109  1.1  riastrad  * of hardware and corresponding consistent software vblank counter
    110  1.1  riastrad  * are preserved, even if there are any spurious vblank irq's after
    111  1.1  riastrad  * disable.
    112  1.1  riastrad  */
    113  1.1  riastrad static void vblank_disable_and_save(struct drm_device *dev, int crtc)
    114  1.1  riastrad {
    115  1.1  riastrad 	unsigned long irqflags;
    116  1.1  riastrad 	u32 vblcount;
    117  1.1  riastrad 	s64 diff_ns;
    118  1.1  riastrad 	int vblrc;
    119  1.1  riastrad 	struct timeval tvblank;
    120  1.1  riastrad 	int count = DRM_TIMESTAMP_MAXRETRIES;
    121  1.1  riastrad 
    122  1.1  riastrad 	/* Prevent vblank irq processing while disabling vblank irqs,
    123  1.1  riastrad 	 * so no updates of timestamps or count can happen after we've
    124  1.1  riastrad 	 * disabled. Needed to prevent races in case of delayed irq's.
    125  1.1  riastrad 	 */
    126  1.1  riastrad 	spin_lock_irqsave(&dev->vblank_time_lock, irqflags);
    127  1.1  riastrad 
    128  1.1  riastrad 	dev->driver->disable_vblank(dev, crtc);
    129  1.4  riastrad 	dev->vblank[crtc].enabled = false;
    130  1.1  riastrad 
    131  1.1  riastrad 	/* No further vblank irq's will be processed after
    132  1.1  riastrad 	 * this point. Get current hardware vblank count and
    133  1.1  riastrad 	 * vblank timestamp, repeat until they are consistent.
    134  1.1  riastrad 	 *
    135  1.1  riastrad 	 * FIXME: There is still a race condition here and in
    136  1.1  riastrad 	 * drm_update_vblank_count() which can cause off-by-one
    137  1.1  riastrad 	 * reinitialization of software vblank counter. If gpu
    138  1.1  riastrad 	 * vblank counter doesn't increment exactly at the leading
    139  1.1  riastrad 	 * edge of a vblank interval, then we can lose 1 count if
    140  1.1  riastrad 	 * we happen to execute between start of vblank and the
    141  1.1  riastrad 	 * delayed gpu counter increment.
    142  1.1  riastrad 	 */
    143  1.1  riastrad 	do {
    144  1.4  riastrad 		dev->vblank[crtc].last = dev->driver->get_vblank_counter(dev, crtc);
    145  1.1  riastrad 		vblrc = drm_get_last_vbltimestamp(dev, crtc, &tvblank, 0);
    146  1.4  riastrad 	} while (dev->vblank[crtc].last != dev->driver->get_vblank_counter(dev, crtc) && (--count) && vblrc);
    147  1.1  riastrad 
    148  1.1  riastrad 	if (!count)
    149  1.1  riastrad 		vblrc = 0;
    150  1.1  riastrad 
    151  1.1  riastrad 	/* Compute time difference to stored timestamp of last vblank
    152  1.1  riastrad 	 * as updated by last invocation of drm_handle_vblank() in vblank irq.
    153  1.1  riastrad 	 */
    154  1.4  riastrad 	vblcount = atomic_read(&dev->vblank[crtc].count);
    155  1.1  riastrad 	diff_ns = timeval_to_ns(&tvblank) -
    156  1.1  riastrad 		  timeval_to_ns(&vblanktimestamp(dev, crtc, vblcount));
    157  1.1  riastrad 
    158  1.1  riastrad 	/* If there is at least 1 msec difference between the last stored
    159  1.1  riastrad 	 * timestamp and tvblank, then we are currently executing our
    160  1.1  riastrad 	 * disable inside a new vblank interval, the tvblank timestamp
    161  1.1  riastrad 	 * corresponds to this new vblank interval and the irq handler
    162  1.1  riastrad 	 * for this vblank didn't run yet and won't run due to our disable.
    163  1.1  riastrad 	 * Therefore we need to do the job of drm_handle_vblank() and
    164  1.1  riastrad 	 * increment the vblank counter by one to account for this vblank.
    165  1.1  riastrad 	 *
    166  1.1  riastrad 	 * Skip this step if there isn't any high precision timestamp
    167  1.1  riastrad 	 * available. In that case we can't account for this and just
    168  1.1  riastrad 	 * hope for the best.
    169  1.1  riastrad 	 */
    170  1.1  riastrad 	if ((vblrc > 0) && (abs64(diff_ns) > 1000000)) {
    171  1.4  riastrad 		atomic_inc(&dev->vblank[crtc].count);
    172  1.1  riastrad 		smp_mb__after_atomic_inc();
    173  1.1  riastrad 	}
    174  1.1  riastrad 
    175  1.1  riastrad 	/* Invalidate all timestamps while vblank irq's are off. */
    176  1.1  riastrad 	clear_vblank_timestamps(dev, crtc);
    177  1.1  riastrad 
    178  1.1  riastrad 	spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
    179  1.1  riastrad }
    180  1.1  riastrad 
    181  1.1  riastrad static void vblank_disable_fn(unsigned long arg)
    182  1.1  riastrad {
    183  1.1  riastrad 	struct drm_device *dev = (struct drm_device *)arg;
    184  1.1  riastrad 	unsigned long irqflags;
    185  1.1  riastrad 	int i;
    186  1.1  riastrad 
    187  1.1  riastrad 	if (!dev->vblank_disable_allowed)
    188  1.1  riastrad 		return;
    189  1.1  riastrad 
    190  1.1  riastrad 	for (i = 0; i < dev->num_crtcs; i++) {
    191  1.1  riastrad 		spin_lock_irqsave(&dev->vbl_lock, irqflags);
    192  1.4  riastrad 		if (atomic_read(&dev->vblank[i].refcount) == 0 &&
    193  1.4  riastrad 		    dev->vblank[i].enabled) {
    194  1.1  riastrad 			DRM_DEBUG("disabling vblank on crtc %d\n", i);
    195  1.1  riastrad 			vblank_disable_and_save(dev, i);
    196  1.1  riastrad 		}
    197  1.1  riastrad 		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
    198  1.1  riastrad 	}
    199  1.1  riastrad }
    200  1.1  riastrad 
    201  1.1  riastrad void drm_vblank_cleanup(struct drm_device *dev)
    202  1.1  riastrad {
    203  1.1  riastrad 	/* Bail if the driver didn't call drm_vblank_init() */
    204  1.1  riastrad 	if (dev->num_crtcs == 0)
    205  1.1  riastrad 		return;
    206  1.1  riastrad 
    207  1.1  riastrad 	del_timer_sync(&dev->vblank_disable_timer);
    208  1.3  riastrad #ifdef __NetBSD__
    209  1.3  riastrad 	teardown_timer(&dev->vblank_disable_timer);
    210  1.3  riastrad #endif
    211  1.1  riastrad 
    212  1.1  riastrad 	vblank_disable_fn((unsigned long)dev);
    213  1.1  riastrad 
    214  1.2  riastrad #ifdef __NetBSD__
    215  1.2  riastrad     {
    216  1.2  riastrad 	unsigned int i;
    217  1.2  riastrad 	for (i = 0; i < dev->num_crtcs; i++)
    218  1.4  riastrad 		DRM_DESTROY_WAITQUEUE(&dev->vblank[i].queue);
    219  1.2  riastrad     }
    220  1.2  riastrad #endif
    221  1.2  riastrad 
    222  1.4  riastrad 	kfree(dev->vblank);
    223  1.1  riastrad 
    224  1.1  riastrad 	dev->num_crtcs = 0;
    225  1.2  riastrad 
    226  1.2  riastrad #ifdef __NetBSD__
    227  1.2  riastrad 	spin_lock_destroy(&dev->vblank_time_lock);
    228  1.2  riastrad 	spin_lock_destroy(&dev->vbl_lock);
    229  1.2  riastrad #endif
    230  1.1  riastrad }
    231  1.1  riastrad EXPORT_SYMBOL(drm_vblank_cleanup);
    232  1.1  riastrad 
    233  1.1  riastrad int drm_vblank_init(struct drm_device *dev, int num_crtcs)
    234  1.1  riastrad {
    235  1.1  riastrad 	int i, ret = -ENOMEM;
    236  1.1  riastrad 
    237  1.1  riastrad 	setup_timer(&dev->vblank_disable_timer, vblank_disable_fn,
    238  1.1  riastrad 		    (unsigned long)dev);
    239  1.1  riastrad 	spin_lock_init(&dev->vbl_lock);
    240  1.1  riastrad 	spin_lock_init(&dev->vblank_time_lock);
    241  1.1  riastrad 
    242  1.1  riastrad 	dev->num_crtcs = num_crtcs;
    243  1.1  riastrad 
    244  1.4  riastrad 	dev->vblank = kcalloc(num_crtcs, sizeof(*dev->vblank), GFP_KERNEL);
    245  1.4  riastrad 	if (!dev->vblank)
    246  1.4  riastrad 		goto err;
    247  1.4  riastrad 
    248  1.4  riastrad 	for (i = 0; i < num_crtcs; i++)
    249  1.2  riastrad #ifdef __NetBSD__
    250  1.4  riastrad 		DRM_INIT_WAITQUEUE(&dev->vblank[i].queue, "drmvblnq");
    251  1.2  riastrad #else
    252  1.4  riastrad 		init_waitqueue_head(&dev->vblank[i].queue);
    253  1.2  riastrad #endif
    254  1.1  riastrad 
    255  1.4  riastrad 	DRM_INFO("Supports vblank timestamp caching Rev 2 (21.10.2013).\n");
    256  1.1  riastrad 
    257  1.1  riastrad 	/* Driver specific high-precision vblank timestamping supported? */
    258  1.1  riastrad 	if (dev->driver->get_vblank_timestamp)
    259  1.1  riastrad 		DRM_INFO("Driver supports precise vblank timestamp query.\n");
    260  1.1  riastrad 	else
    261  1.1  riastrad 		DRM_INFO("No driver support for vblank timestamp query.\n");
    262  1.1  riastrad 
    263  1.4  riastrad 	dev->vblank_disable_allowed = false;
    264  1.1  riastrad 
    265  1.1  riastrad 	return 0;
    266  1.1  riastrad 
    267  1.1  riastrad err:
    268  1.1  riastrad 	drm_vblank_cleanup(dev);
    269  1.1  riastrad 	return ret;
    270  1.1  riastrad }
    271  1.1  riastrad EXPORT_SYMBOL(drm_vblank_init);
    272  1.1  riastrad 
    273  1.1  riastrad static void drm_irq_vgaarb_nokms(void *cookie, bool state)
    274  1.1  riastrad {
    275  1.1  riastrad 	struct drm_device *dev = cookie;
    276  1.1  riastrad 
    277  1.1  riastrad 	if (dev->driver->vgaarb_irq) {
    278  1.1  riastrad 		dev->driver->vgaarb_irq(dev, state);
    279  1.1  riastrad 		return;
    280  1.1  riastrad 	}
    281  1.1  riastrad 
    282  1.1  riastrad 	if (!dev->irq_enabled)
    283  1.1  riastrad 		return;
    284  1.1  riastrad 
    285  1.1  riastrad 	if (state) {
    286  1.1  riastrad 		if (dev->driver->irq_uninstall)
    287  1.1  riastrad 			dev->driver->irq_uninstall(dev);
    288  1.1  riastrad 	} else {
    289  1.1  riastrad 		if (dev->driver->irq_preinstall)
    290  1.1  riastrad 			dev->driver->irq_preinstall(dev);
    291  1.1  riastrad 		if (dev->driver->irq_postinstall)
    292  1.1  riastrad 			dev->driver->irq_postinstall(dev);
    293  1.1  riastrad 	}
    294  1.1  riastrad }
    295  1.1  riastrad 
    296  1.1  riastrad /**
    297  1.1  riastrad  * Install IRQ handler.
    298  1.1  riastrad  *
    299  1.1  riastrad  * \param dev DRM device.
    300  1.1  riastrad  *
    301  1.1  riastrad  * Initializes the IRQ related data. Installs the handler, calling the driver
    302  1.1  riastrad  * \c irq_preinstall() and \c irq_postinstall() functions
    303  1.1  riastrad  * before and after the installation.
    304  1.1  riastrad  */
    305  1.1  riastrad int drm_irq_install(struct drm_device *dev)
    306  1.1  riastrad {
    307  1.1  riastrad 	int ret;
    308  1.1  riastrad 	unsigned long sh_flags = 0;
    309  1.2  riastrad 	const char *irqname;
    310  1.1  riastrad 
    311  1.1  riastrad 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
    312  1.1  riastrad 		return -EINVAL;
    313  1.1  riastrad 
    314  1.1  riastrad 	if (drm_dev_to_irq(dev) == 0)
    315  1.1  riastrad 		return -EINVAL;
    316  1.1  riastrad 
    317  1.1  riastrad 	mutex_lock(&dev->struct_mutex);
    318  1.1  riastrad 
    319  1.1  riastrad 	/* Driver must have been initialized */
    320  1.1  riastrad 	if (!dev->dev_private) {
    321  1.1  riastrad 		mutex_unlock(&dev->struct_mutex);
    322  1.1  riastrad 		return -EINVAL;
    323  1.1  riastrad 	}
    324  1.1  riastrad 
    325  1.1  riastrad 	if (dev->irq_enabled) {
    326  1.1  riastrad 		mutex_unlock(&dev->struct_mutex);
    327  1.1  riastrad 		return -EBUSY;
    328  1.1  riastrad 	}
    329  1.4  riastrad 	dev->irq_enabled = true;
    330  1.1  riastrad 	mutex_unlock(&dev->struct_mutex);
    331  1.1  riastrad 
    332  1.1  riastrad 	DRM_DEBUG("irq=%d\n", drm_dev_to_irq(dev));
    333  1.1  riastrad 
    334  1.1  riastrad 	/* Before installing handler */
    335  1.1  riastrad 	if (dev->driver->irq_preinstall)
    336  1.1  riastrad 		dev->driver->irq_preinstall(dev);
    337  1.1  riastrad 
    338  1.1  riastrad 	/* Install handler */
    339  1.1  riastrad 	if (drm_core_check_feature(dev, DRIVER_IRQ_SHARED))
    340  1.1  riastrad 		sh_flags = IRQF_SHARED;
    341  1.1  riastrad 
    342  1.1  riastrad 	if (dev->devname)
    343  1.1  riastrad 		irqname = dev->devname;
    344  1.1  riastrad 	else
    345  1.1  riastrad 		irqname = dev->driver->name;
    346  1.1  riastrad 
    347  1.2  riastrad #ifdef __NetBSD__
    348  1.2  riastrad 	ret = (*dev->driver->bus->irq_install)(dev, dev->driver->irq_handler,
    349  1.2  riastrad 	    sh_flags, irqname, dev, &dev->irq_cookie);
    350  1.2  riastrad #else
    351  1.1  riastrad 	ret = request_irq(drm_dev_to_irq(dev), dev->driver->irq_handler,
    352  1.1  riastrad 			  sh_flags, irqname, dev);
    353  1.2  riastrad #endif
    354  1.1  riastrad 
    355  1.1  riastrad 	if (ret < 0) {
    356  1.1  riastrad 		mutex_lock(&dev->struct_mutex);
    357  1.4  riastrad 		dev->irq_enabled = false;
    358  1.1  riastrad 		mutex_unlock(&dev->struct_mutex);
    359  1.1  riastrad 		return ret;
    360  1.1  riastrad 	}
    361  1.1  riastrad 
    362  1.1  riastrad 	if (!drm_core_check_feature(dev, DRIVER_MODESET))
    363  1.1  riastrad 		vga_client_register(dev->pdev, (void *)dev, drm_irq_vgaarb_nokms, NULL);
    364  1.1  riastrad 
    365  1.1  riastrad 	/* After installing handler */
    366  1.1  riastrad 	if (dev->driver->irq_postinstall)
    367  1.1  riastrad 		ret = dev->driver->irq_postinstall(dev);
    368  1.1  riastrad 
    369  1.1  riastrad 	if (ret < 0) {
    370  1.1  riastrad 		mutex_lock(&dev->struct_mutex);
    371  1.4  riastrad 		dev->irq_enabled = false;
    372  1.1  riastrad 		mutex_unlock(&dev->struct_mutex);
    373  1.1  riastrad 		if (!drm_core_check_feature(dev, DRIVER_MODESET))
    374  1.1  riastrad 			vga_client_register(dev->pdev, NULL, NULL, NULL);
    375  1.2  riastrad #ifdef __NetBSD__
    376  1.2  riastrad 		(*dev->driver->bus->irq_uninstall)(dev, dev->irq_cookie);
    377  1.2  riastrad #else
    378  1.1  riastrad 		free_irq(drm_dev_to_irq(dev), dev);
    379  1.2  riastrad #endif
    380  1.1  riastrad 	}
    381  1.1  riastrad 
    382  1.1  riastrad 	return ret;
    383  1.1  riastrad }
    384  1.1  riastrad EXPORT_SYMBOL(drm_irq_install);
    385  1.1  riastrad 
    386  1.1  riastrad /**
    387  1.1  riastrad  * Uninstall the IRQ handler.
    388  1.1  riastrad  *
    389  1.1  riastrad  * \param dev DRM device.
    390  1.1  riastrad  *
    391  1.1  riastrad  * Calls the driver's \c irq_uninstall() function, and stops the irq.
    392  1.1  riastrad  */
    393  1.1  riastrad int drm_irq_uninstall(struct drm_device *dev)
    394  1.1  riastrad {
    395  1.1  riastrad 	unsigned long irqflags;
    396  1.4  riastrad 	bool irq_enabled;
    397  1.4  riastrad 	int i;
    398  1.1  riastrad 
    399  1.1  riastrad 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
    400  1.1  riastrad 		return -EINVAL;
    401  1.1  riastrad 
    402  1.1  riastrad 	mutex_lock(&dev->struct_mutex);
    403  1.1  riastrad 	irq_enabled = dev->irq_enabled;
    404  1.4  riastrad 	dev->irq_enabled = false;
    405  1.1  riastrad 	mutex_unlock(&dev->struct_mutex);
    406  1.1  riastrad 
    407  1.1  riastrad 	/*
    408  1.1  riastrad 	 * Wake up any waiters so they don't hang.
    409  1.1  riastrad 	 */
    410  1.1  riastrad 	if (dev->num_crtcs) {
    411  1.1  riastrad 		spin_lock_irqsave(&dev->vbl_lock, irqflags);
    412  1.1  riastrad 		for (i = 0; i < dev->num_crtcs; i++) {
    413  1.2  riastrad #ifdef __NetBSD__
    414  1.4  riastrad 			DRM_SPIN_WAKEUP_ONE(&dev->vblank[i].queue,
    415  1.2  riastrad 			    &dev->vbl_lock);
    416  1.2  riastrad #else
    417  1.4  riastrad 			wake_up(&dev->vblank[i].queue);
    418  1.2  riastrad #endif
    419  1.4  riastrad 			dev->vblank[i].enabled = false;
    420  1.4  riastrad 			dev->vblank[i].last =
    421  1.1  riastrad 				dev->driver->get_vblank_counter(dev, i);
    422  1.1  riastrad 		}
    423  1.1  riastrad 		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
    424  1.1  riastrad 	}
    425  1.1  riastrad 
    426  1.1  riastrad 	if (!irq_enabled)
    427  1.1  riastrad 		return -EINVAL;
    428  1.1  riastrad 
    429  1.1  riastrad 	DRM_DEBUG("irq=%d\n", drm_dev_to_irq(dev));
    430  1.1  riastrad 
    431  1.1  riastrad 	if (!drm_core_check_feature(dev, DRIVER_MODESET))
    432  1.1  riastrad 		vga_client_register(dev->pdev, NULL, NULL, NULL);
    433  1.1  riastrad 
    434  1.1  riastrad 	if (dev->driver->irq_uninstall)
    435  1.1  riastrad 		dev->driver->irq_uninstall(dev);
    436  1.1  riastrad 
    437  1.2  riastrad #ifdef __NetBSD__
    438  1.2  riastrad 	(*dev->driver->bus->irq_uninstall)(dev, dev->irq_cookie);
    439  1.2  riastrad #else
    440  1.1  riastrad 	free_irq(drm_dev_to_irq(dev), dev);
    441  1.2  riastrad #endif
    442  1.1  riastrad 
    443  1.1  riastrad 	return 0;
    444  1.1  riastrad }
    445  1.1  riastrad EXPORT_SYMBOL(drm_irq_uninstall);
    446  1.1  riastrad 
    447  1.1  riastrad /**
    448  1.1  riastrad  * IRQ control ioctl.
    449  1.1  riastrad  *
    450  1.1  riastrad  * \param inode device inode.
    451  1.1  riastrad  * \param file_priv DRM file private.
    452  1.1  riastrad  * \param cmd command.
    453  1.1  riastrad  * \param arg user argument, pointing to a drm_control structure.
    454  1.1  riastrad  * \return zero on success or a negative number on failure.
    455  1.1  riastrad  *
    456  1.1  riastrad  * Calls irq_install() or irq_uninstall() according to \p arg.
    457  1.1  riastrad  */
    458  1.1  riastrad int drm_control(struct drm_device *dev, void *data,
    459  1.1  riastrad 		struct drm_file *file_priv)
    460  1.1  riastrad {
    461  1.1  riastrad 	struct drm_control *ctl = data;
    462  1.1  riastrad 
    463  1.1  riastrad 	/* if we haven't irq we fallback for compatibility reasons -
    464  1.1  riastrad 	 * this used to be a separate function in drm_dma.h
    465  1.1  riastrad 	 */
    466  1.1  riastrad 
    467  1.1  riastrad 
    468  1.1  riastrad 	switch (ctl->func) {
    469  1.1  riastrad 	case DRM_INST_HANDLER:
    470  1.1  riastrad 		if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
    471  1.1  riastrad 			return 0;
    472  1.1  riastrad 		if (drm_core_check_feature(dev, DRIVER_MODESET))
    473  1.1  riastrad 			return 0;
    474  1.1  riastrad 		if (dev->if_version < DRM_IF_VERSION(1, 2) &&
    475  1.1  riastrad 		    ctl->irq != drm_dev_to_irq(dev))
    476  1.1  riastrad 			return -EINVAL;
    477  1.1  riastrad 		return drm_irq_install(dev);
    478  1.1  riastrad 	case DRM_UNINST_HANDLER:
    479  1.1  riastrad 		if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
    480  1.1  riastrad 			return 0;
    481  1.1  riastrad 		if (drm_core_check_feature(dev, DRIVER_MODESET))
    482  1.1  riastrad 			return 0;
    483  1.1  riastrad 		return drm_irq_uninstall(dev);
    484  1.1  riastrad 	default:
    485  1.1  riastrad 		return -EINVAL;
    486  1.1  riastrad 	}
    487  1.1  riastrad }
    488  1.1  riastrad 
    489  1.1  riastrad /**
    490  1.4  riastrad  * drm_calc_timestamping_constants - Calculate vblank timestamp constants
    491  1.1  riastrad  *
    492  1.1  riastrad  * @crtc drm_crtc whose timestamp constants should be updated.
    493  1.4  riastrad  * @mode display mode containing the scanout timings
    494  1.1  riastrad  *
    495  1.4  riastrad  * Calculate and store various constants which are later
    496  1.4  riastrad  * needed by vblank and swap-completion timestamping, e.g,
    497  1.4  riastrad  * by drm_calc_vbltimestamp_from_scanoutpos(). They are
    498  1.4  riastrad  * derived from crtc's true scanout timing, so they take
    499  1.4  riastrad  * things like panel scaling or other adjustments into account.
    500  1.1  riastrad  */
    501  1.4  riastrad void drm_calc_timestamping_constants(struct drm_crtc *crtc,
    502  1.4  riastrad 				     const struct drm_display_mode *mode)
    503  1.1  riastrad {
    504  1.4  riastrad 	int linedur_ns = 0, pixeldur_ns = 0, framedur_ns = 0;
    505  1.4  riastrad 	int dotclock = mode->crtc_clock;
    506  1.1  riastrad 
    507  1.4  riastrad 	/* Valid dotclock? */
    508  1.4  riastrad 	if (dotclock > 0) {
    509  1.4  riastrad 		int frame_size = mode->crtc_htotal * mode->crtc_vtotal;
    510  1.1  riastrad 
    511  1.4  riastrad 		/*
    512  1.4  riastrad 		 * Convert scanline length in pixels and video
    513  1.4  riastrad 		 * dot clock to line duration, frame duration
    514  1.4  riastrad 		 * and pixel duration in nanoseconds:
    515  1.4  riastrad 		 */
    516  1.4  riastrad 		pixeldur_ns = 1000000 / dotclock;
    517  1.4  riastrad 		linedur_ns  = div_u64((u64) mode->crtc_htotal * 1000000, dotclock);
    518  1.4  riastrad 		framedur_ns = div_u64((u64) frame_size * 1000000, dotclock);
    519  1.1  riastrad 
    520  1.4  riastrad 		/*
    521  1.4  riastrad 		 * Fields of interlaced scanout modes are only half a frame duration.
    522  1.1  riastrad 		 */
    523  1.4  riastrad 		if (mode->flags & DRM_MODE_FLAG_INTERLACE)
    524  1.4  riastrad 			framedur_ns /= 2;
    525  1.1  riastrad 	} else
    526  1.1  riastrad 		DRM_ERROR("crtc %d: Can't calculate constants, dotclock = 0!\n",
    527  1.1  riastrad 			  crtc->base.id);
    528  1.1  riastrad 
    529  1.1  riastrad 	crtc->pixeldur_ns = pixeldur_ns;
    530  1.1  riastrad 	crtc->linedur_ns  = linedur_ns;
    531  1.1  riastrad 	crtc->framedur_ns = framedur_ns;
    532  1.1  riastrad 
    533  1.1  riastrad 	DRM_DEBUG("crtc %d: hwmode: htotal %d, vtotal %d, vdisplay %d\n",
    534  1.4  riastrad 		  crtc->base.id, mode->crtc_htotal,
    535  1.4  riastrad 		  mode->crtc_vtotal, mode->crtc_vdisplay);
    536  1.1  riastrad 	DRM_DEBUG("crtc %d: clock %d kHz framedur %d linedur %d, pixeldur %d\n",
    537  1.4  riastrad 		  crtc->base.id, dotclock, framedur_ns,
    538  1.4  riastrad 		  linedur_ns, pixeldur_ns);
    539  1.1  riastrad }
    540  1.1  riastrad EXPORT_SYMBOL(drm_calc_timestamping_constants);
    541  1.1  riastrad 
    542  1.1  riastrad /**
    543  1.1  riastrad  * drm_calc_vbltimestamp_from_scanoutpos - helper routine for kms
    544  1.1  riastrad  * drivers. Implements calculation of exact vblank timestamps from
    545  1.1  riastrad  * given drm_display_mode timings and current video scanout position
    546  1.1  riastrad  * of a crtc. This can be called from within get_vblank_timestamp()
    547  1.1  riastrad  * implementation of a kms driver to implement the actual timestamping.
    548  1.1  riastrad  *
    549  1.1  riastrad  * Should return timestamps conforming to the OML_sync_control OpenML
    550  1.1  riastrad  * extension specification. The timestamp corresponds to the end of
    551  1.1  riastrad  * the vblank interval, aka start of scanout of topmost-leftmost display
    552  1.1  riastrad  * pixel in the following video frame.
    553  1.1  riastrad  *
    554  1.1  riastrad  * Requires support for optional dev->driver->get_scanout_position()
    555  1.1  riastrad  * in kms driver, plus a bit of setup code to provide a drm_display_mode
    556  1.1  riastrad  * that corresponds to the true scanout timing.
    557  1.1  riastrad  *
    558  1.1  riastrad  * The current implementation only handles standard video modes. It
    559  1.1  riastrad  * returns as no operation if a doublescan or interlaced video mode is
    560  1.1  riastrad  * active. Higher level code is expected to handle this.
    561  1.1  riastrad  *
    562  1.1  riastrad  * @dev: DRM device.
    563  1.1  riastrad  * @crtc: Which crtc's vblank timestamp to retrieve.
    564  1.1  riastrad  * @max_error: Desired maximum allowable error in timestamps (nanosecs).
    565  1.1  riastrad  *             On return contains true maximum error of timestamp.
    566  1.1  riastrad  * @vblank_time: Pointer to struct timeval which should receive the timestamp.
    567  1.1  riastrad  * @flags: Flags to pass to driver:
    568  1.1  riastrad  *         0 = Default.
    569  1.1  riastrad  *         DRM_CALLED_FROM_VBLIRQ = If function is called from vbl irq handler.
    570  1.1  riastrad  * @refcrtc: drm_crtc* of crtc which defines scanout timing.
    571  1.4  riastrad  * @mode: mode which defines the scanout timings
    572  1.1  riastrad  *
    573  1.1  riastrad  * Returns negative value on error, failure or if not supported in current
    574  1.1  riastrad  * video mode:
    575  1.1  riastrad  *
    576  1.1  riastrad  * -EINVAL   - Invalid crtc.
    577  1.1  riastrad  * -EAGAIN   - Temporary unavailable, e.g., called before initial modeset.
    578  1.1  riastrad  * -ENOTSUPP - Function not supported in current display mode.
    579  1.1  riastrad  * -EIO      - Failed, e.g., due to failed scanout position query.
    580  1.1  riastrad  *
    581  1.1  riastrad  * Returns or'ed positive status flags on success:
    582  1.1  riastrad  *
    583  1.1  riastrad  * DRM_VBLANKTIME_SCANOUTPOS_METHOD - Signal this method used for timestamping.
    584  1.1  riastrad  * DRM_VBLANKTIME_INVBL - Timestamp taken while scanout was in vblank interval.
    585  1.1  riastrad  *
    586  1.1  riastrad  */
    587  1.1  riastrad int drm_calc_vbltimestamp_from_scanoutpos(struct drm_device *dev, int crtc,
    588  1.1  riastrad 					  int *max_error,
    589  1.1  riastrad 					  struct timeval *vblank_time,
    590  1.1  riastrad 					  unsigned flags,
    591  1.4  riastrad 					  const struct drm_crtc *refcrtc,
    592  1.4  riastrad 					  const struct drm_display_mode *mode)
    593  1.1  riastrad {
    594  1.1  riastrad 	ktime_t stime, etime, mono_time_offset;
    595  1.1  riastrad 	struct timeval tv_etime;
    596  1.4  riastrad 	int vbl_status;
    597  1.1  riastrad 	int vpos, hpos, i;
    598  1.4  riastrad 	int framedur_ns, linedur_ns, pixeldur_ns, delta_ns, duration_ns;
    599  1.1  riastrad 	bool invbl;
    600  1.1  riastrad 
    601  1.1  riastrad 	if (crtc < 0 || crtc >= dev->num_crtcs) {
    602  1.1  riastrad 		DRM_ERROR("Invalid crtc %d\n", crtc);
    603  1.1  riastrad 		return -EINVAL;
    604  1.1  riastrad 	}
    605  1.1  riastrad 
    606  1.1  riastrad 	/* Scanout position query not supported? Should not happen. */
    607  1.1  riastrad 	if (!dev->driver->get_scanout_position) {
    608  1.1  riastrad 		DRM_ERROR("Called from driver w/o get_scanout_position()!?\n");
    609  1.1  riastrad 		return -EIO;
    610  1.1  riastrad 	}
    611  1.1  riastrad 
    612  1.1  riastrad 	/* Durations of frames, lines, pixels in nanoseconds. */
    613  1.1  riastrad 	framedur_ns = refcrtc->framedur_ns;
    614  1.1  riastrad 	linedur_ns  = refcrtc->linedur_ns;
    615  1.1  riastrad 	pixeldur_ns = refcrtc->pixeldur_ns;
    616  1.1  riastrad 
    617  1.1  riastrad 	/* If mode timing undefined, just return as no-op:
    618  1.1  riastrad 	 * Happens during initial modesetting of a crtc.
    619  1.1  riastrad 	 */
    620  1.4  riastrad 	if (framedur_ns == 0) {
    621  1.1  riastrad 		DRM_DEBUG("crtc %d: Noop due to uninitialized mode.\n", crtc);
    622  1.1  riastrad 		return -EAGAIN;
    623  1.1  riastrad 	}
    624  1.1  riastrad 
    625  1.1  riastrad 	/* Get current scanout position with system timestamp.
    626  1.1  riastrad 	 * Repeat query up to DRM_TIMESTAMP_MAXRETRIES times
    627  1.1  riastrad 	 * if single query takes longer than max_error nanoseconds.
    628  1.1  riastrad 	 *
    629  1.1  riastrad 	 * This guarantees a tight bound on maximum error if
    630  1.1  riastrad 	 * code gets preempted or delayed for some reason.
    631  1.1  riastrad 	 */
    632  1.1  riastrad 	for (i = 0; i < DRM_TIMESTAMP_MAXRETRIES; i++) {
    633  1.4  riastrad 		/*
    634  1.4  riastrad 		 * Get vertical and horizontal scanout position vpos, hpos,
    635  1.4  riastrad 		 * and bounding timestamps stime, etime, pre/post query.
    636  1.1  riastrad 		 */
    637  1.4  riastrad 		vbl_status = dev->driver->get_scanout_position(dev, crtc, flags, &vpos,
    638  1.4  riastrad 							       &hpos, &stime, &etime);
    639  1.1  riastrad 
    640  1.4  riastrad 		/*
    641  1.4  riastrad 		 * Get correction for CLOCK_MONOTONIC -> CLOCK_REALTIME if
    642  1.4  riastrad 		 * CLOCK_REALTIME is requested.
    643  1.4  riastrad 		 */
    644  1.1  riastrad 		if (!drm_timestamp_monotonic)
    645  1.1  riastrad 			mono_time_offset = ktime_get_monotonic_offset();
    646  1.1  riastrad 
    647  1.1  riastrad 		/* Return as no-op if scanout query unsupported or failed. */
    648  1.1  riastrad 		if (!(vbl_status & DRM_SCANOUTPOS_VALID)) {
    649  1.1  riastrad 			DRM_DEBUG("crtc %d : scanoutpos query failed [%d].\n",
    650  1.1  riastrad 				  crtc, vbl_status);
    651  1.1  riastrad 			return -EIO;
    652  1.1  riastrad 		}
    653  1.1  riastrad 
    654  1.4  riastrad 		/* Compute uncertainty in timestamp of scanout position query. */
    655  1.1  riastrad 		duration_ns = ktime_to_ns(etime) - ktime_to_ns(stime);
    656  1.1  riastrad 
    657  1.1  riastrad 		/* Accept result with <  max_error nsecs timing uncertainty. */
    658  1.4  riastrad 		if (duration_ns <= *max_error)
    659  1.1  riastrad 			break;
    660  1.1  riastrad 	}
    661  1.1  riastrad 
    662  1.1  riastrad 	/* Noisy system timing? */
    663  1.1  riastrad 	if (i == DRM_TIMESTAMP_MAXRETRIES) {
    664  1.1  riastrad 		DRM_DEBUG("crtc %d: Noisy timestamp %d us > %d us [%d reps].\n",
    665  1.4  riastrad 			  crtc, duration_ns/1000, *max_error/1000, i);
    666  1.1  riastrad 	}
    667  1.1  riastrad 
    668  1.1  riastrad 	/* Return upper bound of timestamp precision error. */
    669  1.4  riastrad 	*max_error = duration_ns;
    670  1.1  riastrad 
    671  1.1  riastrad 	/* Check if in vblank area:
    672  1.1  riastrad 	 * vpos is >=0 in video scanout area, but negative
    673  1.1  riastrad 	 * within vblank area, counting down the number of lines until
    674  1.1  riastrad 	 * start of scanout.
    675  1.1  riastrad 	 */
    676  1.1  riastrad 	invbl = vbl_status & DRM_SCANOUTPOS_INVBL;
    677  1.1  riastrad 
    678  1.1  riastrad 	/* Convert scanout position into elapsed time at raw_time query
    679  1.1  riastrad 	 * since start of scanout at first display scanline. delta_ns
    680  1.1  riastrad 	 * can be negative if start of scanout hasn't happened yet.
    681  1.1  riastrad 	 */
    682  1.4  riastrad 	delta_ns = vpos * linedur_ns + hpos * pixeldur_ns;
    683  1.1  riastrad 
    684  1.1  riastrad 	if (!drm_timestamp_monotonic)
    685  1.1  riastrad 		etime = ktime_sub(etime, mono_time_offset);
    686  1.1  riastrad 
    687  1.1  riastrad 	/* save this only for debugging purposes */
    688  1.1  riastrad 	tv_etime = ktime_to_timeval(etime);
    689  1.1  riastrad 	/* Subtract time delta from raw timestamp to get final
    690  1.1  riastrad 	 * vblank_time timestamp for end of vblank.
    691  1.1  riastrad 	 */
    692  1.4  riastrad 	if (delta_ns < 0)
    693  1.4  riastrad 		etime = ktime_add_ns(etime, -delta_ns);
    694  1.4  riastrad 	else
    695  1.4  riastrad 		etime = ktime_sub_ns(etime, delta_ns);
    696  1.1  riastrad 	*vblank_time = ktime_to_timeval(etime);
    697  1.1  riastrad 
    698  1.1  riastrad 	DRM_DEBUG("crtc %d : v %d p(%d,%d)@ %ld.%ld -> %ld.%ld [e %d us, %d rep]\n",
    699  1.1  riastrad 		  crtc, (int)vbl_status, hpos, vpos,
    700  1.1  riastrad 		  (long)tv_etime.tv_sec, (long)tv_etime.tv_usec,
    701  1.1  riastrad 		  (long)vblank_time->tv_sec, (long)vblank_time->tv_usec,
    702  1.4  riastrad 		  duration_ns/1000, i);
    703  1.1  riastrad 
    704  1.1  riastrad 	vbl_status = DRM_VBLANKTIME_SCANOUTPOS_METHOD;
    705  1.1  riastrad 	if (invbl)
    706  1.1  riastrad 		vbl_status |= DRM_VBLANKTIME_INVBL;
    707  1.1  riastrad 
    708  1.1  riastrad 	return vbl_status;
    709  1.1  riastrad }
    710  1.1  riastrad EXPORT_SYMBOL(drm_calc_vbltimestamp_from_scanoutpos);
    711  1.1  riastrad 
    712  1.1  riastrad static struct timeval get_drm_timestamp(void)
    713  1.1  riastrad {
    714  1.1  riastrad 	ktime_t now;
    715  1.1  riastrad 
    716  1.1  riastrad 	now = ktime_get();
    717  1.1  riastrad 	if (!drm_timestamp_monotonic)
    718  1.1  riastrad 		now = ktime_sub(now, ktime_get_monotonic_offset());
    719  1.1  riastrad 
    720  1.1  riastrad 	return ktime_to_timeval(now);
    721  1.1  riastrad }
    722  1.1  riastrad 
    723  1.1  riastrad /**
    724  1.1  riastrad  * drm_get_last_vbltimestamp - retrieve raw timestamp for the most recent
    725  1.1  riastrad  * vblank interval.
    726  1.1  riastrad  *
    727  1.1  riastrad  * @dev: DRM device
    728  1.1  riastrad  * @crtc: which crtc's vblank timestamp to retrieve
    729  1.1  riastrad  * @tvblank: Pointer to target struct timeval which should receive the timestamp
    730  1.1  riastrad  * @flags: Flags to pass to driver:
    731  1.1  riastrad  *         0 = Default.
    732  1.1  riastrad  *         DRM_CALLED_FROM_VBLIRQ = If function is called from vbl irq handler.
    733  1.1  riastrad  *
    734  1.1  riastrad  * Fetches the system timestamp corresponding to the time of the most recent
    735  1.1  riastrad  * vblank interval on specified crtc. May call into kms-driver to
    736  1.1  riastrad  * compute the timestamp with a high-precision GPU specific method.
    737  1.1  riastrad  *
    738  1.1  riastrad  * Returns zero if timestamp originates from uncorrected do_gettimeofday()
    739  1.1  riastrad  * call, i.e., it isn't very precisely locked to the true vblank.
    740  1.1  riastrad  *
    741  1.1  riastrad  * Returns non-zero if timestamp is considered to be very precise.
    742  1.1  riastrad  */
    743  1.1  riastrad u32 drm_get_last_vbltimestamp(struct drm_device *dev, int crtc,
    744  1.1  riastrad 			      struct timeval *tvblank, unsigned flags)
    745  1.1  riastrad {
    746  1.1  riastrad 	int ret;
    747  1.1  riastrad 
    748  1.1  riastrad 	/* Define requested maximum error on timestamps (nanoseconds). */
    749  1.1  riastrad 	int max_error = (int) drm_timestamp_precision * 1000;
    750  1.1  riastrad 
    751  1.1  riastrad 	/* Query driver if possible and precision timestamping enabled. */
    752  1.1  riastrad 	if (dev->driver->get_vblank_timestamp && (max_error > 0)) {
    753  1.1  riastrad 		ret = dev->driver->get_vblank_timestamp(dev, crtc, &max_error,
    754  1.1  riastrad 							tvblank, flags);
    755  1.1  riastrad 		if (ret > 0)
    756  1.1  riastrad 			return (u32) ret;
    757  1.1  riastrad 	}
    758  1.1  riastrad 
    759  1.1  riastrad 	/* GPU high precision timestamp query unsupported or failed.
    760  1.1  riastrad 	 * Return current monotonic/gettimeofday timestamp as best estimate.
    761  1.1  riastrad 	 */
    762  1.1  riastrad 	*tvblank = get_drm_timestamp();
    763  1.1  riastrad 
    764  1.1  riastrad 	return 0;
    765  1.1  riastrad }
    766  1.1  riastrad EXPORT_SYMBOL(drm_get_last_vbltimestamp);
    767  1.1  riastrad 
    768  1.1  riastrad /**
    769  1.1  riastrad  * drm_vblank_count - retrieve "cooked" vblank counter value
    770  1.1  riastrad  * @dev: DRM device
    771  1.1  riastrad  * @crtc: which counter to retrieve
    772  1.1  riastrad  *
    773  1.1  riastrad  * Fetches the "cooked" vblank count value that represents the number of
    774  1.1  riastrad  * vblank events since the system was booted, including lost events due to
    775  1.1  riastrad  * modesetting activity.
    776  1.1  riastrad  */
    777  1.1  riastrad u32 drm_vblank_count(struct drm_device *dev, int crtc)
    778  1.1  riastrad {
    779  1.4  riastrad 	return atomic_read(&dev->vblank[crtc].count);
    780  1.1  riastrad }
    781  1.1  riastrad EXPORT_SYMBOL(drm_vblank_count);
    782  1.1  riastrad 
    783  1.1  riastrad /**
    784  1.1  riastrad  * drm_vblank_count_and_time - retrieve "cooked" vblank counter value
    785  1.1  riastrad  * and the system timestamp corresponding to that vblank counter value.
    786  1.1  riastrad  *
    787  1.1  riastrad  * @dev: DRM device
    788  1.1  riastrad  * @crtc: which counter to retrieve
    789  1.1  riastrad  * @vblanktime: Pointer to struct timeval to receive the vblank timestamp.
    790  1.1  riastrad  *
    791  1.1  riastrad  * Fetches the "cooked" vblank count value that represents the number of
    792  1.1  riastrad  * vblank events since the system was booted, including lost events due to
    793  1.1  riastrad  * modesetting activity. Returns corresponding system timestamp of the time
    794  1.1  riastrad  * of the vblank interval that corresponds to the current value vblank counter
    795  1.1  riastrad  * value.
    796  1.1  riastrad  */
    797  1.1  riastrad u32 drm_vblank_count_and_time(struct drm_device *dev, int crtc,
    798  1.1  riastrad 			      struct timeval *vblanktime)
    799  1.1  riastrad {
    800  1.1  riastrad 	u32 cur_vblank;
    801  1.1  riastrad 
    802  1.1  riastrad 	/* Read timestamp from slot of _vblank_time ringbuffer
    803  1.1  riastrad 	 * that corresponds to current vblank count. Retry if
    804  1.1  riastrad 	 * count has incremented during readout. This works like
    805  1.1  riastrad 	 * a seqlock.
    806  1.1  riastrad 	 */
    807  1.1  riastrad 	do {
    808  1.4  riastrad 		cur_vblank = atomic_read(&dev->vblank[crtc].count);
    809  1.1  riastrad 		*vblanktime = vblanktimestamp(dev, crtc, cur_vblank);
    810  1.1  riastrad 		smp_rmb();
    811  1.4  riastrad 	} while (cur_vblank != atomic_read(&dev->vblank[crtc].count));
    812  1.1  riastrad 
    813  1.1  riastrad 	return cur_vblank;
    814  1.1  riastrad }
    815  1.1  riastrad EXPORT_SYMBOL(drm_vblank_count_and_time);
    816  1.1  riastrad 
    817  1.1  riastrad static void send_vblank_event(struct drm_device *dev,
    818  1.1  riastrad 		struct drm_pending_vblank_event *e,
    819  1.1  riastrad 		unsigned long seq, struct timeval *now)
    820  1.1  riastrad {
    821  1.1  riastrad 	WARN_ON_SMP(!spin_is_locked(&dev->event_lock));
    822  1.1  riastrad 	e->event.sequence = seq;
    823  1.1  riastrad 	e->event.tv_sec = now->tv_sec;
    824  1.1  riastrad 	e->event.tv_usec = now->tv_usec;
    825  1.1  riastrad 
    826  1.1  riastrad 	list_add_tail(&e->base.link,
    827  1.1  riastrad 		      &e->base.file_priv->event_list);
    828  1.2  riastrad #ifdef __NetBSD__
    829  1.2  riastrad 	DRM_SPIN_WAKEUP_ONE(&e->base.file_priv->event_wait, &dev->event_lock);
    830  1.2  riastrad 	selnotify(&e->base.file_priv->event_selq, (POLLIN | POLLRDNORM),
    831  1.2  riastrad 	    NOTE_SUBMIT);
    832  1.2  riastrad #else
    833  1.1  riastrad 	wake_up_interruptible(&e->base.file_priv->event_wait);
    834  1.2  riastrad #endif
    835  1.1  riastrad 	trace_drm_vblank_event_delivered(e->base.pid, e->pipe,
    836  1.1  riastrad 					 e->event.sequence);
    837  1.1  riastrad }
    838  1.1  riastrad 
    839  1.1  riastrad /**
    840  1.1  riastrad  * drm_send_vblank_event - helper to send vblank event after pageflip
    841  1.1  riastrad  * @dev: DRM device
    842  1.1  riastrad  * @crtc: CRTC in question
    843  1.1  riastrad  * @e: the event to send
    844  1.1  riastrad  *
    845  1.1  riastrad  * Updates sequence # and timestamp on event, and sends it to userspace.
    846  1.1  riastrad  * Caller must hold event lock.
    847  1.1  riastrad  */
    848  1.1  riastrad void drm_send_vblank_event(struct drm_device *dev, int crtc,
    849  1.1  riastrad 		struct drm_pending_vblank_event *e)
    850  1.1  riastrad {
    851  1.1  riastrad 	struct timeval now;
    852  1.1  riastrad 	unsigned int seq;
    853  1.1  riastrad 	if (crtc >= 0) {
    854  1.1  riastrad 		seq = drm_vblank_count_and_time(dev, crtc, &now);
    855  1.1  riastrad 	} else {
    856  1.1  riastrad 		seq = 0;
    857  1.1  riastrad 
    858  1.1  riastrad 		now = get_drm_timestamp();
    859  1.1  riastrad 	}
    860  1.4  riastrad 	e->pipe = crtc;
    861  1.1  riastrad 	send_vblank_event(dev, e, seq, &now);
    862  1.1  riastrad }
    863  1.1  riastrad EXPORT_SYMBOL(drm_send_vblank_event);
    864  1.1  riastrad 
    865  1.1  riastrad /**
    866  1.1  riastrad  * drm_update_vblank_count - update the master vblank counter
    867  1.1  riastrad  * @dev: DRM device
    868  1.1  riastrad  * @crtc: counter to update
    869  1.1  riastrad  *
    870  1.1  riastrad  * Call back into the driver to update the appropriate vblank counter
    871  1.1  riastrad  * (specified by @crtc).  Deal with wraparound, if it occurred, and
    872  1.1  riastrad  * update the last read value so we can deal with wraparound on the next
    873  1.1  riastrad  * call if necessary.
    874  1.1  riastrad  *
    875  1.1  riastrad  * Only necessary when going from off->on, to account for frames we
    876  1.1  riastrad  * didn't get an interrupt for.
    877  1.1  riastrad  *
    878  1.1  riastrad  * Note: caller must hold dev->vbl_lock since this reads & writes
    879  1.1  riastrad  * device vblank fields.
    880  1.1  riastrad  */
    881  1.1  riastrad static void drm_update_vblank_count(struct drm_device *dev, int crtc)
    882  1.1  riastrad {
    883  1.1  riastrad 	u32 cur_vblank, diff, tslot, rc;
    884  1.1  riastrad 	struct timeval t_vblank;
    885  1.1  riastrad 
    886  1.1  riastrad 	/*
    887  1.1  riastrad 	 * Interrupts were disabled prior to this call, so deal with counter
    888  1.1  riastrad 	 * wrap if needed.
    889  1.1  riastrad 	 * NOTE!  It's possible we lost a full dev->max_vblank_count events
    890  1.1  riastrad 	 * here if the register is small or we had vblank interrupts off for
    891  1.1  riastrad 	 * a long time.
    892  1.1  riastrad 	 *
    893  1.1  riastrad 	 * We repeat the hardware vblank counter & timestamp query until
    894  1.1  riastrad 	 * we get consistent results. This to prevent races between gpu
    895  1.1  riastrad 	 * updating its hardware counter while we are retrieving the
    896  1.1  riastrad 	 * corresponding vblank timestamp.
    897  1.1  riastrad 	 */
    898  1.1  riastrad 	do {
    899  1.1  riastrad 		cur_vblank = dev->driver->get_vblank_counter(dev, crtc);
    900  1.1  riastrad 		rc = drm_get_last_vbltimestamp(dev, crtc, &t_vblank, 0);
    901  1.1  riastrad 	} while (cur_vblank != dev->driver->get_vblank_counter(dev, crtc));
    902  1.1  riastrad 
    903  1.1  riastrad 	/* Deal with counter wrap */
    904  1.4  riastrad 	diff = cur_vblank - dev->vblank[crtc].last;
    905  1.4  riastrad 	if (cur_vblank < dev->vblank[crtc].last) {
    906  1.1  riastrad 		diff += dev->max_vblank_count;
    907  1.1  riastrad 
    908  1.1  riastrad 		DRM_DEBUG("last_vblank[%d]=0x%x, cur_vblank=0x%x => diff=0x%x\n",
    909  1.4  riastrad 			  crtc, dev->vblank[crtc].last, cur_vblank, diff);
    910  1.1  riastrad 	}
    911  1.1  riastrad 
    912  1.1  riastrad 	DRM_DEBUG("enabling vblank interrupts on crtc %d, missed %d\n",
    913  1.1  riastrad 		  crtc, diff);
    914  1.1  riastrad 
    915  1.1  riastrad 	/* Reinitialize corresponding vblank timestamp if high-precision query
    916  1.1  riastrad 	 * available. Skip this step if query unsupported or failed. Will
    917  1.1  riastrad 	 * reinitialize delayed at next vblank interrupt in that case.
    918  1.1  riastrad 	 */
    919  1.1  riastrad 	if (rc) {
    920  1.4  riastrad 		tslot = atomic_read(&dev->vblank[crtc].count) + diff;
    921  1.1  riastrad 		vblanktimestamp(dev, crtc, tslot) = t_vblank;
    922  1.1  riastrad 	}
    923  1.1  riastrad 
    924  1.1  riastrad 	smp_mb__before_atomic_inc();
    925  1.4  riastrad 	atomic_add(diff, &dev->vblank[crtc].count);
    926  1.1  riastrad 	smp_mb__after_atomic_inc();
    927  1.1  riastrad }
    928  1.1  riastrad 
    929  1.1  riastrad /**
    930  1.1  riastrad  * drm_vblank_get - get a reference count on vblank events
    931  1.1  riastrad  * @dev: DRM device
    932  1.1  riastrad  * @crtc: which CRTC to own
    933  1.1  riastrad  *
    934  1.1  riastrad  * Acquire a reference count on vblank events to avoid having them disabled
    935  1.1  riastrad  * while in use.
    936  1.1  riastrad  *
    937  1.1  riastrad  * RETURNS
    938  1.1  riastrad  * Zero on success, nonzero on failure.
    939  1.1  riastrad  */
    940  1.1  riastrad int drm_vblank_get(struct drm_device *dev, int crtc)
    941  1.1  riastrad {
    942  1.1  riastrad 	unsigned long irqflags, irqflags2;
    943  1.1  riastrad 	int ret = 0;
    944  1.1  riastrad 
    945  1.1  riastrad 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
    946  1.1  riastrad 	/* Going from 0->1 means we have to enable interrupts again */
    947  1.4  riastrad 	if (atomic_add_return(1, &dev->vblank[crtc].refcount) == 1) {
    948  1.1  riastrad 		spin_lock_irqsave(&dev->vblank_time_lock, irqflags2);
    949  1.4  riastrad 		if (!dev->vblank[crtc].enabled) {
    950  1.1  riastrad 			/* Enable vblank irqs under vblank_time_lock protection.
    951  1.1  riastrad 			 * All vblank count & timestamp updates are held off
    952  1.1  riastrad 			 * until we are done reinitializing master counter and
    953  1.1  riastrad 			 * timestamps. Filtercode in drm_handle_vblank() will
    954  1.1  riastrad 			 * prevent double-accounting of same vblank interval.
    955  1.1  riastrad 			 */
    956  1.1  riastrad 			ret = dev->driver->enable_vblank(dev, crtc);
    957  1.1  riastrad 			DRM_DEBUG("enabling vblank on crtc %d, ret: %d\n",
    958  1.1  riastrad 				  crtc, ret);
    959  1.1  riastrad 			if (ret)
    960  1.4  riastrad 				atomic_dec(&dev->vblank[crtc].refcount);
    961  1.1  riastrad 			else {
    962  1.4  riastrad 				dev->vblank[crtc].enabled = true;
    963  1.1  riastrad 				drm_update_vblank_count(dev, crtc);
    964  1.1  riastrad 			}
    965  1.1  riastrad 		}
    966  1.1  riastrad 		spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags2);
    967  1.1  riastrad 	} else {
    968  1.4  riastrad 		if (!dev->vblank[crtc].enabled) {
    969  1.4  riastrad 			atomic_dec(&dev->vblank[crtc].refcount);
    970  1.1  riastrad 			ret = -EINVAL;
    971  1.1  riastrad 		}
    972  1.1  riastrad 	}
    973  1.1  riastrad 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
    974  1.1  riastrad 
    975  1.1  riastrad 	return ret;
    976  1.1  riastrad }
    977  1.1  riastrad EXPORT_SYMBOL(drm_vblank_get);
    978  1.1  riastrad 
    979  1.1  riastrad /**
    980  1.1  riastrad  * drm_vblank_put - give up ownership of vblank events
    981  1.1  riastrad  * @dev: DRM device
    982  1.1  riastrad  * @crtc: which counter to give up
    983  1.1  riastrad  *
    984  1.1  riastrad  * Release ownership of a given vblank counter, turning off interrupts
    985  1.1  riastrad  * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
    986  1.1  riastrad  */
    987  1.1  riastrad void drm_vblank_put(struct drm_device *dev, int crtc)
    988  1.1  riastrad {
    989  1.4  riastrad 	BUG_ON(atomic_read(&dev->vblank[crtc].refcount) == 0);
    990  1.1  riastrad 
    991  1.1  riastrad 	/* Last user schedules interrupt disable */
    992  1.4  riastrad 	if (atomic_dec_and_test(&dev->vblank[crtc].refcount) &&
    993  1.1  riastrad 	    (drm_vblank_offdelay > 0))
    994  1.1  riastrad 		mod_timer(&dev->vblank_disable_timer,
    995  1.4  riastrad 			  jiffies + ((drm_vblank_offdelay * HZ)/1000));
    996  1.1  riastrad }
    997  1.1  riastrad EXPORT_SYMBOL(drm_vblank_put);
    998  1.1  riastrad 
    999  1.1  riastrad /**
   1000  1.1  riastrad  * drm_vblank_off - disable vblank events on a CRTC
   1001  1.1  riastrad  * @dev: DRM device
   1002  1.1  riastrad  * @crtc: CRTC in question
   1003  1.1  riastrad  *
   1004  1.1  riastrad  * Caller must hold event lock.
   1005  1.1  riastrad  */
   1006  1.1  riastrad void drm_vblank_off(struct drm_device *dev, int crtc)
   1007  1.1  riastrad {
   1008  1.1  riastrad 	struct drm_pending_vblank_event *e, *t;
   1009  1.1  riastrad 	struct timeval now;
   1010  1.1  riastrad 	unsigned long irqflags;
   1011  1.1  riastrad 	unsigned int seq;
   1012  1.1  riastrad 
   1013  1.1  riastrad 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
   1014  1.1  riastrad 	vblank_disable_and_save(dev, crtc);
   1015  1.2  riastrad #ifdef __NetBSD__
   1016  1.4  riastrad 	DRM_SPIN_WAKEUP_ONE(&dev->vblank[crtc].queue, &dev->vbl_lock);
   1017  1.2  riastrad #else
   1018  1.4  riastrad 	wake_up(&dev->vblank[crtc].queue);
   1019  1.2  riastrad #endif
   1020  1.1  riastrad 
   1021  1.1  riastrad 	/* Send any queued vblank events, lest the natives grow disquiet */
   1022  1.1  riastrad 	seq = drm_vblank_count_and_time(dev, crtc, &now);
   1023  1.1  riastrad 
   1024  1.1  riastrad 	spin_lock(&dev->event_lock);
   1025  1.1  riastrad 	list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
   1026  1.1  riastrad 		if (e->pipe != crtc)
   1027  1.1  riastrad 			continue;
   1028  1.1  riastrad 		DRM_DEBUG("Sending premature vblank event on disable: \
   1029  1.1  riastrad 			  wanted %d, current %d\n",
   1030  1.1  riastrad 			  e->event.sequence, seq);
   1031  1.1  riastrad 		list_del(&e->base.link);
   1032  1.1  riastrad 		drm_vblank_put(dev, e->pipe);
   1033  1.1  riastrad 		send_vblank_event(dev, e, seq, &now);
   1034  1.1  riastrad 	}
   1035  1.1  riastrad 	spin_unlock(&dev->event_lock);
   1036  1.1  riastrad 
   1037  1.1  riastrad 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
   1038  1.1  riastrad }
   1039  1.1  riastrad EXPORT_SYMBOL(drm_vblank_off);
   1040  1.1  riastrad 
   1041  1.1  riastrad /**
   1042  1.1  riastrad  * drm_vblank_pre_modeset - account for vblanks across mode sets
   1043  1.1  riastrad  * @dev: DRM device
   1044  1.1  riastrad  * @crtc: CRTC in question
   1045  1.1  riastrad  *
   1046  1.1  riastrad  * Account for vblank events across mode setting events, which will likely
   1047  1.1  riastrad  * reset the hardware frame counter.
   1048  1.1  riastrad  */
   1049  1.1  riastrad void drm_vblank_pre_modeset(struct drm_device *dev, int crtc)
   1050  1.1  riastrad {
   1051  1.4  riastrad 	/* vblank is not initialized (IRQ not installed ?), or has been freed */
   1052  1.1  riastrad 	if (!dev->num_crtcs)
   1053  1.1  riastrad 		return;
   1054  1.1  riastrad 	/*
   1055  1.1  riastrad 	 * To avoid all the problems that might happen if interrupts
   1056  1.1  riastrad 	 * were enabled/disabled around or between these calls, we just
   1057  1.1  riastrad 	 * have the kernel take a reference on the CRTC (just once though
   1058  1.1  riastrad 	 * to avoid corrupting the count if multiple, mismatch calls occur),
   1059  1.1  riastrad 	 * so that interrupts remain enabled in the interim.
   1060  1.1  riastrad 	 */
   1061  1.4  riastrad 	if (!dev->vblank[crtc].inmodeset) {
   1062  1.4  riastrad 		dev->vblank[crtc].inmodeset = 0x1;
   1063  1.1  riastrad 		if (drm_vblank_get(dev, crtc) == 0)
   1064  1.4  riastrad 			dev->vblank[crtc].inmodeset |= 0x2;
   1065  1.1  riastrad 	}
   1066  1.1  riastrad }
   1067  1.1  riastrad EXPORT_SYMBOL(drm_vblank_pre_modeset);
   1068  1.1  riastrad 
   1069  1.1  riastrad void drm_vblank_post_modeset(struct drm_device *dev, int crtc)
   1070  1.1  riastrad {
   1071  1.1  riastrad 	unsigned long irqflags;
   1072  1.1  riastrad 
   1073  1.4  riastrad 	/* vblank is not initialized (IRQ not installed ?), or has been freed */
   1074  1.4  riastrad 	if (!dev->num_crtcs)
   1075  1.4  riastrad 		return;
   1076  1.4  riastrad 
   1077  1.4  riastrad 	if (dev->vblank[crtc].inmodeset) {
   1078  1.1  riastrad 		spin_lock_irqsave(&dev->vbl_lock, irqflags);
   1079  1.4  riastrad 		dev->vblank_disable_allowed = true;
   1080  1.1  riastrad 		spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
   1081  1.1  riastrad 
   1082  1.4  riastrad 		if (dev->vblank[crtc].inmodeset & 0x2)
   1083  1.1  riastrad 			drm_vblank_put(dev, crtc);
   1084  1.1  riastrad 
   1085  1.4  riastrad 		dev->vblank[crtc].inmodeset = 0;
   1086  1.1  riastrad 	}
   1087  1.1  riastrad }
   1088  1.1  riastrad EXPORT_SYMBOL(drm_vblank_post_modeset);
   1089  1.1  riastrad 
   1090  1.1  riastrad /**
   1091  1.1  riastrad  * drm_modeset_ctl - handle vblank event counter changes across mode switch
   1092  1.1  riastrad  * @DRM_IOCTL_ARGS: standard ioctl arguments
   1093  1.1  riastrad  *
   1094  1.1  riastrad  * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET
   1095  1.1  riastrad  * ioctls around modesetting so that any lost vblank events are accounted for.
   1096  1.1  riastrad  *
   1097  1.1  riastrad  * Generally the counter will reset across mode sets.  If interrupts are
   1098  1.1  riastrad  * enabled around this call, we don't have to do anything since the counter
   1099  1.1  riastrad  * will have already been incremented.
   1100  1.1  riastrad  */
   1101  1.1  riastrad int drm_modeset_ctl(struct drm_device *dev, void *data,
   1102  1.1  riastrad 		    struct drm_file *file_priv)
   1103  1.1  riastrad {
   1104  1.1  riastrad 	struct drm_modeset_ctl *modeset = data;
   1105  1.1  riastrad 	unsigned int crtc;
   1106  1.1  riastrad 
   1107  1.1  riastrad 	/* If drm_vblank_init() hasn't been called yet, just no-op */
   1108  1.1  riastrad 	if (!dev->num_crtcs)
   1109  1.1  riastrad 		return 0;
   1110  1.1  riastrad 
   1111  1.1  riastrad 	/* KMS drivers handle this internally */
   1112  1.1  riastrad 	if (drm_core_check_feature(dev, DRIVER_MODESET))
   1113  1.1  riastrad 		return 0;
   1114  1.1  riastrad 
   1115  1.1  riastrad 	crtc = modeset->crtc;
   1116  1.1  riastrad 	if (crtc >= dev->num_crtcs)
   1117  1.1  riastrad 		return -EINVAL;
   1118  1.1  riastrad 
   1119  1.1  riastrad 	switch (modeset->cmd) {
   1120  1.1  riastrad 	case _DRM_PRE_MODESET:
   1121  1.1  riastrad 		drm_vblank_pre_modeset(dev, crtc);
   1122  1.1  riastrad 		break;
   1123  1.1  riastrad 	case _DRM_POST_MODESET:
   1124  1.1  riastrad 		drm_vblank_post_modeset(dev, crtc);
   1125  1.1  riastrad 		break;
   1126  1.1  riastrad 	default:
   1127  1.1  riastrad 		return -EINVAL;
   1128  1.1  riastrad 	}
   1129  1.1  riastrad 
   1130  1.1  riastrad 	return 0;
   1131  1.1  riastrad }
   1132  1.1  riastrad 
   1133  1.1  riastrad static int drm_queue_vblank_event(struct drm_device *dev, int pipe,
   1134  1.1  riastrad 				  union drm_wait_vblank *vblwait,
   1135  1.1  riastrad 				  struct drm_file *file_priv)
   1136  1.1  riastrad {
   1137  1.1  riastrad 	struct drm_pending_vblank_event *e;
   1138  1.1  riastrad 	struct timeval now;
   1139  1.1  riastrad 	unsigned long flags;
   1140  1.1  riastrad 	unsigned int seq;
   1141  1.1  riastrad 	int ret;
   1142  1.1  riastrad 
   1143  1.1  riastrad 	e = kzalloc(sizeof *e, GFP_KERNEL);
   1144  1.1  riastrad 	if (e == NULL) {
   1145  1.1  riastrad 		ret = -ENOMEM;
   1146  1.1  riastrad 		goto err_put;
   1147  1.1  riastrad 	}
   1148  1.1  riastrad 
   1149  1.1  riastrad 	e->pipe = pipe;
   1150  1.2  riastrad #ifdef __NetBSD__
   1151  1.2  riastrad 	e->base.pid = curproc->p_pid;
   1152  1.2  riastrad #else
   1153  1.1  riastrad 	e->base.pid = current->pid;
   1154  1.2  riastrad #endif
   1155  1.1  riastrad 	e->event.base.type = DRM_EVENT_VBLANK;
   1156  1.1  riastrad 	e->event.base.length = sizeof e->event;
   1157  1.1  riastrad 	e->event.user_data = vblwait->request.signal;
   1158  1.1  riastrad 	e->base.event = &e->event.base;
   1159  1.1  riastrad 	e->base.file_priv = file_priv;
   1160  1.1  riastrad 	e->base.destroy = (void (*) (struct drm_pending_event *)) kfree;
   1161  1.1  riastrad 
   1162  1.1  riastrad 	spin_lock_irqsave(&dev->event_lock, flags);
   1163  1.1  riastrad 
   1164  1.1  riastrad 	if (file_priv->event_space < sizeof e->event) {
   1165  1.1  riastrad 		ret = -EBUSY;
   1166  1.1  riastrad 		goto err_unlock;
   1167  1.1  riastrad 	}
   1168  1.1  riastrad 
   1169  1.1  riastrad 	file_priv->event_space -= sizeof e->event;
   1170  1.1  riastrad 	seq = drm_vblank_count_and_time(dev, pipe, &now);
   1171  1.1  riastrad 
   1172  1.1  riastrad 	if ((vblwait->request.type & _DRM_VBLANK_NEXTONMISS) &&
   1173  1.1  riastrad 	    (seq - vblwait->request.sequence) <= (1 << 23)) {
   1174  1.1  riastrad 		vblwait->request.sequence = seq + 1;
   1175  1.1  riastrad 		vblwait->reply.sequence = vblwait->request.sequence;
   1176  1.1  riastrad 	}
   1177  1.1  riastrad 
   1178  1.1  riastrad 	DRM_DEBUG("event on vblank count %d, current %d, crtc %d\n",
   1179  1.1  riastrad 		  vblwait->request.sequence, seq, pipe);
   1180  1.1  riastrad 
   1181  1.2  riastrad #ifdef __NetBSD__
   1182  1.2  riastrad 	trace_drm_vblank_event_queued(curproc->p_pid, pipe,
   1183  1.2  riastrad 				      vblwait->request.sequence);
   1184  1.2  riastrad #else
   1185  1.1  riastrad 	trace_drm_vblank_event_queued(current->pid, pipe,
   1186  1.1  riastrad 				      vblwait->request.sequence);
   1187  1.2  riastrad #endif
   1188  1.1  riastrad 
   1189  1.1  riastrad 	e->event.sequence = vblwait->request.sequence;
   1190  1.1  riastrad 	if ((seq - vblwait->request.sequence) <= (1 << 23)) {
   1191  1.1  riastrad 		drm_vblank_put(dev, pipe);
   1192  1.1  riastrad 		send_vblank_event(dev, e, seq, &now);
   1193  1.1  riastrad 		vblwait->reply.sequence = seq;
   1194  1.1  riastrad 	} else {
   1195  1.1  riastrad 		/* drm_handle_vblank_events will call drm_vblank_put */
   1196  1.1  riastrad 		list_add_tail(&e->base.link, &dev->vblank_event_list);
   1197  1.1  riastrad 		vblwait->reply.sequence = vblwait->request.sequence;
   1198  1.1  riastrad 	}
   1199  1.1  riastrad 
   1200  1.1  riastrad 	spin_unlock_irqrestore(&dev->event_lock, flags);
   1201  1.1  riastrad 
   1202  1.1  riastrad 	return 0;
   1203  1.1  riastrad 
   1204  1.1  riastrad err_unlock:
   1205  1.1  riastrad 	spin_unlock_irqrestore(&dev->event_lock, flags);
   1206  1.1  riastrad 	kfree(e);
   1207  1.1  riastrad err_put:
   1208  1.1  riastrad 	drm_vblank_put(dev, pipe);
   1209  1.1  riastrad 	return ret;
   1210  1.1  riastrad }
   1211  1.1  riastrad 
   1212  1.1  riastrad /**
   1213  1.1  riastrad  * Wait for VBLANK.
   1214  1.1  riastrad  *
   1215  1.1  riastrad  * \param inode device inode.
   1216  1.1  riastrad  * \param file_priv DRM file private.
   1217  1.1  riastrad  * \param cmd command.
   1218  1.1  riastrad  * \param data user argument, pointing to a drm_wait_vblank structure.
   1219  1.1  riastrad  * \return zero on success or a negative number on failure.
   1220  1.1  riastrad  *
   1221  1.1  riastrad  * This function enables the vblank interrupt on the pipe requested, then
   1222  1.1  riastrad  * sleeps waiting for the requested sequence number to occur, and drops
   1223  1.1  riastrad  * the vblank interrupt refcount afterwards. (vblank irq disable follows that
   1224  1.1  riastrad  * after a timeout with no further vblank waits scheduled).
   1225  1.1  riastrad  */
   1226  1.1  riastrad int drm_wait_vblank(struct drm_device *dev, void *data,
   1227  1.1  riastrad 		    struct drm_file *file_priv)
   1228  1.1  riastrad {
   1229  1.1  riastrad 	union drm_wait_vblank *vblwait = data;
   1230  1.1  riastrad 	int ret;
   1231  1.1  riastrad 	unsigned int flags, seq, crtc, high_crtc;
   1232  1.1  riastrad 
   1233  1.4  riastrad 	if (drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
   1234  1.4  riastrad 		if ((!drm_dev_to_irq(dev)) || (!dev->irq_enabled))
   1235  1.4  riastrad 			return -EINVAL;
   1236  1.1  riastrad 
   1237  1.1  riastrad 	if (vblwait->request.type & _DRM_VBLANK_SIGNAL)
   1238  1.1  riastrad 		return -EINVAL;
   1239  1.1  riastrad 
   1240  1.1  riastrad 	if (vblwait->request.type &
   1241  1.1  riastrad 	    ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
   1242  1.1  riastrad 	      _DRM_VBLANK_HIGH_CRTC_MASK)) {
   1243  1.1  riastrad 		DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n",
   1244  1.1  riastrad 			  vblwait->request.type,
   1245  1.1  riastrad 			  (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
   1246  1.1  riastrad 			   _DRM_VBLANK_HIGH_CRTC_MASK));
   1247  1.1  riastrad 		return -EINVAL;
   1248  1.1  riastrad 	}
   1249  1.1  riastrad 
   1250  1.1  riastrad 	flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK;
   1251  1.1  riastrad 	high_crtc = (vblwait->request.type & _DRM_VBLANK_HIGH_CRTC_MASK);
   1252  1.1  riastrad 	if (high_crtc)
   1253  1.1  riastrad 		crtc = high_crtc >> _DRM_VBLANK_HIGH_CRTC_SHIFT;
   1254  1.1  riastrad 	else
   1255  1.1  riastrad 		crtc = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
   1256  1.1  riastrad 	if (crtc >= dev->num_crtcs)
   1257  1.1  riastrad 		return -EINVAL;
   1258  1.1  riastrad 
   1259  1.1  riastrad 	ret = drm_vblank_get(dev, crtc);
   1260  1.1  riastrad 	if (ret) {
   1261  1.1  riastrad 		DRM_DEBUG("failed to acquire vblank counter, %d\n", ret);
   1262  1.1  riastrad 		return ret;
   1263  1.1  riastrad 	}
   1264  1.1  riastrad 	seq = drm_vblank_count(dev, crtc);
   1265  1.1  riastrad 
   1266  1.1  riastrad 	switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) {
   1267  1.1  riastrad 	case _DRM_VBLANK_RELATIVE:
   1268  1.1  riastrad 		vblwait->request.sequence += seq;
   1269  1.1  riastrad 		vblwait->request.type &= ~_DRM_VBLANK_RELATIVE;
   1270  1.1  riastrad 	case _DRM_VBLANK_ABSOLUTE:
   1271  1.1  riastrad 		break;
   1272  1.1  riastrad 	default:
   1273  1.1  riastrad 		ret = -EINVAL;
   1274  1.1  riastrad 		goto done;
   1275  1.1  riastrad 	}
   1276  1.1  riastrad 
   1277  1.1  riastrad 	if (flags & _DRM_VBLANK_EVENT) {
   1278  1.1  riastrad 		/* must hold on to the vblank ref until the event fires
   1279  1.1  riastrad 		 * drm_vblank_put will be called asynchronously
   1280  1.1  riastrad 		 */
   1281  1.1  riastrad 		return drm_queue_vblank_event(dev, crtc, vblwait, file_priv);
   1282  1.1  riastrad 	}
   1283  1.1  riastrad 
   1284  1.1  riastrad 	if ((flags & _DRM_VBLANK_NEXTONMISS) &&
   1285  1.1  riastrad 	    (seq - vblwait->request.sequence) <= (1<<23)) {
   1286  1.1  riastrad 		vblwait->request.sequence = seq + 1;
   1287  1.1  riastrad 	}
   1288  1.1  riastrad 
   1289  1.1  riastrad 	DRM_DEBUG("waiting on vblank count %d, crtc %d\n",
   1290  1.1  riastrad 		  vblwait->request.sequence, crtc);
   1291  1.4  riastrad 	dev->vblank[crtc].last_wait = vblwait->request.sequence;
   1292  1.2  riastrad #ifdef __NetBSD__
   1293  1.2  riastrad     {
   1294  1.2  riastrad 	unsigned long irqflags;
   1295  1.2  riastrad 	spin_lock_irqsave(&dev->vbl_lock, irqflags);
   1296  1.4  riastrad 	DRM_SPIN_TIMED_WAIT_UNTIL(ret, &dev->vblank[crtc].queue,
   1297  1.4  riastrad 	    &dev->vbl_lock,
   1298  1.4  riastrad 	    (3 * HZ),
   1299  1.2  riastrad 	    (((drm_vblank_count(dev, crtc) -
   1300  1.2  riastrad 		    vblwait->request.sequence) <= (1 << 23)) ||
   1301  1.2  riastrad 		!dev->irq_enabled));
   1302  1.2  riastrad 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
   1303  1.2  riastrad 	if (0 < ret)
   1304  1.2  riastrad 		/*
   1305  1.2  riastrad 		 * ret is ticks remaining on success in this case, but
   1306  1.2  riastrad 		 * caller just wants 0 for success.
   1307  1.2  riastrad 		 */
   1308  1.2  riastrad 		ret = 0;
   1309  1.2  riastrad     }
   1310  1.2  riastrad #else
   1311  1.4  riastrad 	DRM_WAIT_ON(ret, dev->vblank[crtc].queue, 3 * HZ,
   1312  1.1  riastrad 		    (((drm_vblank_count(dev, crtc) -
   1313  1.1  riastrad 		       vblwait->request.sequence) <= (1 << 23)) ||
   1314  1.1  riastrad 		     !dev->irq_enabled));
   1315  1.2  riastrad #endif
   1316  1.1  riastrad 
   1317  1.1  riastrad 	if (ret != -EINTR) {
   1318  1.1  riastrad 		struct timeval now;
   1319  1.1  riastrad 
   1320  1.1  riastrad 		vblwait->reply.sequence = drm_vblank_count_and_time(dev, crtc, &now);
   1321  1.1  riastrad 		vblwait->reply.tval_sec = now.tv_sec;
   1322  1.1  riastrad 		vblwait->reply.tval_usec = now.tv_usec;
   1323  1.1  riastrad 
   1324  1.1  riastrad 		DRM_DEBUG("returning %d to client\n",
   1325  1.1  riastrad 			  vblwait->reply.sequence);
   1326  1.1  riastrad 	} else {
   1327  1.1  riastrad 		DRM_DEBUG("vblank wait interrupted by signal\n");
   1328  1.1  riastrad 	}
   1329  1.1  riastrad 
   1330  1.1  riastrad done:
   1331  1.1  riastrad 	drm_vblank_put(dev, crtc);
   1332  1.1  riastrad 	return ret;
   1333  1.1  riastrad }
   1334  1.1  riastrad 
   1335  1.1  riastrad static void drm_handle_vblank_events(struct drm_device *dev, int crtc)
   1336  1.1  riastrad {
   1337  1.1  riastrad 	struct drm_pending_vblank_event *e, *t;
   1338  1.1  riastrad 	struct timeval now;
   1339  1.1  riastrad 	unsigned long flags;
   1340  1.1  riastrad 	unsigned int seq;
   1341  1.1  riastrad 
   1342  1.1  riastrad 	seq = drm_vblank_count_and_time(dev, crtc, &now);
   1343  1.1  riastrad 
   1344  1.1  riastrad 	spin_lock_irqsave(&dev->event_lock, flags);
   1345  1.1  riastrad 
   1346  1.1  riastrad 	list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
   1347  1.1  riastrad 		if (e->pipe != crtc)
   1348  1.1  riastrad 			continue;
   1349  1.1  riastrad 		if ((seq - e->event.sequence) > (1<<23))
   1350  1.1  riastrad 			continue;
   1351  1.1  riastrad 
   1352  1.1  riastrad 		DRM_DEBUG("vblank event on %d, current %d\n",
   1353  1.1  riastrad 			  e->event.sequence, seq);
   1354  1.1  riastrad 
   1355  1.1  riastrad 		list_del(&e->base.link);
   1356  1.1  riastrad 		drm_vblank_put(dev, e->pipe);
   1357  1.1  riastrad 		send_vblank_event(dev, e, seq, &now);
   1358  1.1  riastrad 	}
   1359  1.1  riastrad 
   1360  1.1  riastrad 	spin_unlock_irqrestore(&dev->event_lock, flags);
   1361  1.1  riastrad 
   1362  1.1  riastrad 	trace_drm_vblank_event(crtc, seq);
   1363  1.1  riastrad }
   1364  1.1  riastrad 
   1365  1.1  riastrad /**
   1366  1.1  riastrad  * drm_handle_vblank - handle a vblank event
   1367  1.1  riastrad  * @dev: DRM device
   1368  1.1  riastrad  * @crtc: where this event occurred
   1369  1.1  riastrad  *
   1370  1.1  riastrad  * Drivers should call this routine in their vblank interrupt handlers to
   1371  1.1  riastrad  * update the vblank counter and send any signals that may be pending.
   1372  1.1  riastrad  */
   1373  1.1  riastrad bool drm_handle_vblank(struct drm_device *dev, int crtc)
   1374  1.1  riastrad {
   1375  1.1  riastrad 	u32 vblcount;
   1376  1.1  riastrad 	s64 diff_ns;
   1377  1.1  riastrad 	struct timeval tvblank;
   1378  1.1  riastrad 	unsigned long irqflags;
   1379  1.2  riastrad #ifdef __NetBSD__		/* XXX vblank locking */
   1380  1.2  riastrad 	unsigned long irqflags_vbl_lock;
   1381  1.2  riastrad #endif
   1382  1.1  riastrad 
   1383  1.1  riastrad 	if (!dev->num_crtcs)
   1384  1.1  riastrad 		return false;
   1385  1.1  riastrad 
   1386  1.2  riastrad #ifdef __NetBSD__		/* XXX vblank locking */
   1387  1.2  riastrad 	spin_lock_irqsave(&dev->vbl_lock, irqflags_vbl_lock);
   1388  1.2  riastrad #endif
   1389  1.2  riastrad 
   1390  1.1  riastrad 	/* Need timestamp lock to prevent concurrent execution with
   1391  1.1  riastrad 	 * vblank enable/disable, as this would cause inconsistent
   1392  1.1  riastrad 	 * or corrupted timestamps and vblank counts.
   1393  1.1  riastrad 	 */
   1394  1.1  riastrad 	spin_lock_irqsave(&dev->vblank_time_lock, irqflags);
   1395  1.1  riastrad 
   1396  1.1  riastrad 	/* Vblank irq handling disabled. Nothing to do. */
   1397  1.4  riastrad 	if (!dev->vblank[crtc].enabled) {
   1398  1.1  riastrad 		spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
   1399  1.2  riastrad #ifdef __NetBSD__		/* XXX vblank locking */
   1400  1.2  riastrad 		spin_unlock_irqrestore(&dev->vbl_lock, irqflags_vbl_lock);
   1401  1.2  riastrad #endif
   1402  1.1  riastrad 		return false;
   1403  1.1  riastrad 	}
   1404  1.1  riastrad 
   1405  1.1  riastrad 	/* Fetch corresponding timestamp for this vblank interval from
   1406  1.1  riastrad 	 * driver and store it in proper slot of timestamp ringbuffer.
   1407  1.1  riastrad 	 */
   1408  1.1  riastrad 
   1409  1.1  riastrad 	/* Get current timestamp and count. */
   1410  1.4  riastrad 	vblcount = atomic_read(&dev->vblank[crtc].count);
   1411  1.1  riastrad 	drm_get_last_vbltimestamp(dev, crtc, &tvblank, DRM_CALLED_FROM_VBLIRQ);
   1412  1.1  riastrad 
   1413  1.1  riastrad 	/* Compute time difference to timestamp of last vblank */
   1414  1.1  riastrad 	diff_ns = timeval_to_ns(&tvblank) -
   1415  1.1  riastrad 		  timeval_to_ns(&vblanktimestamp(dev, crtc, vblcount));
   1416  1.1  riastrad 
   1417  1.1  riastrad 	/* Update vblank timestamp and count if at least
   1418  1.1  riastrad 	 * DRM_REDUNDANT_VBLIRQ_THRESH_NS nanoseconds
   1419  1.1  riastrad 	 * difference between last stored timestamp and current
   1420  1.1  riastrad 	 * timestamp. A smaller difference means basically
   1421  1.1  riastrad 	 * identical timestamps. Happens if this vblank has
   1422  1.1  riastrad 	 * been already processed and this is a redundant call,
   1423  1.1  riastrad 	 * e.g., due to spurious vblank interrupts. We need to
   1424  1.1  riastrad 	 * ignore those for accounting.
   1425  1.1  riastrad 	 */
   1426  1.1  riastrad 	if (abs64(diff_ns) > DRM_REDUNDANT_VBLIRQ_THRESH_NS) {
   1427  1.1  riastrad 		/* Store new timestamp in ringbuffer. */
   1428  1.1  riastrad 		vblanktimestamp(dev, crtc, vblcount + 1) = tvblank;
   1429  1.1  riastrad 
   1430  1.1  riastrad 		/* Increment cooked vblank count. This also atomically commits
   1431  1.1  riastrad 		 * the timestamp computed above.
   1432  1.1  riastrad 		 */
   1433  1.1  riastrad 		smp_mb__before_atomic_inc();
   1434  1.4  riastrad 		atomic_inc(&dev->vblank[crtc].count);
   1435  1.1  riastrad 		smp_mb__after_atomic_inc();
   1436  1.1  riastrad 	} else {
   1437  1.1  riastrad 		DRM_DEBUG("crtc %d: Redundant vblirq ignored. diff_ns = %d\n",
   1438  1.1  riastrad 			  crtc, (int) diff_ns);
   1439  1.1  riastrad 	}
   1440  1.1  riastrad 
   1441  1.2  riastrad #ifdef __NetBSD__
   1442  1.4  riastrad 	DRM_SPIN_WAKEUP_ONE(&dev->vblank[crtc].queue, &dev->vbl_lock);
   1443  1.2  riastrad #else
   1444  1.4  riastrad 	wake_up(&dev->vblank[crtc].queue);
   1445  1.2  riastrad #endif
   1446  1.1  riastrad 	drm_handle_vblank_events(dev, crtc);
   1447  1.1  riastrad 
   1448  1.1  riastrad 	spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
   1449  1.2  riastrad #ifdef __NetBSD__		/* XXX vblank locking */
   1450  1.2  riastrad 	spin_unlock_irqrestore(&dev->vbl_lock, irqflags_vbl_lock);
   1451  1.2  riastrad #endif
   1452  1.1  riastrad 	return true;
   1453  1.1  riastrad }
   1454  1.1  riastrad EXPORT_SYMBOL(drm_handle_vblank);
   1455