path: root/shared-core/i915_irq.c

/* i915_irq.c -- IRQ support for the I915 -*- linux-c -*-
 */
/*
 * Copyright 2003 Tungsten Graphics, Inc., Cedar Park, Texas.
 * All Rights Reserved.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sub license, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice (including the
 * next paragraph) shall be included in all copies or substantial portions
 * of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
 * IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR
 * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 */

#include "drmP.h"
#include "drm.h"
#include "i915_drm.h"
#include "i915_drv.h"
#include "intel_drv.h"

#define MAX_NOPID ((u32)~0)

/**
 * i915_get_pipe - return the the pipe associated with a given plane
 * @dev: DRM device
 * @plane: plane to look for
 *
 * The Intel Mesa & 2D drivers call the vblank routines with a plane number
 * rather than a pipe number, since they may not always be equal.  This routine
 * maps the given @plane back to a pipe number.
 */
static int
i915_get_pipe(struct drm_device *dev, int plane)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	u32 dspcntr;

	dspcntr = plane ? I915_READ(DSPBCNTR) : I915_READ(DSPACNTR);

	return dspcntr & DISPPLANE_SEL_PIPE_MASK ? 1 : 0;
}

/**
 * i915_get_plane - return the the plane associated with a given pipe
 * @dev: DRM device
 * @pipe: pipe to look for
 *
 * The Intel Mesa & 2D drivers call the vblank routines with a plane number
 * rather than a plane number, since they may not always be equal.  This routine
 * maps the given @pipe back to a plane number.
 */
static int
i915_get_plane(struct drm_device *dev, int pipe)
{
	if (i915_get_pipe(dev, 0) == pipe)
		return 0;
	return 1;
}

/**
 * i915_pipe_enabled - check if a pipe is enabled
 * @dev: DRM device
 * @pipe: pipe to check
 *
 * Reading certain registers when the pipe is disabled can hang the chip.
 * Use this routine to make sure the PLL is running and the pipe is active
 * before reading such registers if unsure.
 */
static int
i915_pipe_enabled(struct drm_device *dev, int pipe)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	unsigned long pipeconf = pipe ? PIPEBCONF : PIPEACONF;

	if (I915_READ(pipeconf) & PIPEACONF_ENABLE)
		return 1;

	return 0;
}

/**
 * Emit a synchronous flip.
 *
 * This function must be called with the drawable spinlock held.
 */
static void
i915_dispatch_vsync_flip(struct drm_device *dev, struct drm_drawable_info *drw,
			 int plane)
{
	struct drm_i915_master_private *master_priv = dev->primary->master->driver_priv;
	struct drm_i915_sarea *sarea_priv = master_priv->sarea_priv;
	u16 x1, y1, x2, y2;
	int pf_planes = 1 << plane;

	DRM_SPINLOCK_ASSERT(&dev->drw_lock);

	/* If the window is visible on the other plane, we have to flip on that
	 * plane as well.
	 */
	if (plane == 1) {
		x1 = sarea_priv->planeA_x;
		y1 = sarea_priv->planeA_y;
		x2 = x1 + sarea_priv->planeA_w;
		y2 = y1 + sarea_priv->planeA_h;
	} else {
		x1 = sarea_priv->planeB_x;
		y1 = sarea_priv->planeB_y;
		x2 = x1 + sarea_priv->planeB_w;
		y2 = y1 + sarea_priv->planeB_h;
	}

	if (x2 > 0 && y2 > 0) {
		int i, num_rects = drw->num_rects;
		struct drm_clip_rect *rect = drw->rects;

		for (i = 0; i < num_rects; i++)
			if (!(rect[i].x1 >= x2 || rect[i].y1 >= y2 ||
			      rect[i].x2 <= x1 || rect[i].y2 <= y1)) {
				pf_planes = 0x3;

				break;
			}
	}

	i915_dispatch_flip(dev, pf_planes, 1);
}

/**
 * Emit blits for scheduled buffer swaps.
 *
 * This function will be called with the HW lock held.
 */
