2 * Copyright 2003 Eric Anholt
5 * Permission is hereby granted, free of charge, to any person obtaining a
6 * copy of this software and associated documentation files (the "Software"),
7 * to deal in the Software without restriction, including without limitation
8 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
9 * and/or sell copies of the Software, and to permit persons to whom the
10 * Software is furnished to do so, subject to the following conditions:
12 * The above copyright notice and this permission notice (including the next
13 * paragraph) shall be included in all copies or substantial portions of the
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * ERIC ANHOLT BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
20 * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
21 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
24 * Eric Anholt <anholt@FreeBSD.org>
29 * Support code for handling setup/teardown of interrupt handlers and
30 * handing interrupt handlers off to the drivers.
33 #include "dev/drm/drmP.h"
34 #include "dev/drm/drm.h"
36 int drm_irq_by_busid(struct drm_device *dev, void *data,
37 struct drm_file *file_priv)
39 struct drm_irq_busid *irq = data;
41 if ((irq->busnum >> 8) != dev->pci_domain ||
42 (irq->busnum & 0xff) != dev->pci_bus ||
43 irq->devnum != dev->pci_slot ||
44 irq->funcnum != dev->pci_func)
49 DRM_DEBUG("%d:%d:%d => IRQ %d\n",
50 irq->busnum, irq->devnum, irq->funcnum, irq->irq);
55 static void vblank_disable_fn(void *arg)
57 struct drm_device *dev = (struct drm_device *)arg;
60 DRM_SPINLOCK(&dev->vbl_lock);
62 if (callout_pending(&dev->vblank_disable_timer)) {
63 /* callout was reset */
64 DRM_SPINUNLOCK(&dev->vbl_lock);
67 if (!callout_active(&dev->vblank_disable_timer)) {
68 /* callout was stopped */
69 DRM_SPINUNLOCK(&dev->vbl_lock);
72 callout_deactivate(&dev->vblank_disable_timer);
74 DRM_DEBUG("vblank_disable: %s\n", dev->vblank_disable_allowed ?
75 "allowed" : "denied");
76 if (!dev->vblank_disable_allowed) {
77 DRM_SPINUNLOCK(&dev->vbl_lock);
81 for (i = 0; i < dev->num_crtcs; i++) {
82 if (atomic_read(&dev->vblank[i].refcount) == 0 &&
83 dev->vblank[i].enabled && !dev->vblank[i].inmodeset) {
84 DRM_DEBUG("disabling vblank on crtc %d\n", i);
86 dev->driver->get_vblank_counter(dev, i);
87 dev->driver->disable_vblank(dev, i);
88 dev->vblank[i].enabled = 0;
91 DRM_SPINUNLOCK(&dev->vbl_lock);
94 void drm_vblank_cleanup(struct drm_device *dev)
96 /* Bail if the driver didn't call drm_vblank_init() */
97 if (dev->num_crtcs == 0)
100 DRM_SPINLOCK(&dev->vbl_lock);
101 callout_stop(&dev->vblank_disable_timer);
102 DRM_SPINUNLOCK(&dev->vbl_lock);
104 vblank_disable_fn((void *)dev);
106 free(dev->vblank, DRM_MEM_DRIVER);
111 int drm_vblank_init(struct drm_device *dev, int num_crtcs)
115 callout_init(&dev->vblank_disable_timer);
116 dev->num_crtcs = num_crtcs;
118 dev->vblank = malloc(sizeof(struct drm_vblank_info) * num_crtcs,
119 DRM_MEM_DRIVER, M_NOWAIT | M_ZERO);
125 /* Zero per-crtc vblank stuff */
126 for (i = 0; i < num_crtcs; i++) {
127 DRM_INIT_WAITQUEUE(&dev->vblank[i].queue);
128 atomic_set(&dev->vblank[i].count, 0);
129 atomic_set(&dev->vblank[i].refcount, 0);
132 dev->vblank_disable_allowed = 0;
137 drm_vblank_cleanup(dev);
141 int drm_irq_install(struct drm_device *dev)
145 if (dev->irq == 0 || dev->dev_private == NULL)
148 DRM_DEBUG("irq=%d\n", dev->irq);
151 if (dev->irq_enabled) {
155 dev->irq_enabled = 1;
157 dev->context_flag = 0;
159 /* Before installing handler */
160 dev->driver->irq_preinstall(dev);
163 /* Install handler */
164 retcode = bus_setup_intr(dev->device, dev->irqr, INTR_MPSAFE,
165 dev->driver->irq_handler, dev, &dev->irqh,
170 /* After installing handler */
172 dev->driver->irq_postinstall(dev);
174 if (dev->driver->enable_vblank) {
175 DRM_SPINLOCK(&dev->vbl_lock);
176 for( crtc = 0 ; crtc < dev->num_crtcs ; crtc++) {
177 if (dev->driver->enable_vblank(dev, crtc) == 0) {
178 dev->vblank[crtc].enabled = 1;
181 callout_reset(&dev->vblank_disable_timer, 5 * DRM_HZ,
182 (timeout_t *)vblank_disable_fn, (void *)dev);
183 DRM_SPINUNLOCK(&dev->vbl_lock);
189 dev->irq_enabled = 0;
195 int drm_irq_uninstall(struct drm_device *dev)
199 if (!dev->irq_enabled)
202 dev->irq_enabled = 0;
205 * Wake up any waiters so they don't hang.
207 DRM_SPINLOCK(&dev->vbl_lock);
208 for (crtc = 0; crtc < dev->num_crtcs; crtc++) {
209 if (dev->vblank[crtc].enabled) {
210 DRM_WAKEUP(&dev->vblank[crtc].queue);
211 dev->vblank[crtc].last =
212 dev->driver->get_vblank_counter(dev, crtc);
213 dev->vblank[crtc].enabled = 0;
216 DRM_SPINUNLOCK(&dev->vbl_lock);
218 DRM_DEBUG("irq=%d\n", dev->irq);
220 dev->driver->irq_uninstall(dev);
223 bus_teardown_intr(dev->device, dev->irqr, dev->irqh);
229 int drm_control(struct drm_device *dev, void *data, struct drm_file *file_priv)
231 struct drm_control *ctl = data;
235 case DRM_INST_HANDLER:
236 /* Handle drivers whose DRM used to require IRQ setup but the
239 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
241 if (dev->if_version < DRM_IF_VERSION(1, 2) &&
242 ctl->irq != dev->irq)
244 return drm_irq_install(dev);
245 case DRM_UNINST_HANDLER:
246 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
249 err = drm_irq_uninstall(dev);
257 u32 drm_vblank_count(struct drm_device *dev, int crtc)
259 return atomic_read(&dev->vblank[crtc].count);
262 static void drm_update_vblank_count(struct drm_device *dev, int crtc)
264 u32 cur_vblank, diff;
267 * Interrupts were disabled prior to this call, so deal with counter
269 * NOTE! It's possible we lost a full dev->max_vblank_count events
270 * here if the register is small or we had vblank interrupts off for
273 cur_vblank = dev->driver->get_vblank_counter(dev, crtc);
274 diff = cur_vblank - dev->vblank[crtc].last;
275 if (cur_vblank < dev->vblank[crtc].last) {
276 diff += dev->max_vblank_count;
278 DRM_DEBUG("vblank[%d].last=0x%x, cur_vblank=0x%x => diff=0x%x\n",
279 crtc, dev->vblank[crtc].last, cur_vblank, diff);
282 DRM_DEBUG("enabling vblank interrupts on crtc %d, missed %d\n",
285 atomic_add(diff, &dev->vblank[crtc].count);
288 int drm_vblank_get(struct drm_device *dev, int crtc)
292 DRM_SPINLOCK(&dev->vbl_lock);
293 /* Going from 0->1 means we have to enable interrupts again */
294 atomic_add_acq_int(&dev->vblank[crtc].refcount, 1);
295 if (dev->vblank[crtc].refcount == 1 &&
296 !dev->vblank[crtc].enabled) {
297 ret = dev->driver->enable_vblank(dev, crtc);
298 DRM_DEBUG("enabling vblank on crtc %d, ret: %d\n", crtc, ret);
300 atomic_dec(&dev->vblank[crtc].refcount);
302 dev->vblank[crtc].enabled = 1;
303 drm_update_vblank_count(dev, crtc);
306 DRM_SPINUNLOCK(&dev->vbl_lock);
311 void drm_vblank_put(struct drm_device *dev, int crtc)
313 KASSERT(atomic_read(&dev->vblank[crtc].refcount) > 0,
314 ("invalid refcount"));
316 /* Last user schedules interrupt disable */
317 atomic_subtract_acq_int(&dev->vblank[crtc].refcount, 1);
319 DRM_SPINLOCK(&dev->vbl_lock);
320 if (dev->vblank[crtc].refcount == 0)
321 callout_reset(&dev->vblank_disable_timer, 5 * DRM_HZ,
322 (timeout_t *)vblank_disable_fn, (void *)dev);
323 DRM_SPINUNLOCK(&dev->vbl_lock);
326 int drm_modeset_ctl(struct drm_device *dev, void *data,
327 struct drm_file *file_priv)
329 struct drm_modeset_ctl *modeset = data;
332 DRM_DEBUG("num_crtcs=%d\n", dev->num_crtcs);
333 /* If drm_vblank_init() hasn't been called yet, just no-op */
337 crtc = modeset->crtc;
338 DRM_DEBUG("crtc=%d\n", crtc);
339 if (crtc >= dev->num_crtcs) {
345 * To avoid all the problems that might happen if interrupts
346 * were enabled/disabled around or between these calls, we just
347 * have the kernel take a reference on the CRTC (just once though
348 * to avoid corrupting the count if multiple, mismatch calls occur),
349 * so that interrupts remain enabled in the interim.
351 switch (modeset->cmd) {
352 case _DRM_PRE_MODESET:
353 DRM_DEBUG("pre-modeset\n");
354 if (!dev->vblank[crtc].inmodeset) {
355 dev->vblank[crtc].inmodeset = 0x1;
356 if (drm_vblank_get(dev, crtc) == 0)
357 dev->vblank[crtc].inmodeset |= 0x2;
360 case _DRM_POST_MODESET:
361 DRM_DEBUG("post-modeset\n");
362 if (dev->vblank[crtc].inmodeset) {
363 DRM_SPINLOCK(&dev->vbl_lock);
364 dev->vblank_disable_allowed = 1;
365 DRM_SPINUNLOCK(&dev->vbl_lock);
367 if (dev->vblank[crtc].inmodeset & 0x2)
368 drm_vblank_put(dev, crtc);
370 dev->vblank[crtc].inmodeset = 0;
382 int drm_wait_vblank(struct drm_device *dev, void *data, struct drm_file *file_priv)
384 union drm_wait_vblank *vblwait = data;
385 unsigned int flags, seq, crtc;
388 if (!dev->irq_enabled)
391 if (vblwait->request.type &
392 ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK)) {
393 DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n",
394 vblwait->request.type,
395 (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK));
399 flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK;
400 crtc = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
402 if (crtc >= dev->num_crtcs)
405 ret = drm_vblank_get(dev, crtc);
407 DRM_ERROR("failed to acquire vblank counter, %d\n", ret);
410 seq = drm_vblank_count(dev, crtc);
412 switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) {
413 case _DRM_VBLANK_RELATIVE:
414 vblwait->request.sequence += seq;
415 vblwait->request.type &= ~_DRM_VBLANK_RELATIVE;
416 case _DRM_VBLANK_ABSOLUTE:
423 if ((flags & _DRM_VBLANK_NEXTONMISS) &&
424 (seq - vblwait->request.sequence) <= (1<<23)) {
425 vblwait->request.sequence = seq + 1;
428 if (flags & _DRM_VBLANK_SIGNAL) {
429 /* There have never been any consumers */
432 DRM_DEBUG("waiting on vblank count %d, crtc %d\n",
433 vblwait->request.sequence, crtc);
434 for ( ret = 0 ; !ret && !(((drm_vblank_count(dev, crtc) -
435 vblwait->request.sequence) <= (1 << 23)) ||
436 !dev->irq_enabled) ; ) {
437 lwkt_serialize_enter(&dev->irq_lock);
438 if (!(((drm_vblank_count(dev, crtc) -
439 vblwait->request.sequence) <= (1 << 23)) ||
441 ret = serialize_sleep(&dev->vblank[crtc].queue,
442 &dev->irq_lock, PCATCH, "vblwtq",
444 lwkt_serialize_exit(&dev->irq_lock);
447 if (ret != EINTR && ret != ERESTART) {
451 vblwait->reply.tval_sec = now.tv_sec;
452 vblwait->reply.tval_usec = now.tv_usec;
453 vblwait->reply.sequence = drm_vblank_count(dev, crtc);
454 DRM_DEBUG("returning %d to client, irq_enabled %d\n",
455 vblwait->reply.sequence, dev->irq_enabled);
457 DRM_DEBUG("vblank wait interrupted by signal\n");
462 drm_vblank_put(dev, crtc);
466 void drm_handle_vblank(struct drm_device *dev, int crtc)
468 atomic_inc(&dev->vblank[crtc].count);
469 DRM_WAKEUP(&dev->vblank[crtc].queue);