X-Git-Url: http://git.mutantstargoat.com/user/nuclear/?p=dosdemo;a=blobdiff_plain;f=src%2Fgfxutil.c;h=d4107667543680024e5653f8524f9fe9bfd3fd9d;hp=811915ed7530b09156bae68d5d85c9ac52ea73a3;hb=b49854e0980a030cc8338a7f4ee779ecde1aae38;hpb=13f4229ee540e22a5f3ede4d345ae1269cd708d3

diff --git a/src/gfxutil.c b/src/gfxutil.c
index 811915e..d410766 100644
--- a/src/gfxutil.c
+++ b/src/gfxutil.c
@@ -1,5 +1,6 @@
-#include "gfxutil.h"
+#include <string.h>
 #include "demo.h"
+#include "gfxutil.h"
 
 enum {
 	IN		= 0,
@@ -100,7 +101,7 @@ void draw_line(int x0, int y0, int x1, int y1, unsigned short color)
 	int i, dx, dy, x_inc, y_inc, error;
 	unsigned short *fb = fb_pixels;
 
-	fb += y0 * fb_width + x0;
+	fb += y0 * FB_WIDTH + x0;
 
 	dx = x1 - x0;
 	dy = y1 - y0;
@@ -112,9 +113,9 @@ void draw_line(int x0, int y0, int x1, int y1, unsigned short color)
 		dx = -dx;
 	}
 	if(dy >= 0) {
-		y_inc = fb_width;
+		y_inc = FB_WIDTH;
 	} else {
-		y_inc = -fb_width;
+		y_inc = -FB_WIDTH;
 		dy = -dy;
 	}
 
@@ -144,45 +145,135 @@ void draw_line(int x0, int y0, int x1, int y1, unsigned short color)
 }
 
 
+#define BLUR(w, h, pstep, sstep) \
+	for(i=0; i<h; i++) { \
+		int r, g, b; \
+		int rsum = UNPACK_R16(sptr[0]) * (rad + 1); \
+		int gsum = UNPACK_G16(sptr[0]) * (rad + 1); \
+		int bsum = UNPACK_B16(sptr[0]) * (rad + 1); \
+		int count = (rad * 2 + 1) << 8; \
+		int midsize = w - rad * 2; \
+		int rfirstpix = UNPACK_R16(sptr[0]); \
+		int rlastpix = UNPACK_R16(sptr[pstep * (w - 1)]); \
+		int gfirstpix = UNPACK_G16(sptr[0]); \
+		int glastpix = UNPACK_G16(sptr[pstep * (w - 1)]); \
+		int bfirstpix = UNPACK_B16(sptr[0]); \
+		int blastpix = UNPACK_B16(sptr[pstep * (w - 1)]); \
+		/* add up the contributions for the -1 pixel */ \
+		for(j=0; j<rad; j++) { \
+			rsum += UNPACK_R16(sptr[pstep * j]); \
+			gsum += UNPACK_G16(sptr[pstep * j]); \
+			bsum += UNPACK_B16(sptr[pstep * j]); \
+		} \
+		/* first part adding sptr[rad] and subtracting sptr[0] */ \
+		for(j=0; j<=rad; j++) { \
+			rsum += UNPACK_R16((int)sptr[pstep * rad]) - rfirstpix; \
+			gsum += UNPACK_G16((int)sptr[pstep * rad]) - gfirstpix; \
+			bsum += UNPACK_B16((int)sptr[pstep * rad]) - bfirstpix; \
+			sptr += pstep; \
+			r = scale * rsum / count; \
+			g = scale * gsum / count; \
+			b = scale * bsum / count; \
+			*dptr = PACK_RGB16(r, g, b); \
+			dptr += pstep; \
+		} \
+		/* middle part adding sptr[rad] and subtracting sptr[-(rad+1)] */ \
+		for(j=1; j<midsize; j++) { \
+			rsum += UNPACK_R16((int)sptr[pstep * rad]) - UNPACK_R16((int)sptr[-(rad + 1) * pstep]); \
+			gsum += UNPACK_G16((int)sptr[pstep * rad]) - UNPACK_G16((int)sptr[-(rad + 1) * pstep]); \
+			bsum += UNPACK_B16((int)sptr[pstep * rad]) - UNPACK_B16((int)sptr[-(rad + 1) * pstep]); \
+			sptr += pstep; \
+			r = scale * rsum / count; \
+			g = scale * gsum / count; \
+			b = scale * bsum / count; \
+			*dptr = PACK_RGB16(r, g, b); \
+			dptr += pstep; \
+		} \
+		/* last part adding lastpix and subtracting sptr[-(rad+1)] */ \
+		for(j=0; j<rad; j++) { \
+			rsum += rlastpix - UNPACK_R16((int)sptr[-(rad + 1) * pstep]); \
+			gsum += glastpix - UNPACK_G16((int)sptr[-(rad + 1) * pstep]); \
+			bsum += blastpix - UNPACK_B16((int)sptr[-(rad + 1) * pstep]); \
+			sptr += pstep; \
+			r = scale * rsum / count; \
+			g = scale * gsum / count; \
+			b = scale * bsum / count; \
+			*dptr = PACK_RGB16(r, g, b); \
+			dptr += pstep; \
+		} \
+		sptr += sstep; \
+		dptr += sstep; \
+	}
+
 /* TODO bound blur rad to image size to avoid inner loop conditionals */
 /* TODO make version with pow2 (rad*2+1) to avoid div with count everywhere */
