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