add blit ioctl, fix plnwt handling

8 files changed, 161 insertions, 7 deletions

diff --git a/linux-core/mga_drv.c b/linux-core/mga_drv.c
index 883eb75c..e898ee3d 100644
--- a/linux-core/mga_drv.c
+++ b/linux-core/mga_drv.c
@@ -38,7 +38,7 @@
 #define MGA_DESC	 "Matrox G200/G400"
 #define MGA_DATE	 "20000928"
 #define MGA_MAJOR	 2
-#define MGA_MINOR	 0
+#define MGA_MINOR	 1
 #define MGA_PATCHLEVEL	 1
 
 static drm_device_t	      mga_device;
@@ -114,6 +114,7 @@ static drm_ioctl_desc_t	      mga_ioctls[] = {
    	[DRM_IOCTL_NR(DRM_IOCTL_MGA_VERTEX)]  = { mga_vertex,      1, 0 },
    	[DRM_IOCTL_NR(DRM_IOCTL_MGA_FLUSH)]   = { mga_flush_ioctl, 1, 0 },
    	[DRM_IOCTL_NR(DRM_IOCTL_MGA_INDICES)] = { mga_indices,     1, 0 },
+     	[DRM_IOCTL_NR(DRM_IOCTL_MGA_BLIT)]    = { mga_blit,        1, 0 }, 
 };
 
 #define MGA_IOCTL_COUNT DRM_ARRAY_SIZE(mga_ioctls)