static void i915_vblank_tasklet(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	struct drm_i915_master_private *master_priv = dev->primary->master->driver_priv;
	struct list_head *list, *tmp, hits, *hit;
	int nhits, nrects, slice[2], upper[2], lower[2], i, num_pages;
	unsigned counter[2];
	struct drm_drawable_info *drw;
	struct drm_i915_sarea *sarea_priv = master_priv->sarea_priv;
	u32 cpp = dev_priv->cpp,  offsets[3];
	u32 cmd = (cpp == 4) ? (XY_SRC_COPY_BLT_CMD |
				XY_SRC_COPY_BLT_WRITE_ALPHA |
				XY_SRC_COPY_BLT_WRITE_RGB)
			     : XY_SRC_COPY_BLT_CMD;
	u32 src_pitch = sarea_priv->pitch * cpp;
	u32 dst_pitch = sarea_priv->pitch * cpp;
	/* COPY rop (0xcc), map cpp to magic color depth constants */
	u32 ropcpp = (0xcc << 16) | ((cpp - 1) << 24);
	RING_LOCALS;
	
	if (sarea_priv->front_tiled) {
		cmd |= XY_SRC_COPY_BLT_DST_TILED;
		dst_pitch >>= 2;
	}
	if (sarea_priv->back_tiled) {
		cmd |= XY_SRC_COPY_BLT_SRC_TILED;
		src_pitch >>= 2;
	}
	
	counter[0] = drm_vblank_count(dev, 0);
	counter[1] = drm_vblank_count(dev, 1);

	DRM_DEBUG("\n");

	INIT_LIST_HEAD(&hits);

	nhits = nrects = 0;

	/* No irqsave/restore necessary.  This tasklet may be run in an
	 * interrupt context or normal context, but we don't have to worry
	 * about getting interrupted by something acquiring the lock, because
	 * we are the interrupt context thing that acquires the lock.
	 */
	DRM_SPINLOCK(&dev_priv->swaps_lock);

	/* Find buffer swaps scheduled for this vertical blank */
	list_for_each_safe(list, tmp, &dev_priv->vbl_swaps.head) {
		struct drm_i915_vbl_swap *vbl_swap =
			list_entry(list, struct drm_i915_vbl_swap, head);
		int pipe = i915_get_pipe(dev, vbl_swap->plane);

		if ((counter[pipe] - vbl_swap->sequence) > (1<<23))
			continue;

		master_priv = vbl_swap->minor->master->driver_priv;
		sarea_priv = master_priv->sarea_priv;
		
		list_del(list);
		dev_priv->swaps_pending--;
		drm_vblank_put(dev, pipe);

		DRM_SPINUNLOCK(&dev_priv->swaps_lock);
		DRM_SPINLOCK(&dev->drw_lock);

		drw = drm_get_drawable_info(dev, vbl_swap->drw_id);

		if (!drw) {
			DRM_SPINUNLOCK(&dev->drw_lock);
			drm_free(vbl_swap, sizeof(*vbl_swap), DRM_MEM_DRIVER);
			DRM_SPINLOCK(&dev_priv->swaps_lock);
			continue;
		}

		list_for_each(hit, &hits) {
			struct drm_i915_vbl_swap *swap_cmp =
				list_entry(hit, struct drm_i915_vbl_swap, head);
			struct drm_drawable_info *drw_cmp =
				drm_get_drawable_info(dev, swap_cmp->drw_id);

			if (drw_cmp &&
			    drw_cmp->rects[0].y1 > drw->rects[0].y1) {
				list_add_tail(list, hit);
				break;
			}
		}

		DRM_SPINUNLOCK(&dev->drw_lock);

		/* List of hits was empty, or we reached the end of it */
		if (hit == &hits)
			list_add_tail(list, hits.prev);

		nhits++;

		DRM_SPINLOCK(&dev_priv->swaps_lock);
	}

	DRM_SPINUNLOCK(&dev_priv->swaps_lock);

	if (nhits == 0) {
		return;
	}

	i915_kernel_lost_context(dev);

	upper[0] = upper[1] = 0;
	slice[0] = max(sarea_priv->planeA_h / nhits, 1);
	slice[1] = max(sarea_priv->planeB_h / nhits, 1);
	lower[0] = sarea_priv->planeA_y + slice[0];
	lower[1] = sarea_priv->planeB_y + slice[0];

	offsets[0] = sarea_priv->front_offset;
	offsets[1] = sarea_priv->back_offset;
	offsets[2] = sarea_priv->third_offset;
	num_pages = sarea_priv->third_handle ? 3 : 2;

	DRM_SPINLOCK(&dev->drw_lock);

	/* Emit blits for buffer swaps, partitioning both outputs into as many
	 * slices as there are buffer swaps scheduled in order to avoid tearing
	 * (based on the assumption that a single buffer swap would always
	 * complete before scanout starts).
	 */
	for (i = 0; i++ < nhits;
	     upper[0] = lower[0], lower[0] += slice[0],
	     upper[1] = lower[1], lower[1] += slice[1]) {
		int init_drawrect = 1;

		if (i == nhits)
			lower[0] = lower[1] = sarea_priv->height;

		list_for_each(hit, &hits) {
			struct drm_i915_vbl_swap *swap_hit =
				list_entry(hit, struct drm_i915_vbl_swap, head);
			struct drm_clip_rect *rect;
			int num_rects, plane, front, back;
			unsigned short top, bottom;

			drw = drm_get_drawable_info(dev, swap_hit->drw_id);

			if (!drw)
				continue;

			plane = swap_hit->plane;

			if (swap_hit->flip) {
				i915_dispatch_vsync_flip(dev, drw, plane);
				continue;
			}

			if (init_drawrect) {
				int width  = sarea_priv->width;
				int height = sarea_priv->height;
				if (IS_I965G(dev)) {
					BEGIN_LP_RING(4);

					OUT_RING(GFX_OP_DRAWRECT_INFO_I965);
					OUT_RING(0);
					OUT_RING(((width - 1) & 0xffff) | ((height - 1) << 16));
					OUT_RING(0);
					
					ADVANCE_LP_RING();
				} else {
					BEGIN_LP_RING(6);
	
					OUT_RING(GFX_OP_DRAWRECT_INFO);
					OUT_RING(0);
					OUT_RING(0);
					OUT_RING(((width - 1) & 0xffff) | ((height - 1) << 16));
					OUT_RING(0);
					OUT_RING(0);
					
					ADVANCE_LP_RING();
				}

				sarea_priv->ctxOwner = DRM_KERNEL_CONTEXT;

				init_drawrect = 0;
			}

			rect = drw->rects;
			top = upper[plane];
			bottom = lower[plane];

			front = (master_priv->sarea_priv->pf_current_page >>
				 (2 * plane)) & 0x3;
			back = (front + 1) % num_pages;

			for (num_rects = drw->num_rects; num_rects--; rect++) {
				int y1 = max(rect->y1, top);
				int y2 = min(rect->y2, bottom);

				if (y1 >= y2)
					continue;

				BEGIN_LP_RING(8);

				OUT_RING(cmd);
				OUT_RING(ropcpp | dst_pitch);
				OUT_RING((y1 << 16) | rect->x1);
				OUT_RING((y2 << 16) | rect->x2);
				OUT_RING(offsets[front]);
				OUT_RING((y1 << 16) | rect->x1);
				OUT_RING(src_pitch);
				OUT_RING(offsets[back]);

				ADVANCE_LP_RING();
			}
		}
	}

	DRM_SPINUNLOCK(&dev->drw_lock);

	list_for_each_safe(hit, tmp, &hits) {
		struct drm_i915_vbl_swap *swap_hit =
			list_entry(hit, struct drm_i915_vbl_swap, head);

		list_del(hit);

		drm_free(swap_hit, sizeof(*swap_hit), DRM_MEM_DRIVER);
	}
}
#if 0
static int i915_in_vblank(struct drm_device *dev, int pipe)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	unsigned long pipedsl, vblank, vtotal;
	unsigned long vbl_start, vbl_end, cur_line;

	pipedsl = pipe ? PIPEBDSL : PIPEADSL;
	vblank = pipe ? VBLANK_B : VBLANK_A;
	vtotal = pipe ? VTOTAL_B : VTOTAL_A;

	vbl_start = I915_READ(vblank) & VBLANK_START_MASK;
	vbl_end = (I915_READ(vblank) >> VBLANK_END_SHIFT) & VBLANK_END_MASK;

	cur_line = I915_READ(pipedsl);

	if (cur_line >= vbl_start)
		return 1;

	return 0;
}
#endif
u32 i915_get_vblank_counter(struct drm_device *dev, int plane)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	unsigned long high_frame;
	unsigned long low_frame;
	u32 high1, high2, low, count;
	int pipe;

	pipe = i915_get_pipe(dev, plane);
	high_frame = pipe ? PIPEBFRAMEHIGH : PIPEAFRAMEHIGH;
	low_frame = pipe ? PIPEBFRAMEPIXEL : PIPEAFRAMEPIXEL;

	if (!i915_pipe_enabled(dev, pipe)) {
	    printk(KERN_ERR "trying to get vblank count for disabled "
		   "pipe %d\n", pipe);
	    return 0;
	}

	/*
	 * High & low register fields aren't synchronized, so make sure
	 * we get a low value that's stable across two reads of the high
	 * register.
	 */
	do {
		high1 = ((I915_READ(high_frame) & PIPE_FRAME_HIGH_MASK) >>
			 PIPE_FRAME_HIGH_SHIFT);
		low =  ((I915_READ(low_frame) & PIPE_FRAME_LOW_MASK) >>
			PIPE_FRAME_LOW_SHIFT);
		high2 = ((I915_READ(high_frame) & PIPE_FRAME_HIGH_MASK) >>
			 PIPE_FRAME_HIGH_SHIFT);
	} while (high1 != high2);

	count = (high1 << 8) | low;

	/*
	 * If we're in the middle of the vblank period, the
	 * above regs won't have been updated yet, so return
	 * an incremented count to stay accurate
	 */
