xref: /onnv-gate/usr/src/uts/common/io/drm/drm_irq.c (revision 11260:eb8c6f2097e8)
12820Skz151634 /*
22820Skz151634  * drm_irq.c -- IRQ IOCTL and function support
32820Skz151634  * Created: Fri Oct 18 2003 by anholt@FreeBSD.org
42820Skz151634  */
52820Skz151634 /*
62820Skz151634  * Copyright 2003 Eric Anholt
7*11260SMiao.Chen@Sun.COM  * Copyright (c) 2009, Intel Corporation.
82820Skz151634  * All Rights Reserved.
92820Skz151634  *
102820Skz151634  * Permission is hereby granted, free of charge, to any person obtaining a
112820Skz151634  * copy of this software and associated documentation files (the "Software"),
122820Skz151634  * to deal in the Software without restriction, including without limitation
132820Skz151634  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
142820Skz151634  * and/or sell copies of the Software, and to permit persons to whom the
152820Skz151634  * Software is furnished to do so, subject to the following conditions:
162820Skz151634  *
172820Skz151634  * The above copyright notice and this permission notice (including the next
182820Skz151634  * paragraph) shall be included in all copies or substantial portions of the
192820Skz151634  * Software.
202820Skz151634  *
212820Skz151634  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
222820Skz151634  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
232820Skz151634  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
242820Skz151634  * ERIC ANHOLT BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
252820Skz151634  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
262820Skz151634  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
272820Skz151634  *
282820Skz151634  * Authors:
292820Skz151634  *    Eric Anholt <anholt@FreeBSD.org>
302820Skz151634  *
312820Skz151634  */
322820Skz151634 
334194Szw161486 /*
348832SMiao.Chen@Sun.COM  * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
354194Szw161486  * Use is subject to license terms.
364194Szw161486  */
374194Szw161486 
382820Skz151634 #include "drmP.h"
392820Skz151634 #include "drm.h"
405804Scg149915 #include "drm_io32.h"
412820Skz151634 
422820Skz151634 /*ARGSUSED*/
432820Skz151634 int
drm_irq_by_busid(DRM_IOCTL_ARGS)442820Skz151634 drm_irq_by_busid(DRM_IOCTL_ARGS)
452820Skz151634 {
462820Skz151634 	DRM_DEVICE;
472820Skz151634 	drm_irq_busid_t irq;
482820Skz151634 
495804Scg149915 	DRM_COPYFROM_WITH_RETURN(&irq, (void *)data, sizeof (irq));
502820Skz151634 
512820Skz151634 	if ((irq.busnum >> 8) != dev->pci_domain ||
522820Skz151634 	    (irq.busnum & 0xff) != dev->pci_bus ||
532820Skz151634 	    irq.devnum != dev->pci_slot ||
542820Skz151634 	    irq.funcnum != dev->pci_func)
555804Scg149915 		return (EINVAL);
562820Skz151634 
572820Skz151634 	irq.irq = dev->irq;
582820Skz151634 
598832SMiao.Chen@Sun.COM 	DRM_DEBUG("%d:%d:%d => IRQ %d\n",
608832SMiao.Chen@Sun.COM 	    irq.busnum, irq.devnum, irq.funcnum, irq.irq);
618832SMiao.Chen@Sun.COM 
625804Scg149915 	DRM_COPYTO_WITH_RETURN((void *)data, &irq, sizeof (irq));
632820Skz151634 
642820Skz151634 	return (0);
652820Skz151634 }
662820Skz151634 
675804Scg149915 
685804Scg149915 static irqreturn_t
drm_irq_handler_wrap(DRM_IRQ_ARGS)695804Scg149915 drm_irq_handler_wrap(DRM_IRQ_ARGS)
705804Scg149915 {
715804Scg149915 	drm_device_t *dev = (void *)arg;
725804Scg149915 	int	ret;
735804Scg149915 
745804Scg149915 	mutex_enter(&dev->irq_lock);
755804Scg149915 	ret = dev->driver->irq_handler(arg);
765804Scg149915 	mutex_exit(&dev->irq_lock);
775804Scg149915 
785804Scg149915 	return (ret);
795804Scg149915 }
805804Scg149915 
vblank_disable_fn(void * arg)818832SMiao.Chen@Sun.COM static void vblank_disable_fn(void *arg)
828832SMiao.Chen@Sun.COM {
838832SMiao.Chen@Sun.COM 	struct drm_device *dev = (struct drm_device *)arg;
848832SMiao.Chen@Sun.COM 	int i;
858832SMiao.Chen@Sun.COM 
869207SEdward.Shu@Sun.COM 	if (!dev->vblank_disable_allowed)
879207SEdward.Shu@Sun.COM 		return;
889207SEdward.Shu@Sun.COM 
898832SMiao.Chen@Sun.COM 	for (i = 0; i < dev->num_crtcs; i++) {
908832SMiao.Chen@Sun.COM 		if (atomic_read(&dev->vblank_refcount[i]) == 0 &&
918832SMiao.Chen@Sun.COM 		    atomic_read(&dev->vblank_enabled[i]) == 1) {
928832SMiao.Chen@Sun.COM 			dev->last_vblank[i] =
938832SMiao.Chen@Sun.COM 			    dev->driver->get_vblank_counter(dev, i);
948832SMiao.Chen@Sun.COM 			dev->driver->disable_vblank(dev, i);
958832SMiao.Chen@Sun.COM 			atomic_set(&dev->vblank_enabled[i], 0);
968832SMiao.Chen@Sun.COM 			DRM_DEBUG("disable vblank");
978832SMiao.Chen@Sun.COM 		}
988832SMiao.Chen@Sun.COM 	}
998832SMiao.Chen@Sun.COM }
1008832SMiao.Chen@Sun.COM 
1019207SEdward.Shu@Sun.COM void
drm_vblank_cleanup(struct drm_device * dev)1029207SEdward.Shu@Sun.COM drm_vblank_cleanup(struct drm_device *dev)
1038832SMiao.Chen@Sun.COM {
1049207SEdward.Shu@Sun.COM 
1058832SMiao.Chen@Sun.COM 	/* Bail if the driver didn't call drm_vblank_init() */
1068832SMiao.Chen@Sun.COM 	if (dev->num_crtcs == 0)
1078832SMiao.Chen@Sun.COM 		return;
1088832SMiao.Chen@Sun.COM 
1098832SMiao.Chen@Sun.COM 	vblank_disable_fn((void *)dev);
1108832SMiao.Chen@Sun.COM 
1118832SMiao.Chen@Sun.COM 	drm_free(dev->vbl_queues, sizeof (wait_queue_head_t) * dev->num_crtcs,
1128832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1138832SMiao.Chen@Sun.COM 	drm_free(dev->vbl_sigs, sizeof (struct drm_vbl_sig) * dev->num_crtcs,
1148832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1158832SMiao.Chen@Sun.COM 	drm_free(dev->_vblank_count, sizeof (atomic_t) *
1168832SMiao.Chen@Sun.COM 	    dev->num_crtcs, DRM_MEM_DRIVER);
1178832SMiao.Chen@Sun.COM 	drm_free(dev->vblank_refcount, sizeof (atomic_t) *
1188832SMiao.Chen@Sun.COM 	    dev->num_crtcs, DRM_MEM_DRIVER);
1198832SMiao.Chen@Sun.COM 	drm_free(dev->vblank_enabled, sizeof (int) *
1208832SMiao.Chen@Sun.COM 	    dev->num_crtcs, DRM_MEM_DRIVER);
1218832SMiao.Chen@Sun.COM 	drm_free(dev->last_vblank, sizeof (u32) * dev->num_crtcs,
1228832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
123*11260SMiao.Chen@Sun.COM 	drm_free(dev->vblank_inmodeset, sizeof (*dev->vblank_inmodeset) *
124*11260SMiao.Chen@Sun.COM 	    dev->num_crtcs, DRM_MEM_DRIVER);
1258832SMiao.Chen@Sun.COM 	dev->num_crtcs = 0;
1268832SMiao.Chen@Sun.COM }
1278832SMiao.Chen@Sun.COM 
1288832SMiao.Chen@Sun.COM int
drm_vblank_init(struct drm_device * dev,int num_crtcs)1298832SMiao.Chen@Sun.COM drm_vblank_init(struct drm_device *dev, int num_crtcs)
1308832SMiao.Chen@Sun.COM {
1318832SMiao.Chen@Sun.COM 	int i, ret = ENOMEM;
1328832SMiao.Chen@Sun.COM 
1338832SMiao.Chen@Sun.COM 	atomic_set(&dev->vbl_signal_pending, 0);
1348832SMiao.Chen@Sun.COM 	dev->num_crtcs = num_crtcs;
1358832SMiao.Chen@Sun.COM 
1368832SMiao.Chen@Sun.COM 
1378832SMiao.Chen@Sun.COM 	dev->vbl_queues = drm_alloc(sizeof (wait_queue_head_t) * num_crtcs,
1388832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1398832SMiao.Chen@Sun.COM 	if (!dev->vbl_queues)
1408832SMiao.Chen@Sun.COM 		goto err;
1418832SMiao.Chen@Sun.COM 
1428832SMiao.Chen@Sun.COM 	dev->vbl_sigs = drm_alloc(sizeof (struct drm_vbl_sig) * num_crtcs,
1438832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1448832SMiao.Chen@Sun.COM 	if (!dev->vbl_sigs)
1458832SMiao.Chen@Sun.COM 		goto err;
1468832SMiao.Chen@Sun.COM 
1478832SMiao.Chen@Sun.COM 	dev->_vblank_count = drm_alloc(sizeof (atomic_t) * num_crtcs,
1488832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1498832SMiao.Chen@Sun.COM 	if (!dev->_vblank_count)
1508832SMiao.Chen@Sun.COM 		goto err;
1518832SMiao.Chen@Sun.COM 
1528832SMiao.Chen@Sun.COM 	dev->vblank_refcount = drm_alloc(sizeof (atomic_t) * num_crtcs,
1538832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1548832SMiao.Chen@Sun.COM 	if (!dev->vblank_refcount)
1558832SMiao.Chen@Sun.COM 		goto err;
1568832SMiao.Chen@Sun.COM 
1578832SMiao.Chen@Sun.COM 	dev->vblank_enabled = drm_alloc(num_crtcs * sizeof (int),
1588832SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
1598832SMiao.Chen@Sun.COM 	if (!dev->vblank_enabled)
1608832SMiao.Chen@Sun.COM 		goto err;
1618832SMiao.Chen@Sun.COM 
1628832SMiao.Chen@Sun.COM 	dev->last_vblank = drm_alloc(num_crtcs * sizeof (u32), DRM_MEM_DRIVER);
1638832SMiao.Chen@Sun.COM 	if (!dev->last_vblank)
1648832SMiao.Chen@Sun.COM 		goto err;
165*11260SMiao.Chen@Sun.COM 
166*11260SMiao.Chen@Sun.COM 	dev->vblank_inmodeset = drm_alloc(num_crtcs * sizeof (int),
167*11260SMiao.Chen@Sun.COM 	    DRM_MEM_DRIVER);
168*11260SMiao.Chen@Sun.COM 	if (!dev->vblank_inmodeset)
169*11260SMiao.Chen@Sun.COM 		goto err;
170*11260SMiao.Chen@Sun.COM 
1718832SMiao.Chen@Sun.COM 	/* Zero per-crtc vblank stuff */
1728832SMiao.Chen@Sun.COM 	for (i = 0; i < num_crtcs; i++) {
1738832SMiao.Chen@Sun.COM 		DRM_INIT_WAITQUEUE(&dev->vbl_queues[i], DRM_INTR_PRI(dev));
1748832SMiao.Chen@Sun.COM 		TAILQ_INIT(&dev->vbl_sigs[i]);
1758832SMiao.Chen@Sun.COM 		atomic_set(&dev->_vblank_count[i], 0);
1768832SMiao.Chen@Sun.COM 		atomic_set(&dev->vblank_refcount[i], 0);
1778832SMiao.Chen@Sun.COM 	}
1789207SEdward.Shu@Sun.COM 
1799207SEdward.Shu@Sun.COM 	dev->vblank_disable_allowed = 1;
1808832SMiao.Chen@Sun.COM 	return (0);
1818832SMiao.Chen@Sun.COM 
1828832SMiao.Chen@Sun.COM err:
1838832SMiao.Chen@Sun.COM 	DRM_ERROR("drm_vblank_init: alloc error");
1848832SMiao.Chen@Sun.COM 	drm_vblank_cleanup(dev);
1858832SMiao.Chen@Sun.COM 	return (ret);
1868832SMiao.Chen@Sun.COM }
1875804Scg149915 
1882820Skz151634 /*ARGSUSED*/
1892820Skz151634 static int
drm_install_irq_handle(drm_device_t * dev)1905804Scg149915 drm_install_irq_handle(drm_device_t *dev)
1912820Skz151634 {
1925804Scg149915 	dev_info_t *dip = dev->dip;
1932820Skz151634 
1942820Skz151634 	if (dip == NULL) {
1952820Skz151634 		DRM_ERROR("drm_install_irq_handle: cannot get vgatext's dip");
1962820Skz151634 		return (DDI_FAILURE);
1972820Skz151634 	}
1982820Skz151634 
1992820Skz151634 	if (ddi_intr_hilevel(dip, 0) != 0) {
2002820Skz151634 		DRM_ERROR("drm_install_irq_handle: "
2015804Scg149915 		    "high-level interrupts are not supported");
2022820Skz151634 		return (DDI_FAILURE);
2032820Skz151634 	}
2042820Skz151634 
2052820Skz151634 	if (ddi_get_iblock_cookie(dip, (uint_t)0,
2062820Skz151634 	    &dev->intr_block) != DDI_SUCCESS) {
2072820Skz151634 		DRM_ERROR("drm_install_irq_handle: cannot get iblock cookie");
2082820Skz151634 		return (DDI_FAILURE);
2092820Skz151634 	}
2102820Skz151634 
2112820Skz151634 	/* setup the interrupt handler */
2122820Skz151634 	if (ddi_add_intr(dip, 0, &dev->intr_block,
2135804Scg149915 	    (ddi_idevice_cookie_t *)NULL, drm_irq_handler_wrap,
2145804Scg149915 	    (caddr_t)dev) != DDI_SUCCESS) {
2152820Skz151634 		DRM_ERROR("drm_install_irq_handle: ddi_add_intr failed");
2162820Skz151634 		return (DDI_FAILURE);
2172820Skz151634 	}
2182820Skz151634 
2192820Skz151634 	return (DDI_SUCCESS);
2202820Skz151634 }
2212820Skz151634 
2222820Skz151634 /*ARGSUSED*/
2232820Skz151634 int
drm_irq_install(drm_device_t * dev)2245804Scg149915 drm_irq_install(drm_device_t *dev)
2252820Skz151634 {
2262820Skz151634 	int ret;
2272820Skz151634 
2282820Skz151634 	if (dev->dev_private == NULL) {
2292820Skz151634 		DRM_ERROR("drm_irq_install: dev_private is NULL");
2305804Scg149915 		return (EINVAL);
2312820Skz151634 	}
2322820Skz151634 
2332820Skz151634 	if (dev->irq_enabled) {
2342820Skz151634 		DRM_ERROR("drm_irq_install: irq already enabled");
2355804Scg149915 		return (EBUSY);
2362820Skz151634 	}
2378959SMiao.Chen@Sun.COM 
2388832SMiao.Chen@Sun.COM 	DRM_DEBUG("drm_irq_install irq=%d\n", dev->irq);
2395804Scg149915 
2402820Skz151634 	/* before installing handler */
2418959SMiao.Chen@Sun.COM 	ret = dev->driver->irq_preinstall(dev);
2428959SMiao.Chen@Sun.COM 	if (ret)
2438959SMiao.Chen@Sun.COM 		return (EINVAL);
2442820Skz151634 
2452820Skz151634 	/* install handler */
2462820Skz151634 	ret  = drm_install_irq_handle(dev);
2472820Skz151634 	if (ret != DDI_SUCCESS) {
2482820Skz151634 		DRM_ERROR("drm_irq_install: drm_install_irq_handle failed");
2492820Skz151634 		return (ret);
2502820Skz151634 	}
2512820Skz151634 
2522820Skz151634 	/* after installing handler */
2535804Scg149915 	dev->driver->irq_postinstall(dev);
2542820Skz151634 
2558959SMiao.Chen@Sun.COM 	dev->irq_enabled = 1;
2568959SMiao.Chen@Sun.COM 	dev->context_flag = 0;
2578959SMiao.Chen@Sun.COM 
2585804Scg149915 	return (0);
2592820Skz151634 }
2602820Skz151634 
2612820Skz151634 static void
drm_uninstall_irq_handle(drm_device_t * dev)2622820Skz151634 drm_uninstall_irq_handle(drm_device_t *dev)
2632820Skz151634 {
2642820Skz151634 	ASSERT(dev->dip);
2652820Skz151634 	ddi_remove_intr(dev->dip, 0, dev->intr_block);
2662820Skz151634 }
2672820Skz151634 
2682820Skz151634 
2692820Skz151634 /*ARGSUSED*/
2702820Skz151634 int
drm_irq_uninstall(drm_device_t * dev)2715804Scg149915 drm_irq_uninstall(drm_device_t *dev)
2722820Skz151634 {
2739207SEdward.Shu@Sun.COM 	int i;
2744194Szw161486 	if (!dev->irq_enabled) {
2755804Scg149915 		return (EINVAL);
2764194Szw161486 	}
2772820Skz151634 	dev->irq_enabled = 0;
2789207SEdward.Shu@Sun.COM 
2799207SEdward.Shu@Sun.COM 	/*
2809207SEdward.Shu@Sun.COM 	 * Wake up any waiters so they don't hang.
2819207SEdward.Shu@Sun.COM 	 */
2829207SEdward.Shu@Sun.COM 	DRM_SPINLOCK(&dev->vbl_lock);
2839207SEdward.Shu@Sun.COM 	for (i = 0; i < dev->num_crtcs; i++) {
2849207SEdward.Shu@Sun.COM 		DRM_WAKEUP(&dev->vbl_queues[i]);
2859207SEdward.Shu@Sun.COM 		dev->vblank_enabled[i] = 0;
2869207SEdward.Shu@Sun.COM 	}
2879207SEdward.Shu@Sun.COM 	DRM_SPINUNLOCK(&dev->vbl_lock);
2889207SEdward.Shu@Sun.COM 
2895804Scg149915 	dev->driver->irq_uninstall(dev);
2902820Skz151634 	drm_uninstall_irq_handle(dev);
2914194Szw161486 	dev->locked_tasklet_func = NULL;
2928832SMiao.Chen@Sun.COM 
2932820Skz151634 	return (DDI_SUCCESS);
2942820Skz151634 }
2952820Skz151634 
2962820Skz151634 /*ARGSUSED*/
2972820Skz151634 int
drm_control(DRM_IOCTL_ARGS)2982820Skz151634 drm_control(DRM_IOCTL_ARGS)
2992820Skz151634 {
3002820Skz151634 	DRM_DEVICE;
3012820Skz151634 	drm_control_t ctl;
3022820Skz151634 	int err;
3032820Skz151634 
3045804Scg149915 	DRM_COPYFROM_WITH_RETURN(&ctl, (void *)data, sizeof (ctl));
3052820Skz151634 
3062820Skz151634 	switch (ctl.func) {
3072820Skz151634 	case DRM_INST_HANDLER:
3082820Skz151634 		/*
3092820Skz151634 		 * Handle drivers whose DRM used to require IRQ setup but the
3102820Skz151634 		 * no longer does.
3112820Skz151634 		 */
3122820Skz151634 		return (drm_irq_install(dev));
3132820Skz151634 	case DRM_UNINST_HANDLER:
3142820Skz151634 		err = drm_irq_uninstall(dev);
3152820Skz151634 		return (err);
3162820Skz151634 	default:
3175804Scg149915 		return (EINVAL);
3182820Skz151634 	}
3192820Skz151634 }
3202820Skz151634 
3218832SMiao.Chen@Sun.COM u32
drm_vblank_count(struct drm_device * dev,int crtc)3228832SMiao.Chen@Sun.COM drm_vblank_count(struct drm_device *dev, int crtc)
3238832SMiao.Chen@Sun.COM {
3248832SMiao.Chen@Sun.COM 	return (atomic_read(&dev->_vblank_count[crtc]));
3258832SMiao.Chen@Sun.COM }
3268832SMiao.Chen@Sun.COM 
drm_update_vblank_count(struct drm_device * dev,int crtc)3278832SMiao.Chen@Sun.COM static void drm_update_vblank_count(struct drm_device *dev, int crtc)
3288832SMiao.Chen@Sun.COM {
3298832SMiao.Chen@Sun.COM 	u32 cur_vblank, diff;
3308832SMiao.Chen@Sun.COM 	/*
3318832SMiao.Chen@Sun.COM 	 * Interrupts were disabled prior to this call, so deal with counter
3328832SMiao.Chen@Sun.COM 	 * wrap if needed.
3338832SMiao.Chen@Sun.COM 	 * NOTE!  It's possible we lost a full dev->max_vblank_count events
3348832SMiao.Chen@Sun.COM 	 * here if the register is small or we had vblank interrupts off for
3358832SMiao.Chen@Sun.COM 	 * a long time.
3368832SMiao.Chen@Sun.COM 	 */
3378832SMiao.Chen@Sun.COM 	cur_vblank = dev->driver->get_vblank_counter(dev, crtc);
3388832SMiao.Chen@Sun.COM 	diff = cur_vblank - dev->last_vblank[crtc];
3398832SMiao.Chen@Sun.COM 	if (cur_vblank < dev->last_vblank[crtc]) {
3408832SMiao.Chen@Sun.COM 		diff += dev->max_vblank_count;
3418832SMiao.Chen@Sun.COM 	DRM_DEBUG("last_vblank[%d]=0x%x, cur_vblank=0x%x => diff=0x%x\n",
3428832SMiao.Chen@Sun.COM 	    crtc, dev->last_vblank[crtc], cur_vblank, diff);
3438832SMiao.Chen@Sun.COM 	}
3448832SMiao.Chen@Sun.COM 
3458832SMiao.Chen@Sun.COM 	atomic_add(diff, &dev->_vblank_count[crtc]);
3468832SMiao.Chen@Sun.COM }
3478832SMiao.Chen@Sun.COM 
3488832SMiao.Chen@Sun.COM static timeout_id_t timer_id = NULL;
3498832SMiao.Chen@Sun.COM 
3508832SMiao.Chen@Sun.COM int
drm_vblank_get(struct drm_device * dev,int crtc)3518832SMiao.Chen@Sun.COM drm_vblank_get(struct drm_device *dev, int crtc)
3528832SMiao.Chen@Sun.COM {
3538832SMiao.Chen@Sun.COM 	int ret = 0;
3548832SMiao.Chen@Sun.COM 
3558832SMiao.Chen@Sun.COM 	DRM_SPINLOCK(&dev->vbl_lock);
3568832SMiao.Chen@Sun.COM 
3578832SMiao.Chen@Sun.COM 	if (timer_id != NULL) {
3588832SMiao.Chen@Sun.COM 		(void) untimeout(timer_id);
3598832SMiao.Chen@Sun.COM 		timer_id = NULL;
3608832SMiao.Chen@Sun.COM 	}
3618832SMiao.Chen@Sun.COM 
3628832SMiao.Chen@Sun.COM 	/* Going from 0->1 means we have to enable interrupts again */
3638832SMiao.Chen@Sun.COM 	atomic_add(1, &dev->vblank_refcount[crtc]);
3648832SMiao.Chen@Sun.COM 	if (dev->vblank_refcount[crtc] == 1 &&
3658832SMiao.Chen@Sun.COM 	    atomic_read(&dev->vblank_enabled[crtc]) == 0) {
3668832SMiao.Chen@Sun.COM 		ret = dev->driver->enable_vblank(dev, crtc);
3678832SMiao.Chen@Sun.COM 		if (ret)
3688832SMiao.Chen@Sun.COM 			atomic_dec(&dev->vblank_refcount[crtc]);
3698832SMiao.Chen@Sun.COM 		else {
3708832SMiao.Chen@Sun.COM 			atomic_set(&dev->vblank_enabled[crtc], 1);
3718832SMiao.Chen@Sun.COM 			drm_update_vblank_count(dev, crtc);
3728832SMiao.Chen@Sun.COM 		}
3738832SMiao.Chen@Sun.COM 	}
3748832SMiao.Chen@Sun.COM 	DRM_SPINUNLOCK(&dev->vbl_lock);
3758832SMiao.Chen@Sun.COM 
3768832SMiao.Chen@Sun.COM 	return (ret);
3778832SMiao.Chen@Sun.COM }
3788832SMiao.Chen@Sun.COM 
3798832SMiao.Chen@Sun.COM void
drm_vblank_put(struct drm_device * dev,int crtc)3808832SMiao.Chen@Sun.COM drm_vblank_put(struct drm_device *dev, int crtc)
3818832SMiao.Chen@Sun.COM {
3828832SMiao.Chen@Sun.COM 	DRM_SPINLOCK(&dev->vbl_lock);
3838832SMiao.Chen@Sun.COM 	/* Last user schedules interrupt disable */
3848832SMiao.Chen@Sun.COM 	atomic_dec(&dev->vblank_refcount[crtc]);
3858832SMiao.Chen@Sun.COM 
3868832SMiao.Chen@Sun.COM 	if (dev->vblank_refcount[crtc] == 0)
3878832SMiao.Chen@Sun.COM 		timer_id = timeout(vblank_disable_fn, (void *) dev, 5*DRM_HZ);
3888832SMiao.Chen@Sun.COM 
3898832SMiao.Chen@Sun.COM 	DRM_SPINUNLOCK(&dev->vbl_lock);
3908832SMiao.Chen@Sun.COM }
3918832SMiao.Chen@Sun.COM 
392*11260SMiao.Chen@Sun.COM /*
393*11260SMiao.Chen@Sun.COM  * drm_modeset_ctl - handle vblank event counter changes across mode switch
394*11260SMiao.Chen@Sun.COM  * @DRM_IOCTL_ARGS: standard ioctl arguments
395*11260SMiao.Chen@Sun.COM  *
396*11260SMiao.Chen@Sun.COM  * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET
397*11260SMiao.Chen@Sun.COM  * ioctls around modesetting so that any lost vblank events are accounted for.
398*11260SMiao.Chen@Sun.COM  *
399*11260SMiao.Chen@Sun.COM  * Generally the counter will reset across mode sets.  If interrupts are
400*11260SMiao.Chen@Sun.COM  * enabled around this call, we don't have to do anything since the counter
401*11260SMiao.Chen@Sun.COM  * will have already been incremented.
402*11260SMiao.Chen@Sun.COM  */
403*11260SMiao.Chen@Sun.COM /*ARGSUSED*/
404*11260SMiao.Chen@Sun.COM int
drm_modeset_ctl(DRM_IOCTL_ARGS)405*11260SMiao.Chen@Sun.COM drm_modeset_ctl(DRM_IOCTL_ARGS)
406*11260SMiao.Chen@Sun.COM {
407*11260SMiao.Chen@Sun.COM 	DRM_DEVICE;
408*11260SMiao.Chen@Sun.COM 	struct drm_modeset_ctl modeset;
409*11260SMiao.Chen@Sun.COM 	int crtc, ret = 0;
410*11260SMiao.Chen@Sun.COM 
411*11260SMiao.Chen@Sun.COM 	/* If drm_vblank_init() hasn't been called yet, just no-op */
412*11260SMiao.Chen@Sun.COM 	if (!dev->num_crtcs)
413*11260SMiao.Chen@Sun.COM 		goto out;
414*11260SMiao.Chen@Sun.COM 
415*11260SMiao.Chen@Sun.COM 	DRM_COPYFROM_WITH_RETURN(&modeset, (void *)data,
416*11260SMiao.Chen@Sun.COM 	    sizeof (modeset));
417*11260SMiao.Chen@Sun.COM 
418*11260SMiao.Chen@Sun.COM 	crtc = modeset.crtc;
419*11260SMiao.Chen@Sun.COM 	if (crtc >= dev->num_crtcs) {
420*11260SMiao.Chen@Sun.COM 		ret = -EINVAL;
421*11260SMiao.Chen@Sun.COM 		goto out;
422*11260SMiao.Chen@Sun.COM 	}
423*11260SMiao.Chen@Sun.COM 
424*11260SMiao.Chen@Sun.COM 	/*
425*11260SMiao.Chen@Sun.COM 	 * To avoid all the problems that might happen if interrupts
426*11260SMiao.Chen@Sun.COM 	 * were enabled/disabled around or between these calls, we just
427*11260SMiao.Chen@Sun.COM 	 * have the kernel take a reference on the CRTC (just once though
428*11260SMiao.Chen@Sun.COM 	 * to avoid corrupting the count if multiple, mismatch calls occur),
429*11260SMiao.Chen@Sun.COM 	 * so that interrupts remain enabled in the interim.
430*11260SMiao.Chen@Sun.COM 	 */
431*11260SMiao.Chen@Sun.COM 	switch (modeset.cmd) {
432*11260SMiao.Chen@Sun.COM 	case _DRM_PRE_MODESET:
433*11260SMiao.Chen@Sun.COM 		if (!dev->vblank_inmodeset[crtc]) {
434*11260SMiao.Chen@Sun.COM 			dev->vblank_inmodeset[crtc] = 1;
435*11260SMiao.Chen@Sun.COM 			ret = drm_vblank_get(dev, crtc);
436*11260SMiao.Chen@Sun.COM 		}
437*11260SMiao.Chen@Sun.COM 		break;
438*11260SMiao.Chen@Sun.COM 	case _DRM_POST_MODESET:
439*11260SMiao.Chen@Sun.COM 		if (dev->vblank_inmodeset[crtc]) {
440*11260SMiao.Chen@Sun.COM 			DRM_SPINLOCK(&dev->vbl_lock);
441*11260SMiao.Chen@Sun.COM 			dev->vblank_disable_allowed = 1;
442*11260SMiao.Chen@Sun.COM 			dev->vblank_inmodeset[crtc] = 0;
443*11260SMiao.Chen@Sun.COM 			DRM_SPINUNLOCK(&dev->vbl_lock);
444*11260SMiao.Chen@Sun.COM 			drm_vblank_put(dev, crtc);
445*11260SMiao.Chen@Sun.COM 		}
446*11260SMiao.Chen@Sun.COM 		break;
447*11260SMiao.Chen@Sun.COM 	default:
448*11260SMiao.Chen@Sun.COM 		ret = -EINVAL;
449*11260SMiao.Chen@Sun.COM 		break;
450*11260SMiao.Chen@Sun.COM 	}
451*11260SMiao.Chen@Sun.COM 
452*11260SMiao.Chen@Sun.COM out:
453*11260SMiao.Chen@Sun.COM 	return (ret);
454*11260SMiao.Chen@Sun.COM }
455*11260SMiao.Chen@Sun.COM 
4562820Skz151634 /*ARGSUSED*/
4572820Skz151634 int
drm_wait_vblank(DRM_IOCTL_ARGS)4582820Skz151634 drm_wait_vblank(DRM_IOCTL_ARGS)
4592820Skz151634 {
4605804Scg149915 	DRM_DEVICE;
4615804Scg149915 	drm_wait_vblank_t vblwait;
4628832SMiao.Chen@Sun.COM 	int ret, flags, crtc;
4635804Scg149915 	unsigned int	sequence;
4645804Scg149915 
4658832SMiao.Chen@Sun.COM 	if (!dev->irq_enabled) {
466*11260SMiao.Chen@Sun.COM 		DRM_ERROR("wait vblank, EINVAL");
4675804Scg149915 		return (EINVAL);
4688832SMiao.Chen@Sun.COM 	}
4695804Scg149915 #ifdef _MULTI_DATAMODEL
4705804Scg149915 	if (ddi_model_convert_from(mode & FMODELS) == DDI_MODEL_ILP32) {
4715804Scg149915 		drm_wait_vblank_32_t vblwait32;
4725804Scg149915 		DRM_COPYFROM_WITH_RETURN(&vblwait32, (void *)data,
4735804Scg149915 		    sizeof (vblwait32));
4745804Scg149915 		vblwait.request.type = vblwait32.request.type;
4755804Scg149915 		vblwait.request.sequence = vblwait32.request.sequence;
4765804Scg149915 		vblwait.request.signal = vblwait32.request.signal;
4775804Scg149915 	} else {
4785804Scg149915 #endif
4795804Scg149915 		DRM_COPYFROM_WITH_RETURN(&vblwait, (void *)data,
4805804Scg149915 		    sizeof (vblwait));
4815804Scg149915 #ifdef _MULTI_DATAMODEL
4825804Scg149915 	}
4835804Scg149915 #endif
4845804Scg149915 
4855804Scg149915 	if (vblwait.request.type &
4865804Scg149915 	    ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK)) {
487*11260SMiao.Chen@Sun.COM 		DRM_ERROR("drm_wait_vblank: wrong request type 0x%x",
4885804Scg149915 		    vblwait.request.type);
4895804Scg149915 		return (EINVAL);
4905804Scg149915 	}
4915804Scg149915 
4925804Scg149915 	flags = vblwait.request.type & _DRM_VBLANK_FLAGS_MASK;
4938832SMiao.Chen@Sun.COM 	crtc = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
494*11260SMiao.Chen@Sun.COM 	if (crtc >= dev->num_crtcs) {
495*11260SMiao.Chen@Sun.COM 		DRM_ERROR("wait vblank operation not support");
4968832SMiao.Chen@Sun.COM 		return (ENOTSUP);
497*11260SMiao.Chen@Sun.COM 	}
4988832SMiao.Chen@Sun.COM 	ret = drm_vblank_get(dev, crtc);
4998832SMiao.Chen@Sun.COM 	if (ret) {
500*11260SMiao.Chen@Sun.COM 		DRM_ERROR("can't get drm vblank %d", ret);
5018832SMiao.Chen@Sun.COM 		return (ret);
5025804Scg149915 	}
5038832SMiao.Chen@Sun.COM 	sequence = drm_vblank_count(dev, crtc);
5045804Scg149915 
5058832SMiao.Chen@Sun.COM 	switch (vblwait.request.type & _DRM_VBLANK_TYPES_MASK) {
5068832SMiao.Chen@Sun.COM 	case _DRM_VBLANK_RELATIVE:
5075804Scg149915 		vblwait.request.sequence += sequence;
5085804Scg149915 		vblwait.request.type &= ~_DRM_VBLANK_RELATIVE;
5098832SMiao.Chen@Sun.COM 		/*FALLTHROUGH*/
5108832SMiao.Chen@Sun.COM 	case _DRM_VBLANK_ABSOLUTE:
5118832SMiao.Chen@Sun.COM 		break;
5128832SMiao.Chen@Sun.COM 	default:
5138832SMiao.Chen@Sun.COM 		DRM_DEBUG("wait vblank return EINVAL");
5145804Scg149915 		return (EINVAL);
5155804Scg149915 	}
5165804Scg149915 
5175804Scg149915 	if ((flags & _DRM_VBLANK_NEXTONMISS) &&
5185804Scg149915 	    (sequence - vblwait.request.sequence) <= (1<<23)) {
5195804Scg149915 		vblwait.request.sequence = sequence + 1;
5205804Scg149915 	}
5215804Scg149915 
5225804Scg149915 	if (flags & _DRM_VBLANK_SIGNAL) {
5235804Scg149915 		/*
5245804Scg149915 		 * Don't block process, send signal when vblank interrupt
5255804Scg149915 		 */
526*11260SMiao.Chen@Sun.COM 		DRM_ERROR("NOT SUPPORT YET, SHOULD BE ADDED");
5275804Scg149915 		cmn_err(CE_WARN, "NOT SUPPORT YET, SHOULD BE ADDED");
5285804Scg149915 		ret = EINVAL;
5298832SMiao.Chen@Sun.COM 		goto done;
5305804Scg149915 	} else {
5315804Scg149915 		/* block until vblank interupt */
5328832SMiao.Chen@Sun.COM 		/* shared code returns -errno */
5338832SMiao.Chen@Sun.COM 		DRM_WAIT_ON(ret, &dev->vbl_queues[crtc], 3 * DRM_HZ,
534*11260SMiao.Chen@Sun.COM 		    (((drm_vblank_count(dev, crtc)
535*11260SMiao.Chen@Sun.COM 		    - vblwait.request.sequence) <= (1 << 23)) ||
536*11260SMiao.Chen@Sun.COM 		    !dev->irq_enabled));
5378832SMiao.Chen@Sun.COM 		if (ret != EINTR) {
5388832SMiao.Chen@Sun.COM 			struct timeval now;
5398832SMiao.Chen@Sun.COM 			(void) uniqtime(&now);
5408832SMiao.Chen@Sun.COM 			vblwait.reply.tval_sec = now.tv_sec;
5418832SMiao.Chen@Sun.COM 			vblwait.reply.tval_usec = now.tv_usec;
5428832SMiao.Chen@Sun.COM 			vblwait.reply.sequence = drm_vblank_count(dev, crtc);
5435804Scg149915 		}
5445804Scg149915 	}
5455804Scg149915 
5468832SMiao.Chen@Sun.COM done:
5475804Scg149915 #ifdef _MULTI_DATAMODEL
5485804Scg149915 	if (ddi_model_convert_from(mode & FMODELS) == DDI_MODEL_ILP32) {
5495804Scg149915 		drm_wait_vblank_32_t vblwait32;
5505804Scg149915 		vblwait32.reply.type = vblwait.reply.type;
5515804Scg149915 		vblwait32.reply.sequence = vblwait.reply.sequence;
5528832SMiao.Chen@Sun.COM 		vblwait32.reply.tval_sec = (int32_t)vblwait.reply.tval_sec;
5538832SMiao.Chen@Sun.COM 		vblwait32.reply.tval_usec = (int32_t)vblwait.reply.tval_usec;
5545804Scg149915 		DRM_COPYTO_WITH_RETURN((void *)data, &vblwait32,
5555804Scg149915 		    sizeof (vblwait32));
5565804Scg149915 	} else {
5575804Scg149915 #endif
5585804Scg149915 		DRM_COPYTO_WITH_RETURN((void *)data, &vblwait,
5595804Scg149915 		    sizeof (vblwait));
5605804Scg149915 #ifdef _MULTI_DATAMODEL
5615804Scg149915 	}
5625804Scg149915 #endif
5638832SMiao.Chen@Sun.COM 
5648832SMiao.Chen@Sun.COM 	drm_vblank_put(dev, crtc);
5655804Scg149915 	return (ret);
5662820Skz151634 }
5674194Szw161486 
5685804Scg149915 
5694194Szw161486 /*ARGSUSED*/
5704194Szw161486 void
drm_vbl_send_signals(drm_device_t * dev)5714194Szw161486 drm_vbl_send_signals(drm_device_t *dev)
5724194Szw161486 {
5738832SMiao.Chen@Sun.COM 	DRM_DEBUG("drm_vbl_send_signals");
5748832SMiao.Chen@Sun.COM }
5755804Scg149915 
5768832SMiao.Chen@Sun.COM void
drm_handle_vblank(struct drm_device * dev,int crtc)5778832SMiao.Chen@Sun.COM drm_handle_vblank(struct drm_device *dev, int crtc)
5788832SMiao.Chen@Sun.COM {
5798832SMiao.Chen@Sun.COM 	atomic_inc(&dev->_vblank_count[crtc]);
5808832SMiao.Chen@Sun.COM 	DRM_WAKEUP(&dev->vbl_queues[crtc]);
5814194Szw161486 }
582