-void blur_grey_horiz(uint16_t *dest, uint16_t *src, int xsz, int ysz, int rad)
+void blur_horiz(uint16_t *dest, uint16_t *src, int xsz, int ysz, int rad, int scale)
 {
 	int i, j;
+	uint16_t *dptr = dest;
+	uint16_t *sptr = src;
 
-	for(i=0; i<ysz; i++) {
-		int sum = src[0] * (rad + 1);
-		int count = rad * 2 + 1;
-		uint16_t lastpix = src[xsz - 1];
+	BLUR(xsz, ysz, 1, 0);
+}
 
-		/* add up the contributions for the -1 pixel */
-		for(j=0; j<rad; j++) {
-			sum += src[j];
-		}
 
-		/* first part adding src[rad] and subtracting src[0] */
-		for(j=0; j<rad; j++) {
-			sum += src[rad] - src[0];
-			++src;
-			*dest++ = sum / count;
-		}
+void blur_vert(uint16_t *dest, uint16_t *src, int xsz, int ysz, int rad, int scale)
+{
+	int i, j;
+	uint16_t *dptr = dest;
+	uint16_t *sptr = src;
+	int pixel_step = xsz;
+	int scanline_step = 1 - ysz * pixel_step;
 
-		/* middle part adding src[rad] and subtracting src[-(rad+1)] */
-		for(j=0; j<xsz - rad; j++) {
-			sum += src[rad] - src[-(rad + 1)];
-			++src;
-			*dest++ = sum / count;
-		}
+	BLUR(ysz, xsz, pixel_step, scanline_step);
+}
 
-		/* last part adding lastpix and subtracting src[-(rad+1)] */
-		for(j=0; j<rad; j++) {
-			sum += lastpix - src[-(rad + 1)];
-			++src;
-			*dest++ = sum / count;
-		}
+void convimg_rgb24_rgb16(uint16_t *dest, unsigned char *src, int xsz, int ysz)
+{
+	int i;
+	int npixels = xsz * ysz;
+
+	for(i=0; i<npixels; i++) {
+		int r = *src++;
+		int g = *src++;
+		int b = *src++;
+		*dest++ = PACK_RGB16(r, g, b);
 	}
 }
 
-void blur_grey_vert(uint16_t *dest, uint16_t *src, int xsz, int ysz, int radius)
+void blitfb(uint16_t *dest, uint16_t *src, int width, int height, int pitch_pix)
 {
+	int i;
+	for(i=0; i<height; i++) {
+		memcpy(dest, src, width << 1);
+		dest += 320;
+	}
+}
+
+void blit(uint16_t *dest, int destwidth, uint16_t *src, int width, int height, int pitch_pix)
+{
+	int i, spansz = width << 1;
+	for(i=0; i<height; i++) {
+		memcpy(dest, src, spansz);
+		dest += destwidth;
+		src += pitch_pix;
+	}
+}
+
+void blit_key(uint16_t *dest, int destwidth, uint16_t *src, int width, int height, int pitch_pix, uint16_t key)
+{
+	int i, j;
+	int dadv = destwidth - width;
+	int sadv = pitch_pix - width;
+
+	for(i=0; i<height; i++) {
+		for(j=0; j<width; j++) {
+			uint16_t scol = *src++;
+			if(scol != key) *dest = scol;
+			dest++;
+		}
+		dest += dadv;
+		src += sadv;
+	}
+
 }