#if 0
	if (i915_in_vblank(dev, pipe))
		count++;
#endif
	/* count may be reset by other driver(e.g. 2D driver), 
	   we have no way to know if it is wrapped or resetted 
	   when count is zero. do a rough guess.
	*/
	if (count == 0 && dev->last_vblank[pipe] < dev->max_vblank_count/2)
		dev->last_vblank[pipe] = 0; 
	
	return count;
}

#define HOTPLUG_CMD_CRT 1
#define HOTPLUG_CMD_CRT_DIS 2
#define HOTPLUG_CMD_SDVOB 4
#define HOTPLUG_CMD_SDVOC 8
#define HOTPLUG_CMD_TV 16

static struct drm_device *hotplug_dev;
static int hotplug_cmd = 0;
static spinlock_t hotplug_lock = SPIN_LOCK_UNLOCKED;

static void i915_hotplug_tv(struct drm_device *dev)
{
	struct drm_output *output;
	struct intel_output *iout;
	enum drm_output_status status;

	mutex_lock(&dev->mode_config.mutex);

	/* find the crt output */
	list_for_each_entry(output, &dev->mode_config.output_list, head) {
		iout = output->driver_private;
		if (iout->type == INTEL_OUTPUT_TVOUT)
			break;
		else
			iout = 0;
	}

	if (iout == 0)
		goto unlock;

	status = output->funcs->detect(output);
	drm_hotplug_stage_two(dev, output,
			      status == output_status_connected ? 1 : 0);

unlock:
	mutex_unlock(&dev->mode_config.mutex);
}

static void i915_hotplug_crt(struct drm_device *dev, bool isconnected)
{
	struct drm_output *output;
	struct intel_output *iout;

	mutex_lock(&dev->mode_config.mutex);

	/* find the crt output */
	list_for_each_entry(output, &dev->mode_config.output_list, head) {
		iout = output->driver_private;
		if (iout->type == INTEL_OUTPUT_ANALOG)
			break;
		else
			iout = 0;
	}

	if (iout == 0)
		goto unlock;

	drm_hotplug_stage_two(dev, output, isconnected);

unlock:
	mutex_unlock(&dev->mode_config.mutex);
}