diff --git a/linux/drm.h b/linux/drm.h
index 20691ccf..cdc058af 100644
--- a/linux/drm.h
+++ b/linux/drm.h
@@ -350,6 +350,7 @@ typedef struct drm_agp_info {
 #define DRM_IOCTL_MGA_VERTEX  DRM_IOW( 0x44, drm_mga_vertex_t)
 #define DRM_IOCTL_MGA_FLUSH   DRM_IOW( 0x45, drm_lock_t )
 #define DRM_IOCTL_MGA_INDICES DRM_IOW( 0x46, drm_mga_indices_t)
+#define DRM_IOCTL_MGA_BLIT    DRM_IOW( 0x47, drm_mga_blit_t)
 
 /* I810 specific ioctls */
 #define DRM_IOCTL_I810_INIT    DRM_IOW( 0x40, drm_i810_init_t)
diff --git a/linux/mga_drm.h b/linux/mga_drm.h
index 52cf7766..53813393 100644
--- a/linux/mga_drm.h
+++ b/linux/mga_drm.h
@@ -271,4 +271,14 @@ typedef struct _drm_mga_indices {
 	int discard;		/* client finished with buffer?  */
 } drm_mga_indices_t;
 
+typedef struct _drm_mga_blit {
+	unsigned int planemask;
+	unsigned int source;
+	unsigned int dest;
+	int delta_sx, delta_sy;
+	int delta_dx, delta_dy;
+	int height, ydir;		/* flip image vertically */
+	int source_pitch, dest_pitch;
+} drm_mga_blit_t;
+
 #endif
diff --git a/linux/mga_drv.c b/linux/mga_drv.c
index 883eb75c..e898ee3d 100644
--- a/linux/mga_drv.c
+++ b/linux/mga_drv.c
@@ -38,7 +38,7 @@
 #define MGA_DESC	 "Matrox G200/G400"
 #define MGA_DATE	 "20000928"
 #define MGA_MAJOR	 2
-#define MGA_MINOR	 0
+#define MGA_MINOR	 1
 #define MGA_PATCHLEVEL	 1
 
 static drm_device_t	      mga_device;
@@ -114,6 +114,7 @@ static drm_ioctl_desc_t	      mga_ioctls[] = {
    	[DRM_IOCTL_NR(DRM_IOCTL_MGA_VERTEX)]  = { mga_vertex,      1, 0 },
    	[DRM_IOCTL_NR(DRM_IOCTL_MGA_FLUSH)]   = { mga_flush_ioctl, 1, 0 },
    	[DRM_IOCTL_NR(DRM_IOCTL_MGA_INDICES)] = { mga_indices,     1, 0 },
+     	[DRM_IOCTL_NR(DRM_IOCTL_MGA_BLIT)]    = { mga_blit,        1, 0 }, 
 };
 
 #define MGA_IOCTL_COUNT DRM_ARRAY_SIZE(mga_ioctls)
diff --git a/linux/mga_drv.h b/linux/mga_drv.h
index e37cc2ef..15f7a989 100644
--- a/linux/mga_drv.h
+++ b/linux/mga_drv.h
@@ -160,6 +160,8 @@ extern int  mga_vertex(struct inode *inode, struct file *filp,
 		      unsigned int cmd, unsigned long arg);
 extern int  mga_indices(struct inode *inode, struct file *filp,
 			unsigned int cmd, unsigned long arg);
+extern int  mga_blit(struct inode *inode, struct file *filp,
+			unsigned int cmd, unsigned long arg);
 				/* mga_context.c */
 extern int  mga_resctx(struct inode *inode, struct file *filp,
 		       unsigned int cmd, unsigned long arg);
@@ -339,6 +341,7 @@ drm_mga_prim_buf_t *tmp_buf = 					\
 #define MGAREG_SECEND 				0x2c44
 #define MGAREG_SETUPADDRESS 			0x2cd0
 #define MGAREG_SETUPEND 			0x2cd4
+#define	MGAREG_SGN		                0x1c58
 #define MGAREG_SOFTRAP				0x2c48
 #define MGAREG_SRCORG 				0x2cb4
 #define MGAREG_STATUS 				0x1e14
@@ -497,6 +500,12 @@ drm_mga_prim_buf_t *tmp_buf = 					\
 #define DC_clipdis_enable 			0x80000000
 
 
+#define SO_srcacc_pci 		0x0 		
+#define SO_srcacc_agp 		0x2 		
+#define SO_srcmap_fb 		0x0 		
+#define SO_srcmap_sys 		0x1 		
+
+
 #define SETADD_mode_vertlist                   	0x0
 
 
diff --git a/linux/mga_state.c b/linux/mga_state.c
index 6ac3d605..bba8fa35 100644
--- a/linux/mga_state.c
+++ b/linux/mga_state.c
@@ -491,6 +491,8 @@ static void mga_dma_dispatch_tex_blit(drm_device_t * dev,
 				      int length, unsigned int destOrg)
 {
 	drm_mga_private_t *dev_priv = dev->dev_private;
+	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
+	unsigned int *regs = sarea_priv->ContextState;
 	int use_agp = PDEA_pagpxfer_enable | 0x00000001;
 	u16 y2;
 	PRIMLOCALS;
@@ -505,7 +507,7 @@ static void mga_dma_dispatch_tex_blit(drm_device_t * dev,
 	PRIMOUTREG(MGAREG_AR5, 64);
 
 	PRIMOUTREG(MGAREG_PITCH, 64);
-	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_PLNWT, ~0);
 	PRIMOUTREG(MGAREG_DMAPAD, 0);
 	PRIMOUTREG(MGAREG_DWGCTL, MGA_COPY_CMD);
 
@@ -514,7 +516,7 @@ static void mga_dma_dispatch_tex_blit(drm_device_t * dev,
 	PRIMOUTREG(MGAREG_FXBNDRY, (63 << 16));
 	PRIMOUTREG(MGAREG_YDSTLEN + MGAREG_MGA_EXEC, y2);
 
-	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_PLNWT, regs[MGA_CTXREG_PLNWT]);
 	PRIMOUTREG(MGAREG_SRCORG, 0);
 	PRIMOUTREG(MGAREG_PITCH, dev_priv->stride / dev_priv->cpp);
 	PRIMOUTREG(MGAREG_DWGSYNC, 0x7000);
@@ -691,7 +693,7 @@ static void mga_dma_dispatch_clear(drm_device_t * dev, int flags,
 	/* Force reset of DWGCTL */
 	PRIMOUTREG(MGAREG_DMAPAD, 0);
 	PRIMOUTREG(MGAREG_DMAPAD, 0);
-	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_PLNWT, regs[MGA_CTXREG_PLNWT]);
 	PRIMOUTREG(MGAREG_DWGCTL, regs[MGA_CTXREG_DWGCTL]);
 	PRIMADVANCE(dev_priv);
 }
@@ -722,7 +724,7 @@ static void mga_dma_dispatch_swap(drm_device_t * dev)
 
 	PRIMOUTREG(MGAREG_DMAPAD, 0);
 	PRIMOUTREG(MGAREG_DMAPAD, 0);
-	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_PLNWT, ~0);
 	PRIMOUTREG(MGAREG_DWGCTL, MGA_COPY_CMD);
 
 	for (i = 0; i < nbox; i++) {
@@ -739,13 +741,141 @@ static void mga_dma_dispatch_swap(drm_device_t * dev)
 
 	/* Force reset of DWGCTL */
 	PRIMOUTREG(MGAREG_DMAPAD, 0);
-	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_PLNWT, regs[MGA_CTXREG_PLNWT]);
 	PRIMOUTREG(MGAREG_SRCORG, 0);
 	PRIMOUTREG(MGAREG_DWGCTL, regs[MGA_CTXREG_DWGCTL]);
 
 	PRIMADVANCE(dev_priv);
 }
 
