Mercurial > vba-clojure

     1 #include "../Port.h"

     2 #include "hq_shared32.h"

     3 #include "interp.h"

     4 

     5 #define SIZE_PIXEL 2 // 16bit = 2 bytes

     6 #define PIXELTYPE unsigned short

     7 #define Interp1 Interp1_16

     8 #define Interp2 Interp2_16

     9 #define Interp3 Interp3_16

    10 #define Interp4 Interp4_16

    11 #define Interp5 Interp5_16

    12 

    13 void hq3x(unsigned char *pIn,  unsigned int srcPitch,

    14           unsigned char *,

    15           unsigned char *pOut, unsigned int dstPitch,

    16           int Xres, int Yres)

    17 {

    18 	int i, j;

    19 	unsigned int line;

    20 	PIXELTYPE	 c[10];

    21 

    22 	// +----+----+----+

    23 	// |    |    |    |

    24 	// | c1 | c2 | c3 |

    25 	// +----+----+----+

    26 	// |    |    |    |

    27 	// | c4 | c5 | c6 |

    28 	// +----+----+----+

    29 	// |    |    |    |

    30 	// | c7 | c8 | c9 |

    31 	// +----+----+----+

    32 

    33 	for (j = 0; j < Yres; j++)

    34 	{

    35 		if ((j > 0) || (j < Yres - 1))

    36 			line = srcPitch;

    37 		else

    38 			line = 0;

    39 

    40 		for (i = 0; i < Xres; i++)

    41 		{

    42 			c[2] = *((PIXELTYPE *)(pIn - line));

    43 			c[5] = *((PIXELTYPE *)(pIn));

    44 			c[8] = *((PIXELTYPE *)(pIn + line));

    45 

    46 			if (i > 0)

    47 			{

    48 				c[1] = *((PIXELTYPE *)(pIn - line - SIZE_PIXEL));

    49 				c[4] = *((PIXELTYPE *)(pIn        - SIZE_PIXEL));

    50 				c[7] = *((PIXELTYPE *)(pIn + line - SIZE_PIXEL));

    51 			}

    52 			else

    53 			{

    54 				c[1] = c[2];

    55 				c[4] = c[5];

    56 				c[7] = c[8];

    57 			}

    58 

    59 			if (i < Xres - 1)

    60 			{

    61 				c[3] = *((PIXELTYPE *)(pIn - line + SIZE_PIXEL));

    62 				c[6] = *((PIXELTYPE *)(pIn        + SIZE_PIXEL));

    63 				c[9] = *((PIXELTYPE *)(pIn + line + SIZE_PIXEL));

    64 			}

    65 			else

    66 			{

    67 				c[3] = c[2];

    68 				c[6] = c[5];

    69 				c[9] = c[8];

    70 			}

    71 

    72 			int pattern = 0;

    73 

    74 			if (interp_16_diff(c[1], c[5]))

    75 				pattern |= 1 << 0;

    76 			if (interp_16_diff(c[2], c[5]))

    77 				pattern |= 1 << 1;

    78 			if (interp_16_diff(c[3], c[5]))

    79 				pattern |= 1 << 2;

    80 			if (interp_16_diff(c[4], c[5]))

    81 				pattern |= 1 << 3;

    82 			if (interp_16_diff(c[6], c[5]))

    83 				pattern |= 1 << 4;

    84 			if (interp_16_diff(c[7], c[5]))

    85 				pattern |= 1 << 5;

    86 			if (interp_16_diff(c[8], c[5]))

    87 				pattern |= 1 << 6;

    88 			if (interp_16_diff(c[9], c[5]))

    89 				pattern |= 1 << 7;

    90 

    91 #define Diff interp_16_diff

    92 #include "hq3x32.h"

    93 #undef Diff

    94 			pIn	 += SIZE_PIXEL;

    95 			pOut += 3 << 1;

    96 		}

    97 		pIn	 += srcPitch - (Xres << 1);

    98 		pOut += dstPitch - (3 * Xres << 1);

    99 		pOut += dstPitch << 1;

   100 		//	pIn+=SIZE_PIXEL;

   101 		//	pOut+=3*SIZE_PIXEL;

   102 		//}

   103 		//pIn+=srcPitch-(4*Xres);

   104 		//pOut+=dstPitch-(3*Xres*SIZE_PIXEL);

   105 		//pOut+=2*dstPitch;

   106 	}

   107 }

   108 

   109 void hq3xS(unsigned char *pIn,  unsigned int srcPitch,

   110            unsigned char *,

   111            unsigned char *pOut, unsigned int dstPitch,

   112            int Xres, int Yres)

   113 {

   114 	int i, j;

   115 	PIXELTYPE c[10];

   116 

   117 	// +----+----+----+

   118 	// |    |    |    |

   119 	// | c1 | c2 | c3 |

   120 	// +----+----+----+

   121 	// |    |    |    |

   122 	// | c4 | c5 | c6 |

   123 	// +----+----+----+

   124 	// |    |    |    |

   125 	// | c7 | c8 | c9 |

   126 	// +----+----+----+

   127 

   128 	for (j = 0; j < Yres; j++)

   129 	{

   130 		for (i = 0; i < Xres; i++)

   131 		{

   132 			c[2] = *((PIXELTYPE *)(pIn - srcPitch));

   133 			c[5] = *((PIXELTYPE *)(pIn));

   134 			c[8] = *((PIXELTYPE *)(pIn + srcPitch));

   135 

   136 			c[1] = *((PIXELTYPE *)(pIn - srcPitch - SIZE_PIXEL));

   137 			c[4] = *((PIXELTYPE *)(pIn        - SIZE_PIXEL));

   138 			c[7] = *((PIXELTYPE *)(pIn + srcPitch - SIZE_PIXEL));

   139 

   140 			c[3] = *((PIXELTYPE *)(pIn - srcPitch + SIZE_PIXEL));

   141 			c[6] = *((PIXELTYPE *)(pIn        + SIZE_PIXEL));

   142 			c[9] = *((PIXELTYPE *)(pIn + srcPitch + SIZE_PIXEL));

   143 

   144 			int pattern = 0;

   145 

   146 			// hq3xS dynamic edge detection:

   147 			// simply comparing the center color against its surroundings will give bad results in many cases,

   148 			// so, instead, compare the center color relative to the max difference in brightness of this 3x3 block

   149 			int brightArray[10];

   150 			int maxBright = 0, minBright = 999999;

   151 			for (int j = 1; j < 10; j++)

   152 			{

   153 				int r, g, b;

   154 				if (interp_bits_per_pixel == 16)

   155 				{

   156 					b = (int)((c[j] & 0x1F)) << 3;

   157 					g = (int)((c[j] & 0x7E0)) >> 3;

   158 					r = (int)((c[j] & 0xF800)) >> 8;

   159 				}

   160 				else

   161 				{

   162 					b = (int)((c[j] & 0x1F)) << 3;

   163 					g = (int)((c[j] & 0x3E0)) >> 2;

   164 					r = (int)((c[j] & 0x7C00)) >> 7;

   165 				}

   166 				const int bright = r + r + r + g + g + g + b + b;

   167 				if (bright > maxBright) maxBright = bright;

   168 				if (bright < minBright) minBright = bright;

   169 

   170 				brightArray[j] = bright;

   171 			}

   172 			const int diffBright = ((maxBright - minBright) * 7) >> 4;

   173 			if (diffBright > 7)

   174 			{

   175 				#define ABS(x) ((x) < 0 ? -(x) : (x))

   176 

   177 				const int centerBright = brightArray[5];

   178 				if (ABS(brightArray[1] - centerBright) > diffBright)

   179 					pattern |= 1 << 0;

   180 				if (ABS(brightArray[2] - centerBright) > diffBright)

   181 					pattern |= 1 << 1;

   182 				if (ABS(brightArray[3] - centerBright) > diffBright)

   183 					pattern |= 1 << 2;

   184 				if (ABS(brightArray[4] - centerBright) > diffBright)

   185 					pattern |= 1 << 3;

   186 				if (ABS(brightArray[6] - centerBright) > diffBright)

   187 					pattern |= 1 << 4;

   188 				if (ABS(brightArray[7] - centerBright) > diffBright)

   189 					pattern |= 1 << 5;

   190 				if (ABS(brightArray[8] - centerBright) > diffBright)

   191 					pattern |= 1 << 6;

   192 				if (ABS(brightArray[9] - centerBright) > diffBright)

   193 					pattern |= 1 << 7;

   194 			}

   195 

   196 #define Diff(x, y) false //(ABS((x) - (y)) > diffBright)

   197 #undef cget

   198 #define cget(x) brightArray[x]

   199 #include "hq3x32.h"

   200 #undef cget

   201 #undef Diff

   202 			pIn	 += SIZE_PIXEL;

   203 			pOut += 3 << 1;

   204 		}

   205 		pIn	 += srcPitch - (Xres << 1);

   206 		pOut += dstPitch - (3 * Xres << 1);

   207 		pOut += dstPitch << 1;

   208 		//	pIn+=SIZE_PIXEL;

   209 		//	pOut+=3*SIZE_PIXEL;

   210 		//}

   211 		//pIn+=srcPitch-(4*Xres);

   212 		//pOut+=dstPitch-(3*Xres*SIZE_PIXEL);

   213 		//pOut+=2*dstPitch;

   214 	}

   215 }

   216 

   217 #undef Interp1

   218 #undef Interp2

   219 #undef Interp3

   220 #undef Interp4

   221 #undef Interp5

   222 #undef SIZE_PIXEL

   223 #undef PIXELTYPE

   224 #define SIZE_PIXEL 4 // 32bit = 4 bytes

   225 #define PIXELTYPE unsigned int

   226 

   227 void hq3x32(unsigned char *pIn,  unsigned int srcPitch,

   228             unsigned char *,

   229             unsigned char *pOut, unsigned int dstPitch,

   230             int Xres, int Yres)

   231 {

   232 	unsigned int YUV1, YUV2;

   233 	int i, j, k;

   234 	unsigned int line;

   235 	PIXELTYPE c[10];

   236 

   237 	// +----+----+----+

   238 	// |    |    |    |

   239 	// | c1 | c2 | c3 |

   240 	// +----+----+----+

   241 	// |    |    |    |

   242 	// | c4 | c5 | c6 |

   243 	// +----+----+----+

   244 	// |    |    |    |

   245 	// | c7 | c8 | c9 |

   246 	// +----+----+----+

   247 

   248 	for (j = 0; j < Yres; j++)

   249 	{

   250 		if ((j > 0) && (j < Yres - 1))

   251 			line = srcPitch;

   252 		else

   253 			line = 0;

   254 

   255 		for (i = 0; i < Xres; i++)

   256 		{

   257 			c[2] = *((PIXELTYPE *)(pIn - line));

   258 			c[5] = *((PIXELTYPE *)(pIn));

   259 			c[8] = *((PIXELTYPE *)(pIn + line));

   260 

   261 			if (i > 0)

   262 			{

   263 				c[1] = *((PIXELTYPE *)(pIn - line - SIZE_PIXEL));

   264 				c[4] = *((PIXELTYPE *)(pIn        - SIZE_PIXEL));

   265 				c[7] = *((PIXELTYPE *)(pIn + line - SIZE_PIXEL));

   266 			}

   267 			else

   268 			{

   269 				c[1] = c[2];

   270 				c[4] = c[5];

   271 				c[7] = c[8];

   272 			}

   273 

   274 			if (i < Xres - 1)

   275 			{

   276 				c[3] = *((PIXELTYPE *)(pIn - line + SIZE_PIXEL));

   277 				c[6] = *((PIXELTYPE *)(pIn        + SIZE_PIXEL));

   278 				c[9] = *((PIXELTYPE *)(pIn + line + SIZE_PIXEL));

   279 			}

   280 			else

   281 			{

   282 				c[3] = c[2];

   283 				c[6] = c[5];

   284 				c[9] = c[8];

   285 			}

   286 

   287 			int pattern = 0;

   288 			int flag	= 1;

   289 

   290 			YUV1 = RGBtoYUV(c[5]);

   291 

   292 			for (k = 1; k <= 9; k++)

   293 			{

   294 				if (k == 5) continue;

   295 

   296 				if (c[k] != c[5])

   297 				{

   298 					YUV2 = RGBtoYUV(c[k]);

   299 					if (

   300 					    (abs32((YUV1 & Ymask) - (YUV2 & Ymask)) > trY) ||

   301 					    (abs32((YUV1 & Umask) - (YUV2 & Umask)) > trU) ||

   302 					    (abs32((YUV1 & Vmask) - (YUV2 & Vmask)) > trV)

   303 					    )

   304 						pattern |= flag;

   305 				}

   306 				flag <<= 1;

   307 			}

   308 

   309 #include "hq3x32.h"

   310 			pIn	 += SIZE_PIXEL;

   311 			pOut += 3 << 2;

   312 		}

   313 		pIn	 += srcPitch - (Xres << 2);

   314 		pOut += dstPitch - (3 * Xres << 2);

   315 		pOut += dstPitch << 1;

   316 		//	pIn+=SIZE_PIXEL;

   317 		//	pOut+=3*SIZE_PIXEL;

   318 		//}

   319 		//pIn+=srcPitch-(4*Xres);

   320 		//pOut+=dstPitch-(3*Xres*SIZE_PIXEL);

   321 		//pOut+=2*dstPitch;

   322 	}

   323 }

   324 

   325 void hq3xS32(unsigned char *pIn,  unsigned int srcPitch,

   326              unsigned char *,

   327              unsigned char *pOut, unsigned int dstPitch,

   328              int Xres, int Yres)

   329 {

   330 	int i, j;

   331 	unsigned int line;

   332 	PIXELTYPE c[10];

   333 

   334 	// +----+----+----+

   335 	// |    |    |    |

   336 	// | c1 | c2 | c3 |

   337 	// +----+----+----+

   338 	// |    |    |    |

   339 	// | c4 | c5 | c6 |

   340 	// +----+----+----+

   341 	// |    |    |    |

   342 	// | c7 | c8 | c9 |

   343 	// +----+----+----+

   344 

   345 	for (j = 0; j < Yres; j++)

   346 	{

   347 		if ((j > 0) && (j < Yres - 1))

   348 			line = srcPitch;

   349 		else

   350 			line = 0;

   351 

   352 		for (i = 0; i < Xres; i++)

   353 		{

   354 			c[2] = *((PIXELTYPE *)(pIn - line));

   355 			c[5] = *((PIXELTYPE *)(pIn));

   356 			c[8] = *((PIXELTYPE *)(pIn + line));

   357 

   358 			if (i > 0)

   359 			{

   360 				c[1] = *((PIXELTYPE *)(pIn - line - SIZE_PIXEL));

   361 				c[4] = *((PIXELTYPE *)(pIn        - SIZE_PIXEL));

   362 				c[7] = *((PIXELTYPE *)(pIn + line - SIZE_PIXEL));

   363 			}

   364 			else

   365 			{

   366 				c[1] = c[2];

   367 				c[4] = c[5];

   368 				c[7] = c[8];

   369 			}

   370 

   371 			if (i < Xres - 1)

   372 			{

   373 				c[3] = *((PIXELTYPE *)(pIn - line + SIZE_PIXEL));

   374 				c[6] = *((PIXELTYPE *)(pIn        + SIZE_PIXEL));

   375 				c[9] = *((PIXELTYPE *)(pIn + line + SIZE_PIXEL));

   376 			}

   377 			else

   378 			{

   379 				c[3] = c[2];

   380 				c[6] = c[5];

   381 				c[9] = c[8];

   382 			}

   383 

   384 			int pattern = 0;

   385 

   386 			// hq3xS dynamic edge detection:

   387 			// simply comparing the center color against its surroundings will give bad results in many cases,

   388 			// so, instead, compare the center color relative to the max difference in brightness of this 3x3 block

   389 			int brightArray[10];

   390 			int maxBright = 0, minBright = 999999;

   391 			for (int j = 1; j < 10; j++)

   392 			{

   393 				const int b		 = (int)((c[j] & 0xF8));

   394 				const int g		 = (int)((c[j] & 0xF800)) >> 8;

   395 				const int r		 = (int)((c[j] & 0xF80000)) >> 16;

   396 				const int bright = r + r + r + g + g + g + b + b;

   397 				if (bright > maxBright) maxBright = bright;

   398 				if (bright < minBright) minBright = bright;

   399 

   400 				brightArray[j] = bright;

   401 			}

   402 			int diffBright = ((maxBright - minBright) * 7) >> 4;

   403 			if (diffBright > 7)

   404 			{

   405 				#define ABS(x) ((x) < 0 ? -(x) : (x))

   406 

   407 				const int centerBright = brightArray[5];

   408 				if (ABS(brightArray[1] - centerBright) > diffBright)

   409 					pattern |= 1 << 0;

   410 				if (ABS(brightArray[2] - centerBright) > diffBright)

   411 					pattern |= 1 << 1;

   412 				if (ABS(brightArray[3] - centerBright) > diffBright)

   413 					pattern |= 1 << 2;

   414 				if (ABS(brightArray[4] - centerBright) > diffBright)

   415 					pattern |= 1 << 3;

   416 				if (ABS(brightArray[6] - centerBright) > diffBright)

   417 					pattern |= 1 << 4;

   418 				if (ABS(brightArray[7] - centerBright) > diffBright)

   419 					pattern |= 1 << 5;

   420 				if (ABS(brightArray[8] - centerBright) > diffBright)

   421 					pattern |= 1 << 6;

   422 				if (ABS(brightArray[9] - centerBright) > diffBright)

   423 					pattern |= 1 << 7;

   424 			}

   425 

   426 #define Diff(x, y) false //(ABS((x) - (y)) > diffBright)

   427 #undef cget

   428 #define cget(x) brightArray[x]

   429 #include "hq3x32.h"

   430 #undef cget

   431 #undef Diff

   432 			pIn	 += SIZE_PIXEL;

   433 			pOut += 3 << 2;

   434 		}

   435 		pIn	 += srcPitch - (Xres << 2);

   436 		pOut += dstPitch - (3 * Xres << 2);

   437 		pOut += dstPitch << 1;

   438 		//	pIn+=SIZE_PIXEL;

   439 		//	pOut+=3*SIZE_PIXEL;

   440 		//}

   441 		//pIn+=srcPitch-(4*Xres);

   442 		//pOut+=dstPitch-(3*Xres*SIZE_PIXEL);

   443 		//pOut+=2*dstPitch;

   444 	}

   445 }
author	Robert McIntyre <rlm@mit.edu>
date	Sat, 01 Sep 2012 09:54:48 -0500
parents	f9f4f1b99eed
children