static void i915_hotplug_sdvo(struct drm_device *dev, int sdvoB)
{
	struct drm_output *output = 0;
	enum drm_output_status status;

	mutex_lock(&dev->mode_config.mutex);

	output = intel_sdvo_find(dev, sdvoB);

	if (!output)
		goto unlock;

	status = output->funcs->detect(output);

	if (status != output_status_connected)
		drm_hotplug_stage_two(dev, output, false);
	else
		drm_hotplug_stage_two(dev, output, true);

	intel_sdvo_set_hotplug(output, 1);

unlock:
	mutex_unlock(&dev->mode_config.mutex);
}
/*
 * This code is called in a more safe envirmoent to handle the hotplugs.
 * Add code here for hotplug love to userspace.
 */
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20)
static void i915_hotplug_work_func(void *work)
#else
static void i915_hotplug_work_func(struct work_struct *work)
#endif
{
	struct drm_device *dev = hotplug_dev;
	int crt;
	int crtDis;
	int sdvoB;
	int sdvoC;
	int tv;

	spin_lock(&hotplug_lock);
	tv = hotplug_cmd & HOTPLUG_CMD_TV;
	crt = hotplug_cmd & HOTPLUG_CMD_CRT;
	crtDis = hotplug_cmd & HOTPLUG_CMD_CRT_DIS;
	sdvoB = hotplug_cmd & HOTPLUG_CMD_SDVOB;
	sdvoC = hotplug_cmd & HOTPLUG_CMD_SDVOC;
	hotplug_cmd = 0;
	spin_unlock(&hotplug_lock);

	if (tv)
		i915_hotplug_tv(dev);
	if (crt)
		i915_hotplug_crt(dev, true);
	if (crtDis)
		i915_hotplug_crt(dev, false);

	if (sdvoB)
		i915_hotplug_sdvo(dev, 1);

	if (sdvoC)
		i915_hotplug_sdvo(dev, 0);

	drm_handle_hotplug(dev);
}

static int i915_run_hotplug_tasklet(struct drm_device *dev, uint32_t stat)
{
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20)
	static DECLARE_WORK(hotplug, i915_hotplug_work_func, NULL);
#else
	static DECLARE_WORK(hotplug, i915_hotplug_work_func);
#endif
	struct drm_i915_private *dev_priv = dev->dev_private;

	hotplug_dev = dev;

	if (stat & TV_HOTPLUG_INT_STATUS) {
		DRM_DEBUG("TV event\n");

		spin_lock(&hotplug_lock);
		hotplug_cmd |= HOTPLUG_CMD_TV;
		spin_unlock(&hotplug_lock);
	}

	if (stat & CRT_HOTPLUG_INT_STATUS) {
		DRM_DEBUG("CRT event\n");

		if (stat & CRT_HOTPLUG_MONITOR_MASK) {
			spin_lock(&hotplug_lock);
			hotplug_cmd |= HOTPLUG_CMD_CRT;
			spin_unlock(&hotplug_lock);
		} else {
			spin_lock(&hotplug_lock);
			hotplug_cmd |= HOTPLUG_CMD_CRT_DIS;
			spin_unlock(&hotplug_lock);
		}
	}

	if (stat & SDVOB_HOTPLUG_INT_STATUS) {
		DRM_DEBUG("sDVOB event\n");

		spin_lock(&hotplug_lock);
		hotplug_cmd |= HOTPLUG_CMD_SDVOB;
		spin_unlock(&hotplug_lock);
	}

	if (stat & SDVOC_HOTPLUG_INT_STATUS) {
		DRM_DEBUG("sDVOC event\n");

		spin_lock(&hotplug_lock);
		hotplug_cmd |= HOTPLUG_CMD_SDVOC;
		spin_unlock(&hotplug_lock);
	}

	queue_work(dev_priv->wq, &hotplug);

	return 0;
}