+/*  #define BLIT_LEFT	1 */
+/*  #define BLIT_UP		4 */
+
+static void mga_dma_dispatch_blit(drm_device_t * dev,
+				  unsigned int planemask,
+				  unsigned int source,
+				  unsigned int dest,
+				  int delta_sx, int delta_sy,
+				  int delta_dx, int delta_dy,
+				  int source_pitch,
+				  int dest_pitch,
+				  int height,
+				  int ydir)
+{
+	drm_mga_private_t *dev_priv = dev->dev_private;
+	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
+	unsigned int *regs = sarea_priv->ContextState;
+	int nbox = sarea_priv->nbox;
+	drm_clip_rect_t *pbox = sarea_priv->boxes;
+	int pixel_stride = dev_priv->stride / dev_priv->cpp;
+	u32 scandir = 0, i;
+	
+	PRIMLOCALS;	   
+
+	PRIM_OVERFLOW(dev, dev_priv, (MGA_NR_SAREA_CLIPRECTS * 5) + 20);
+
+	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_DWGSYNC, 0x7100);
+	PRIMOUTREG(MGAREG_DWGSYNC, 0x7000);
+
+	PRIMOUTREG(MGAREG_DWGCTL, MGA_COPY_CMD);
+	PRIMOUTREG(MGAREG_PLNWT, planemask);
+	PRIMOUTREG(MGAREG_SRCORG, source);
+	PRIMOUTREG(MGAREG_DSTORG, dest);
+
+	PRIMOUTREG(MGAREG_SGN, scandir);
+	PRIMOUTREG(MGAREG_MACCESS, dev_priv->mAccess);
+	PRIMOUTREG(MGAREG_AR5, ydir * source_pitch);	    
+	PRIMOUTREG(MGAREG_PITCH, dest_pitch);
+
+	for (i = 0; i < nbox; i++) {
+		int srcx = pbox[i].x1 + delta_sx;
+		int srcy = pbox[i].y1 + delta_sy;
+		int dstx = pbox[i].x1 + delta_dx;
+		int dsty = pbox[i].y1 + delta_dy;
+		int h = pbox[i].y2 - pbox[i].y1;
+		int w = pbox[i].x2 - pbox[i].x1 - 1;
+		int start;
+
+		if (ydir == -1) {
+			srcy = height - srcy - 1;
+		}
+
+		start = srcy * source_pitch + srcx;
+
+		PRIMOUTREG(MGAREG_AR0, start + w);
+		PRIMOUTREG(MGAREG_AR3, start);
+		PRIMOUTREG(MGAREG_FXBNDRY, ((dstx+w) << 16) | (dstx & 0xffff));
+		PRIMOUTREG(MGAREG_YDSTLEN + MGAREG_MGA_EXEC, (dsty << 16) | h);
+	}
+
+	/* Do something to flush AGP?
+	 */
+
+	/* Force reset of DWGCTL */
+	PRIMOUTREG(MGAREG_DMAPAD, 0);
+	PRIMOUTREG(MGAREG_PLNWT, regs[MGA_CTXREG_PLNWT]);
+	PRIMOUTREG(MGAREG_PITCH, pixel_stride);
+	PRIMOUTREG(MGAREG_DWGCTL, regs[MGA_CTXREG_DWGCTL]);
+
+	PRIMADVANCE(dev_priv);
+}
+
+
+int mga_blit(struct inode *inode, struct file *filp,
+	     unsigned int cmd, unsigned long arg)
+{
+	drm_file_t *priv = filp->private_data;
+	drm_device_t *dev = priv->dev;
+	drm_mga_private_t *dev_priv =
+	    (drm_mga_private_t *) dev->dev_private;
+	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
+	drm_mga_blit_t blit;
+
+	if (copy_from_user(&blit, (drm_mga_blit_t *) arg, sizeof(blit)))
+		return -EFAULT;
+		
+	DRM_DEBUG("%s\n", __FUNCTION__);
+
+	if (!_DRM_LOCK_IS_HELD(dev->lock.hw_lock->lock)) {
+		DRM_ERROR("mga_blit_bufs called without lock held\n");
+		return -EINVAL;
+	}
+
+	if (sarea_priv->nbox > MGA_NR_SAREA_CLIPRECTS)
+		sarea_priv->nbox = MGA_NR_SAREA_CLIPRECTS;
+
+	/* Make sure we restore the 3D state next time.
+	 */
+	dev_priv->sarea_priv->dirty |= MGA_UPLOAD_CTX;
+	
+  	if ((blit.source & 0x3) != (SO_srcmap_sys|SO_srcacc_pci) &&
+	    (blit.dest & 0x3) != (SO_srcmap_sys|SO_srcacc_pci))
+	{
+	   mga_dma_dispatch_blit(dev,
+				 blit.planemask, 
+				 blit.source,
+				 blit.dest,
+				 blit.delta_sx, blit.delta_sy,
+				 blit.delta_dx, blit.delta_dy,
+				 blit.source_pitch,
+				 blit.dest_pitch,
+				 blit.height,
+				 blit.ydir);
+	}
+
+
+	PRIMUPDATE(dev_priv);
+
+#ifdef __i386__
+	mga_flush_write_combine();
+#endif
+	mga_dma_schedule(dev, 1);
+	return 0;
+}
+
+
 int mga_clear_bufs(struct inode *inode, struct file *filp,
 		   unsigned int cmd, unsigned long arg)
 {
diff --git a/shared-core/drm.h b/shared-core/drm.h
index 20691ccf..cdc058af 100644
--- a/shared-core/drm.h
+++ b/shared-core/drm.h
@@ -350,6 +350,7 @@ typedef struct drm_agp_info {
 #define DRM_IOCTL_MGA_VERTEX  DRM_IOW( 0x44, drm_mga_vertex_t)
 #define DRM_IOCTL_MGA_FLUSH   DRM_IOW( 0x45, drm_lock_t )
 #define DRM_IOCTL_MGA_INDICES DRM_IOW( 0x46, drm_mga_indices_t)
+#define DRM_IOCTL_MGA_BLIT    DRM_IOW( 0x47, drm_mga_blit_t)
 
 /* I810 specific ioctls */
 #define DRM_IOCTL_I810_INIT    DRM_IOW( 0x40, drm_i810_init_t)
diff --git a/shared/drm.h b/shared/drm.h
index 20691ccf..cdc058af 100644
--- a/shared/drm.h
+++ b/shared/drm.h
@@ -350,6 +350,7 @@ typedef struct drm_agp_info {
 #define DRM_IOCTL_MGA_VERTEX  DRM_IOW( 0x44, drm_mga_vertex_t)
 #define DRM_IOCTL_MGA_FLUSH   DRM_IOW( 0x45, drm_lock_t )
 #define DRM_IOCTL_MGA_INDICES DRM_IOW( 0x46, drm_mga_indices_t)
+#define DRM_IOCTL_MGA_BLIT    DRM_IOW( 0x47, drm_mga_blit_t)
 
 /* I810 specific ioctls */
 #define DRM_IOCTL_I810_INIT    DRM_IOW( 0x40, drm_i810_init_t)