irqreturn_t i915_driver_irq_handler(DRM_IRQ_ARGS)
{
	struct drm_device *dev = (struct drm_device *) arg;
	struct drm_i915_master_private *master_priv;
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	u32 iir;
	u32 pipea_stats = 0, pipeb_stats, tvdac;
	int hotplug = 0;
	int vblank = 0;

	/* On i8xx/i915 hw the IIR and IER are 16bit on i9xx its 32bit */
	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
		iir = I915_READ(IIR);
	else
		iir = I915_READ16(IIR);

	iir &= (dev_priv->irq_enable_reg | I915_USER_INTERRUPT);

#if 0
	DRM_DEBUG("flag=%08x\n", iir);
#endif
	if (iir == 0) {
#if 0
		DRM_DEBUG ("iir 0x%08x im 0x%08x ie 0x%08x pipea 0x%08x pipeb 0x%08x\n",
			   iir,
			   I915_READ(IMR),
			   I915_READ(IER),
			   I915_READ(PIPEASTAT),
			   I915_READ(PIPEBSTAT));
#endif
		return IRQ_NONE;
	}

	/*
	 * Clear the PIPE(A|B)STAT regs before the IIR otherwise
	 * we may get extra interrupts.
	 */
	if (iir & I915_DISPLAY_PIPE_A_EVENT_INTERRUPT) {
		pipea_stats = I915_READ(PIPEASTAT);
		if (pipea_stats & (PIPE_START_VBLANK_INTERRUPT_STATUS|
				   PIPE_VBLANK_INTERRUPT_STATUS))
		{
			vblank++;
			drm_handle_vblank(dev, i915_get_plane(dev, 0));
		}

		/* This is a global event, and not a pipe A event */
		if (pipea_stats & PIPE_HOTPLUG_INTERRUPT_STATUS)
			hotplug = 1;

		if (pipea_stats & PIPE_HOTPLUG_TV_INTERRUPT_STATUS) {
			hotplug = 1;
			/* Toggle hotplug detection to clear hotplug status */
			tvdac = I915_READ(TV_DAC);
			I915_WRITE(TV_DAC, tvdac & ~TVDAC_STATE_CHG_EN);
			I915_WRITE(TV_DAC, tvdac | TVDAC_STATE_CHG_EN);
		}

		I915_WRITE(PIPEASTAT, pipea_stats);
	}

	if (iir & I915_DISPLAY_PIPE_B_EVENT_INTERRUPT) {
		pipeb_stats = I915_READ(PIPEBSTAT);
		if (pipeb_stats & (PIPE_START_VBLANK_INTERRUPT_STATUS|
				   PIPE_VBLANK_INTERRUPT_STATUS))
		{
			vblank++;
			drm_handle_vblank(dev, i915_get_plane(dev, 1));
		}
		I915_WRITE(PIPEBSTAT, pipeb_stats);
	}

	/* Clear the generated interrupt */
	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
		I915_WRITE(IIR, iir);
		(void) I915_READ(IIR);
	} else {
		I915_WRITE16(IIR, iir);
		(void) I915_READ16(IIR);
	}

	if (dev->primary->master) {
		master_priv = dev->primary->master->driver_priv;
		master_priv->sarea_priv->last_dispatch = READ_BREADCRUMB(dev_priv);
	}

	if (iir & I915_USER_INTERRUPT) {
		DRM_WAKEUP(&dev_priv->irq_queue);
#ifdef I915_HAVE_FENCE
		i915_fence_handler(dev);
#endif
	}

	if (vblank) {
		if (dev_priv->swaps_pending > 0)
			drm_locked_tasklet(dev, i915_vblank_tasklet);
	}

	if ((iir & I915_DISPLAY_PORT_INTERRUPT) || hotplug) {
		u32 temp2 = 0;

		DRM_INFO("Hotplug event received\n");

		if (!IS_I9XX(dev) || IS_I915G(dev) || IS_I915GM(dev)) {
			if (pipea_stats & PIPE_HOTPLUG_INTERRUPT_STATUS)
				temp2 |= SDVOB_HOTPLUG_INT_STATUS |
					SDVOC_HOTPLUG_INT_STATUS;
			if (pipea_stats & PIPE_HOTPLUG_TV_INTERRUPT_STATUS)
				temp2 |= TV_HOTPLUG_INT_STATUS;
		} else {
			temp2 = I915_READ(PORT_HOTPLUG_STAT);

			I915_WRITE(PORT_HOTPLUG_STAT, temp2);
		}
		i915_run_hotplug_tasklet(dev, temp2);
	}

	return IRQ_HANDLED;
}

int i915_emit_irq(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	RING_LOCALS;

	i915_kernel_lost_context(dev);

	DRM_DEBUG("\n");

	i915_emit_breadcrumb(dev);

	BEGIN_LP_RING(2);
	OUT_RING(0);
	OUT_RING(MI_USER_INTERRUPT);
	ADVANCE_LP_RING();

	return dev_priv->counter;
}

void i915_user_irq_on(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;

	DRM_SPINLOCK(&dev_priv->user_irq_lock);
	if (dev_priv->irq_enabled && (++dev_priv->user_irq_refcount == 1)){
		dev_priv->irq_enable_reg |= I915_USER_INTERRUPT;
		if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
			I915_WRITE(IER, dev_priv->irq_enable_reg);
		else
			I915_WRITE16(IER, dev_priv->irq_enable_reg);
	}
	DRM_SPINUNLOCK(&dev_priv->user_irq_lock);

}
		
void i915_user_irq_off(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;

	DRM_SPINLOCK(&dev_priv->user_irq_lock);
	if (dev_priv->irq_enabled && (--dev_priv->user_irq_refcount == 0)) {
		//		dev_priv->irq_enable_reg &= ~I915_USER_INTERRUPT;
		//		if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
		//			I915_WRITE(IER, dev_priv->irq_enable_reg);
		//		else
		//			I915_WRITE16(IER, dev_priv->irq_enable_reg);
	}
	DRM_SPINUNLOCK(&dev_priv->user_irq_lock);
}


static int i915_wait_irq(struct drm_device * dev, int irq_nr)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	struct drm_i915_master_private *master_priv;
	int ret = 0;

	DRM_DEBUG("irq_nr=%d breadcrumb=%d\n", irq_nr,
		  READ_BREADCRUMB(dev_priv));

	if (READ_BREADCRUMB(dev_priv) >= irq_nr)
		return 0;

	i915_user_irq_on(dev);
	DRM_WAIT_ON(ret, dev_priv->irq_queue, 3 * DRM_HZ,
		    READ_BREADCRUMB(dev_priv) >= irq_nr);
	i915_user_irq_off(dev);

	if (ret == -EBUSY) {
		DRM_ERROR("EBUSY -- rec: %d emitted: %d\n",
			  READ_BREADCRUMB(dev_priv), (int)dev_priv->counter);
	}
	
	if (dev->primary->master) {
		master_priv = dev->primary->master->driver_priv;
		master_priv->sarea_priv->last_dispatch = READ_BREADCRUMB(dev_priv);
	}

	return ret;
}

/* Needs the lock as it touches the ring.
 */
int i915_irq_emit(struct drm_device *dev, void *data,
			 struct drm_file *file_priv)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_i915_irq_emit *emit = data;
	int result;

	LOCK_TEST_WITH_RETURN(dev, file_priv);

	if (!dev_priv) {
		DRM_ERROR("called with no initialization\n");
		return -EINVAL;
	}

	result = i915_emit_irq(dev);

	if (DRM_COPY_TO_USER(emit->irq_seq, &result, sizeof(int))) {
		DRM_ERROR("copy_to_user\n");
		return -EFAULT;
	}

	return 0;
}

/* Doesn't need the hardware lock.
 */
int i915_irq_wait(struct drm_device *dev, void *data,
		  struct drm_file *file_priv)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_i915_irq_wait *irqwait = data;

	if (!dev_priv) {
		DRM_ERROR("called with no initialization\n");
		return -EINVAL;
	}

	return i915_wait_irq(dev, irqwait->irq_seq);
}

int i915_enable_vblank(struct drm_device *dev, int plane)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	int pipe = i915_get_pipe(dev, plane);
	u32	pipestat_reg = 0;
	u32	pipestat;

	switch (pipe) {
	case 0:
		pipestat_reg = PIPEASTAT;
		dev_priv->irq_enable_reg |= I915_DISPLAY_PIPE_A_EVENT_INTERRUPT;
		break;
	case 1:
		pipestat_reg = PIPEBSTAT;
		dev_priv->irq_enable_reg |= I915_DISPLAY_PIPE_B_EVENT_INTERRUPT;
		break;
	default:
		DRM_ERROR("tried to enable vblank on non-existent pipe %d\n",
			  pipe);
		break;
	}

	if (pipestat_reg)
	{
		pipestat = I915_READ (pipestat_reg);
		/*
		 * Older chips didn't have the start vblank interrupt,
		 * but 
		 */
		if (IS_I965G (dev))
			pipestat |= PIPE_START_VBLANK_INTERRUPT_ENABLE;
		else
			pipestat |= PIPE_VBLANK_INTERRUPT_ENABLE;
		/*
		 * Clear any pending status
		 */
		pipestat |= (PIPE_START_VBLANK_INTERRUPT_STATUS |
			     PIPE_VBLANK_INTERRUPT_STATUS);
		I915_WRITE(pipestat_reg, pipestat);
	}

	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
		I915_WRITE(IER, dev_priv->irq_enable_reg);
	else
		I915_WRITE16(IER, dev_priv->irq_enable_reg);


	return 0;
}

void i915_disable_vblank(struct drm_device *dev, int plane)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	int pipe = i915_get_pipe(dev, plane);
	u32	pipestat_reg = 0;
	u32	pipestat;

	switch (pipe) {
	case 0:
		pipestat_reg = PIPEASTAT;
		dev_priv->irq_enable_reg &= ~I915_DISPLAY_PIPE_A_EVENT_INTERRUPT;
		break;
	case 1:
		pipestat_reg = PIPEBSTAT;
		dev_priv->irq_enable_reg &= ~I915_DISPLAY_PIPE_B_EVENT_INTERRUPT;
		break;
	default:
		DRM_ERROR("tried to disable vblank on non-existent pipe %d\n",
			  pipe);
		break;
	}

	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
		I915_WRITE(IER, dev_priv->irq_enable_reg);
	else
		I915_WRITE16(IER, dev_priv->irq_enable_reg);

	if (pipestat_reg)
	{
		pipestat = I915_READ (pipestat_reg);
		pipestat &= ~(PIPE_START_VBLANK_INTERRUPT_ENABLE |
			      PIPE_VBLANK_INTERRUPT_ENABLE);
		/*
		 * Clear any pending status
		 */
		pipestat |= (PIPE_START_VBLANK_INTERRUPT_STATUS |
			     PIPE_VBLANK_INTERRUPT_STATUS);
		I915_WRITE(pipestat_reg, pipestat);
	}
}

void i915_enable_interrupt (struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	struct drm_output *o;

	dev_priv->irq_enable_reg |= I915_USER_INTERRUPT;

	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
		if (dev->mode_config.num_output)
			dev_priv->irq_enable_reg |= I915_DISPLAY_PORT_INTERRUPT;
	} else {
		if (dev->mode_config.num_output)
			dev_priv->irq_enable_reg |= I915_DISPLAY_PIPE_A_EVENT_INTERRUPT;

		/* Enable global interrupts for hotplug - not a pipeA event */
		I915_WRITE(PIPEASTAT, I915_READ(PIPEASTAT) |
			   PIPE_HOTPLUG_INTERRUPT_ENABLE |
			   PIPE_HOTPLUG_TV_INTERRUPT_ENABLE |
			   PIPE_HOTPLUG_TV_INTERRUPT_STATUS |
			   PIPE_HOTPLUG_INTERRUPT_STATUS);
	}

	if (dev_priv->irq_enable_reg & (I915_DISPLAY_PORT_INTERRUPT | I915_DISPLAY_PIPE_A_EVENT_INTERRUPT)) {
		u32 temp = 0;

		if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
			temp = I915_READ(PORT_HOTPLUG_EN);

			/* Activate the CRT */
			temp |= CRT_HOTPLUG_INT_EN;
		}

		if (IS_I9XX(dev)) {
			/* SDVOB */
			o = intel_sdvo_find(dev, 1);
			if (o && intel_sdvo_supports_hotplug(o)) {
				intel_sdvo_set_hotplug(o, 1);
				temp |= SDVOB_HOTPLUG_INT_EN;
			}

			/* SDVOC */
			o = intel_sdvo_find(dev, 0);
			if (o && intel_sdvo_supports_hotplug(o)) {
				intel_sdvo_set_hotplug(o, 1);
				temp |= SDVOC_HOTPLUG_INT_EN;
			}

			I915_WRITE(SDVOB, I915_READ(SDVOB) | SDVO_INTERRUPT_ENABLE);
			I915_WRITE(SDVOC, I915_READ(SDVOC) | SDVO_INTERRUPT_ENABLE);

			/* TV */
			I915_WRITE(TV_DAC, I915_READ(TV_DAC) | TVDAC_STATE_CHG_EN);
		} else {
			/* DVO ???? */
		}

		if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
			I915_WRITE(PORT_HOTPLUG_EN, temp);

			DRM_DEBUG("HEN %08x\n",I915_READ(PORT_HOTPLUG_EN));
			DRM_DEBUG("HST %08x\n",I915_READ(PORT_HOTPLUG_STAT));

			I915_WRITE(PORT_HOTPLUG_STAT, I915_READ(PORT_HOTPLUG_STAT));
		}
	}

	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
		I915_WRITE(IER, dev_priv->irq_enable_reg);
	else
		I915_WRITE16(IER, dev_priv->irq_enable_reg);

	dev_priv->irq_enabled = 1;
}

/* Set the vblank monitor pipe
 */
int i915_vblank_pipe_set(struct drm_device *dev, void *data,
			 struct drm_file *file_priv)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_i915_vblank_pipe *pipe = data;

	if (!dev_priv) {
		DRM_ERROR("called with no initialization\n");
		return -EINVAL;
	}

	if (pipe->pipe & ~(DRM_I915_VBLANK_PIPE_A|DRM_I915_VBLANK_PIPE_B)) {
		DRM_ERROR("called with invalid pipe 0x%x\n", pipe->pipe);
		return -EINVAL;
	}

	dev_priv->vblank_pipe = pipe->pipe;

	return 0;
}

int i915_vblank_pipe_get(struct drm_device *dev, void *data,
			 struct drm_file *file_priv)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_i915_vblank_pipe *pipe = data;
	u16 flag;

	if (!dev_priv) {
		DRM_ERROR("called with no initialization\n");
		return -EINVAL;
	}

	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev))
		flag = I915_READ(IER);
	else
		flag = I915_READ16(IER);

	pipe->pipe = 0;
	if (flag & I915_DISPLAY_PIPE_A_EVENT_INTERRUPT)
		pipe->pipe |= DRM_I915_VBLANK_PIPE_A;
	if (flag & I915_DISPLAY_PIPE_B_EVENT_INTERRUPT)
		pipe->pipe |= DRM_I915_VBLANK_PIPE_B;

	return 0;
}

/**
 * Schedule buffer swap at given vertical blank.
 */
int i915_vblank_swap(struct drm_device *dev, void *data,
		     struct drm_file *file_priv)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_i915_master_private *master_priv;
	struct drm_i915_vblank_swap *swap = data;
	struct drm_i915_vbl_swap *vbl_swap;
	unsigned int pipe, seqtype, curseq, plane;
	unsigned long irqflags;
	struct list_head *list;
	int ret;

	if (!dev_priv) {
		DRM_ERROR("%s called with no initialization\n", __func__);
		return -EINVAL;
	}

	if (!dev->primary->master)
		return -EINVAL;

	master_priv = dev->primary->master->driver_priv;

	if (master_priv->sarea_priv->rotation) {
		DRM_DEBUG("Rotation not supported\n");
		return -EINVAL;
	}

	if (swap->seqtype & ~(_DRM_VBLANK_RELATIVE | _DRM_VBLANK_ABSOLUTE |
			     _DRM_VBLANK_SECONDARY | _DRM_VBLANK_NEXTONMISS |
			     _DRM_VBLANK_FLIP)) {
		DRM_ERROR("Invalid sequence type 0x%x\n", swap->seqtype);
		return -EINVAL;
	}

	plane = (swap->seqtype & _DRM_VBLANK_SECONDARY) ? 1 : 0;
	pipe = i915_get_pipe(dev, plane);

	seqtype = swap->seqtype & (_DRM_VBLANK_RELATIVE | _DRM_VBLANK_ABSOLUTE);

	if (!(dev_priv->vblank_pipe & (1 << pipe))) {
		DRM_ERROR("Invalid pipe %d\n", pipe);
		return -EINVAL;
	}

	DRM_SPINLOCK_IRQSAVE(&dev->drw_lock, irqflags);

	/* It makes no sense to schedule a swap for a drawable that doesn't have
	 * valid information at this point. E.g. this could mean that the X
	 * server is too old to push drawable information to the DRM, in which
	 * case all such swaps would become ineffective.
	 */
	if (!drm_get_drawable_info(dev, swap->drawable)) {
		DRM_SPINUNLOCK_IRQRESTORE(&dev->drw_lock, irqflags);
		DRM_DEBUG("Invalid drawable ID %d\n", swap->drawable);
		return -EINVAL;
	}

	DRM_SPINUNLOCK_IRQRESTORE(&dev->drw_lock, irqflags);

	drm_update_vblank_count(dev, pipe);
	curseq = drm_vblank_count(dev, pipe);

	if (seqtype == _DRM_VBLANK_RELATIVE)
		swap->sequence += curseq;

	if ((curseq - swap->sequence) <= (1<<23)) {
		if (swap->seqtype & _DRM_VBLANK_NEXTONMISS) {
			swap->sequence = curseq + 1;
		} else {
			DRM_DEBUG("Missed target sequence\n");
			return -EINVAL;
		}
	}

	if (swap->seqtype & _DRM_VBLANK_FLIP) {
		swap->sequence--;

		if ((curseq - swap->sequence) <= (1<<23)) {
			struct drm_drawable_info *drw;

			LOCK_TEST_WITH_RETURN(dev, file_priv);

			DRM_SPINLOCK_IRQSAVE(&dev->drw_lock, irqflags);

			drw = drm_get_drawable_info(dev, swap->drawable);

			if (!drw) {
				DRM_SPINUNLOCK_IRQRESTORE(&dev->drw_lock,
				    irqflags);
				DRM_DEBUG("Invalid drawable ID %d\n",
					  swap->drawable);
				return -EINVAL;
			}

			i915_dispatch_vsync_flip(dev, drw, plane);

			DRM_SPINUNLOCK_IRQRESTORE(&dev->drw_lock, irqflags);

			return 0;
		}
	}

	DRM_SPINLOCK_IRQSAVE(&dev_priv->swaps_lock, irqflags);

	list_for_each(list, &dev_priv->vbl_swaps.head) {
		vbl_swap = list_entry(list, struct drm_i915_vbl_swap, head);

		if (vbl_swap->drw_id == swap->drawable &&
		    vbl_swap->plane == plane &&
		    vbl_swap->sequence == swap->sequence) {
			vbl_swap->flip = (swap->seqtype & _DRM_VBLANK_FLIP);
			DRM_SPINUNLOCK_IRQRESTORE(&dev_priv->swaps_lock, irqflags);
			DRM_DEBUG("Already scheduled\n");
			return 0;
		}
	}

	DRM_SPINUNLOCK_IRQRESTORE(&dev_priv->swaps_lock, irqflags);

	if (dev_priv->swaps_pending >= 100) {
		DRM_DEBUG("Too many swaps queued\n");
		return -EBUSY;
	}

	vbl_swap = drm_calloc(1, sizeof(*vbl_swap), DRM_MEM_DRIVER);

	if (!vbl_swap) {
		DRM_ERROR("Failed to allocate memory to queue swap\n");
		return -ENOMEM;
	}

	DRM_DEBUG("\n");

	ret = drm_vblank_get(dev, pipe);
	if (ret) {
		drm_free(vbl_swap, sizeof(*vbl_swap), DRM_MEM_DRIVER);
		return ret;
	}

	vbl_swap->drw_id = swap->drawable;
	vbl_swap->plane = plane;
	vbl_swap->sequence = swap->sequence;
	vbl_swap->flip = (swap->seqtype & _DRM_VBLANK_FLIP);
	vbl_swap->minor = file_priv->minor;

	if (vbl_swap->flip)
		swap->sequence++;

	DRM_SPINLOCK_IRQSAVE(&dev_priv->swaps_lock, irqflags);

	list_add_tail(&vbl_swap->head, &dev_priv->vbl_swaps.head);
	dev_priv->swaps_pending++;

	DRM_SPINUNLOCK_IRQRESTORE(&dev_priv->swaps_lock, irqflags);

	return 0;
}

/* drm_dma.h hooks
*/
void i915_driver_irq_preinstall(struct drm_device * dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	u32 tmp;

	tmp = I915_READ(PIPEASTAT);
	I915_WRITE(PIPEASTAT, tmp);
	tmp = I915_READ(PIPEBSTAT);
	I915_WRITE(PIPEBSTAT, tmp);


	I915_WRITE16(HWSTAM, 0xeffe);
	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
		I915_WRITE(IMR, 0x0);
		I915_WRITE(IER, 0x0);
		tmp = I915_READ(IIR);
		I915_WRITE(IIR, tmp);
	} else {
		I915_WRITE16(IMR, 0x0);
		I915_WRITE16(IER, 0x0);
		tmp = I915_READ16(IIR);
		I915_WRITE16(IIR, tmp);
	}

}

int i915_driver_irq_postinstall(struct drm_device * dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	int ret, num_pipes = 2;

	DRM_SPININIT(&dev_priv->swaps_lock, "swap");
	INIT_LIST_HEAD(&dev_priv->vbl_swaps.head);
	dev_priv->swaps_pending = 0;

	DRM_SPININIT(&dev_priv->user_irq_lock, "userirq");
	dev_priv->user_irq_refcount = 0;
	dev_priv->irq_enable_reg = 0;

	ret = drm_vblank_init(dev, num_pipes);
	if (ret)
		return ret;

	ret = drm_hotplug_init(dev);
	if (ret)
		return ret;

	dev->max_vblank_count = 0xffffff; /* only 24 bits of frame count */

	i915_enable_interrupt(dev);
	DRM_INIT_WAITQUEUE(&dev_priv->irq_queue);

	/*
	 * Initialize the hardware status page IRQ location.
	 */

	I915_WRITE(INSTPM, (1 << 5) | (1 << 21));
	return 0;
}

void i915_driver_irq_uninstall(struct drm_device * dev)
{
	struct drm_i915_private *dev_priv = (struct drm_i915_private *) dev->dev_private;
	u32 temp;

	if (!dev_priv)
		return;

	dev_priv->irq_enabled = 0;

	temp = I915_READ(PIPEASTAT);
	I915_WRITE(PIPEASTAT, temp);
	temp = I915_READ(PIPEBSTAT);
	I915_WRITE(PIPEBSTAT, temp);
	if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
		I915_WRITE(HWSTAM, 0xffffffff);
		I915_WRITE(IMR, 0xffffffff);
		I915_WRITE(IER, 0x0);

		temp = I915_READ(IIR);
		I915_WRITE(IIR, temp);
	} else {
		I915_WRITE16(HWSTAM, 0xffff);
		I915_WRITE16(IMR, 0xffff);
		I915_WRITE16(IER, 0x0);

		temp = I915_READ16(IIR);
		I915_WRITE16(IIR, temp);
	}
}