Mercurial > vba-clojure

     1 /*

     2  * This file is part of the Advance project.

     3  *

     4  * Copyright (C) 1999-2002 Andrea Mazzoleni

     5  *

     6  * This program is free software; you can redistribute it and/or modify

     7  * it under the terms of the GNU General Public License as published by

     8  * the Free Software Foundation; either version 2 of the License, or

     9  * (at your option) any later version.

    10  *

    11  * This program is distributed in the hope that it will be useful,

    12  * but WITHOUT ANY WARRANTY; without even the implied warranty of

    13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    14  * GNU General Public License for more details.

    15  *

    16  * You should have received a copy of the GNU General Public License

    17  * along with this program; if not, write to the Free Software

    18  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

    19  *

    20  * In addition, as a special exception, Andrea Mazzoleni

    21  * gives permission to link the code of this program with

    22  * the MAME library (or with modified versions of MAME that use the

    23  * same license as MAME), and distribute linked combinations including

    24  * the two.  You must obey the GNU General Public License in all

    25  * respects for all of the code used other than MAME.  If you modify

    26  * this file, you may extend this exception to your version of the

    27  * file, but you are not obligated to do so.  If you do not wish to

    28  * do so, delete this exception statement from your version.

    29  */

    30 

    31 /*

    32  * Alternatively at the previous license terms, you are allowed to use this

    33  * code in your program with these conditions:

    34  * - the program is not used in commercial activities.

    35  * - the whole source code of the program is released with the binary.

    36  */

    37 

    38 #include "../Port.h"

    39 

    40 #ifdef MMX

    41 extern "C" bool cpu_mmx;

    42 #endif

    43 

    44 static void internal_scale2x_16_def(u16 *dst, const u16 *src0, const u16 *src1, const u16 *src2, unsigned count)

    45 {

    46 	/* first pixel */

    47 	dst[0] = src1[0];

    48 	if (src1[1] == src0[0] && src2[0] != src0[0])

    49 		dst[1] = src0[0];

    50 	else

    51 		dst[1] = src1[0];

    52 	++src0;

    53 	++src1;

    54 	++src2;

    55 	dst += 2;

    56 

    57 	/* central pixels */

    58 	count -= 2;

    59 	while (count)

    60 	{

    61 		if (src0[0] != src2[0] && src1[-1] != src1[1])

    62 		{

    63 			dst[0] = src1[-1] == src0[0] ? src0[0] : src1[0];

    64 			dst[1] = src1[1] == src0[0] ? src0[0] : src1[0];

    65 		}

    66 		else

    67 		{

    68 			dst[0] = src1[0];

    69 			dst[1] = src1[0];

    70 		}

    71 

    72 		++src0;

    73 		++src1;

    74 		++src2;

    75 		dst += 2;

    76 		--count;

    77 	}

    78 

    79 	/* last pixel */

    80 	if (src1[-1] == src0[0] && src2[0] != src0[0])

    81 		dst[0] = src0[0];

    82 	else

    83 		dst[0] = src1[0];

    84 	dst[1] = src1[0];

    85 }

    86 

    87 static void internal_scale2x_32_def(u32 *dst,

    88                                     const u32 *src0,

    89                                     const u32 *src1,

    90                                     const u32 *src2,

    91                                     unsigned count)

    92 {

    93 	/* first pixel */

    94 	dst[0] = src1[0];

    95 	if (src1[1] == src0[0] && src2[0] != src0[0])

    96 		dst[1] = src0[0];

    97 	else

    98 		dst[1] = src1[0];

    99 	++src0;

   100 	++src1;

   101 	++src2;

   102 	dst += 2;

   103 

   104 	/* central pixels */

   105 	count -= 2;

   106 	while (count)

   107 	{

   108 		if (src0[0] != src2[0] && src1[-1] != src1[1])

   109 		{

   110 			dst[0] = src1[-1] == src0[0] ? src0[0] : src1[0];

   111 			dst[1] = src1[1] == src0[0] ? src0[0] : src1[0];

   112 		}

   113 		else

   114 		{

   115 			dst[0] = src1[0];

   116 			dst[1] = src1[0];

   117 		}

   118 

   119 		++src0;

   120 		++src1;

   121 		++src2;

   122 		dst += 2;

   123 		--count;

   124 	}

   125 

   126 	/* last pixel */

   127 	if (src1[-1] == src0[0] && src2[0] != src0[0])

   128 		dst[0] = src0[0];

   129 	else

   130 		dst[0] = src1[0];

   131 	dst[1] = src1[0];

   132 }

   133 

   134 #ifdef MMX

   135 static void internal_scale2x_16_mmx_single(u16 *dst, const u16 *src0, const u16 *src1, const u16 *src2, unsigned count)

   136 {

   137 	/* always do the first and last run */

   138 	count -= 2 * 4;

   139 

   140 #ifdef __GNUC__

   141 	__asm__ __volatile__ (

   142 	    /* first run */

   143 	    /* set the current, current_pre, current_next registers */

   144 	    "movq 0(%1), %%mm0\n"

   145 	    "movq 0(%1),%%mm7\n"

   146 	    "movq 8(%1),%%mm1\n"

   147 	    "psllq $48,%%mm0\n"

   148 	    "psllq $48,%%mm1\n"

   149 	    "psrlq $48, %%mm0\n"

   150 	    "movq %%mm7,%%mm2\n"

   151 	    "movq %%mm7,%%mm3\n"

   152 	    "psllq $16,%%mm2\n"

   153 	    "psrlq $16,%%mm3\n"

   154 	    "por %%mm2,%%mm0\n"

   155 	    "por %%mm3,%%mm1\n"

   156 

   157 	    /* current_upper */

   158 	    "movq (%0),%%mm6\n"

   159 

   160 	    /* compute the upper-left pixel for dst on %%mm2 */

   161 	    /* compute the upper-right pixel for dst on %%mm4 */

   162 	    "movq %%mm0,%%mm2\n"

   163 	    "movq %%mm1,%%mm4\n"

   164 	    "movq %%mm0,%%mm3\n"

   165 	    "movq %%mm1,%%mm5\n"

   166 	    "pcmpeqw %%mm6,%%mm2\n"

   167 	    "pcmpeqw %%mm6,%%mm4\n"

   168 	    "pcmpeqw (%2),%%mm3\n"

   169 	    "pcmpeqw (%2),%%mm5\n"

   170 	    "pandn %%mm2,%%mm3\n"

   171 	    "pandn %%mm4,%%mm5\n"

   172 	    "movq %%mm0,%%mm2\n"

   173 	    "movq %%mm1,%%mm4\n"

   174 	    "pcmpeqw %%mm1,%%mm2\n"

   175 	    "pcmpeqw %%mm0,%%mm4\n"

   176 	    "pandn %%mm3,%%mm2\n"

   177 	    "pandn %%mm5,%%mm4\n"

   178 	    "movq %%mm2,%%mm3\n"

   179 	    "movq %%mm4,%%mm5\n"

   180 	    "pand %%mm6,%%mm2\n"

   181 	    "pand %%mm6,%%mm4\n"

   182 	    "pandn %%mm7,%%mm3\n"

   183 	    "pandn %%mm7,%%mm5\n"

   184 	    "por %%mm3,%%mm2\n"

   185 	    "por %%mm5,%%mm4\n"

   186 

   187 	    /* set *dst */

   188 	    "movq %%mm2,%%mm3\n"

   189 	    "punpcklwd %%mm4,%%mm2\n"

   190 	    "punpckhwd %%mm4,%%mm3\n"

   191 	    "movq %%mm2,(%3)\n"

   192 	    "movq %%mm3,8(%3)\n"

   193 

   194 	    /* next */

   195 	    "addl $8,%0\n"

   196 	    "addl $8,%1\n"

   197 	    "addl $8,%2\n"

   198 	    "addl $16,%3\n"

   199 

   200 	    /* central runs */

   201 	    "shrl $2,%4\n"

   202 	    "jz 1f\n"

   203 

   204 	    "0:\n"

   205 

   206 	    /* set the current, current_pre, current_next registers */

   207 	    "movq -8(%1),%%mm0\n"

   208 	    "movq (%1),%%mm7\n"

   209 	    "movq 8(%1),%%mm1\n"

   210 	    "psrlq $48,%%mm0\n"

   211 	    "psllq $48,%%mm1\n"

   212 	    "movq %%mm7,%%mm2\n"

   213 	    "movq %%mm7,%%mm3\n"

   214 	    "psllq $16,%%mm2\n"

   215 	    "psrlq $16,%%mm3\n"

   216 	    "por %%mm2,%%mm0\n"

   217 	    "por %%mm3,%%mm1\n"

   218 

   219 	    /* current_upper */

   220 	    "movq (%0),%%mm6\n"

   221 

   222 	    /* compute the upper-left pixel for dst on %%mm2 */

   223 	    /* compute the upper-right pixel for dst on %%mm4 */

   224 	    "movq %%mm0,%%mm2\n"

   225 	    "movq %%mm1,%%mm4\n"

   226 	    "movq %%mm0,%%mm3\n"

   227 	    "movq %%mm1,%%mm5\n"

   228 	    "pcmpeqw %%mm6,%%mm2\n"

   229 	    "pcmpeqw %%mm6,%%mm4\n"

   230 	    "pcmpeqw (%2),%%mm3\n"

   231 	    "pcmpeqw (%2),%%mm5\n"

   232 	    "pandn %%mm2,%%mm3\n"

   233 	    "pandn %%mm4,%%mm5\n"

   234 	    "movq %%mm0,%%mm2\n"

   235 	    "movq %%mm1,%%mm4\n"

   236 	    "pcmpeqw %%mm1,%%mm2\n"

   237 	    "pcmpeqw %%mm0,%%mm4\n"

   238 	    "pandn %%mm3,%%mm2\n"

   239 	    "pandn %%mm5,%%mm4\n"

   240 	    "movq %%mm2,%%mm3\n"

   241 	    "movq %%mm4,%%mm5\n"

   242 	    "pand %%mm6,%%mm2\n"

   243 	    "pand %%mm6,%%mm4\n"

   244 	    "pandn %%mm7,%%mm3\n"

   245 	    "pandn %%mm7,%%mm5\n"

   246 	    "por %%mm3,%%mm2\n"

   247 	    "por %%mm5,%%mm4\n"

   248 

   249 	    /* set *dst */

   250 	    "movq %%mm2,%%mm3\n"

   251 	    "punpcklwd %%mm4,%%mm2\n"

   252 	    "punpckhwd %%mm4,%%mm3\n"

   253 	    "movq %%mm2,(%3)\n"

   254 	    "movq %%mm3,8(%3)\n"

   255 

   256 	    /* next */

   257 	    "addl $8,%0\n"

   258 	    "addl $8,%1\n"

   259 	    "addl $8,%2\n"

   260 	    "addl $16,%3\n"

   261 

   262 	    "decl %4\n"

   263 	    "jnz 0b\n"

   264 	    "1:\n"

   265 

   266 	    /* final run */

   267 	    /* set the current, current_pre, current_next registers */

   268 	    "movq (%1),%%mm1\n"

   269 	    "movq (%1),%%mm7\n"

   270 	    "movq -8(%1),%%mm0\n"

   271 	    "psrlq $48,%%mm1\n"

   272 	    "psrlq $48,%%mm0\n"

   273 	    "psllq $48,%%mm1\n"

   274 	    "movq %%mm7,%%mm2\n"

   275 	    "movq %%mm7,%%mm3\n"

   276 	    "psllq $16,%%mm2\n"

   277 	    "psrlq $16,%%mm3\n"

   278 	    "por %%mm2,%%mm0\n"

   279 	    "por %%mm3,%%mm1\n"

   280 

   281 	    /* current_upper */

   282 	    "movq (%0),%%mm6\n"

   283 

   284 	    /* compute the upper-left pixel for dst on %%mm2 */

   285 	    /* compute the upper-right pixel for dst on %%mm4 */

   286 	    "movq %%mm0,%%mm2\n"

   287 	    "movq %%mm1,%%mm4\n"

   288 	    "movq %%mm0,%%mm3\n"

   289 	    "movq %%mm1,%%mm5\n"

   290 	    "pcmpeqw %%mm6,%%mm2\n"

   291 	    "pcmpeqw %%mm6,%%mm4\n"

   292 	    "pcmpeqw (%2),%%mm3\n"

   293 	    "pcmpeqw (%2),%%mm5\n"

   294 	    "pandn %%mm2,%%mm3\n"

   295 	    "pandn %%mm4,%%mm5\n"

   296 	    "movq %%mm0,%%mm2\n"

   297 	    "movq %%mm1,%%mm4\n"

   298 	    "pcmpeqw %%mm1,%%mm2\n"

   299 	    "pcmpeqw %%mm0,%%mm4\n"

   300 	    "pandn %%mm3,%%mm2\n"

   301 	    "pandn %%mm5,%%mm4\n"

   302 	    "movq %%mm2,%%mm3\n"

   303 	    "movq %%mm4,%%mm5\n"

   304 	    "pand %%mm6,%%mm2\n"

   305 	    "pand %%mm6,%%mm4\n"

   306 	    "pandn %%mm7,%%mm3\n"

   307 	    "pandn %%mm7,%%mm5\n"

   308 	    "por %%mm3,%%mm2\n"

   309 	    "por %%mm5,%%mm4\n"

   310 

   311 	    /* set *dst */

   312 	    "movq %%mm2,%%mm3\n"

   313 	    "punpcklwd %%mm4,%%mm2\n"

   314 	    "punpckhwd %%mm4,%%mm3\n"

   315 	    "movq %%mm2,(%3)\n"

   316 	    "movq %%mm3,8(%3)\n"

   317 	    "emms\n"

   318 

   319 		: "+r" (src0), "+r" (src1), "+r" (src2), "+r" (dst), "+r" (count)

   320 		:

   321 		: "cc"

   322 	    );

   323 #else

   324 	__asm {

   325 		mov eax, src0;

   326 		mov ebx, src1;

   327 		mov ecx, src2;

   328 		mov edx, dst;

   329 		mov esi, count;

   330 

   331 		/* first run */

   332 		/* set the current, current_pre, current_next registers */

   333 		movq  mm0, qword ptr [ebx];

   334 		movq  mm7, qword ptr [ebx];

   335 		movq  mm1, qword ptr [ebx + 8];

   336 		psllq mm0, 48;

   337 		psllq mm1, 48;

   338 		psrlq mm0, 48;

   339 		movq  mm2, mm7;

   340 		movq  mm3, mm7;

   341 		psllq mm2, 16;

   342 		psrlq mm3, 16;

   343 		por	  mm0, mm2;

   344 		por	  mm1, mm3;

   345 

   346 		/* current_upper */

   347 		movq mm6, qword ptr [eax];

   348 

   349 		/* compute the upper-left pixel for dst on %%mm2 */

   350 		/* compute the upper-right pixel for dst on %%mm4 */

   351 		movq	mm2, mm0;

   352 		movq	mm4, mm1;

   353 		movq	mm3, mm0;

   354 		movq	mm5, mm1;

   355 		pcmpeqw mm2, mm6;

   356 		pcmpeqw mm4, mm6;

   357 		pcmpeqw mm3, qword ptr [ecx];

   358 		pcmpeqw mm5, qword ptr [ecx];

   359 		pandn	mm3, mm2;

   360 		pandn	mm5, mm4;

   361 		movq	mm2, mm0;

   362 		movq	mm4, mm1;

   363 		pcmpeqw mm2, mm1;

   364 		pcmpeqw mm4, mm0;

   365 		pandn	mm2, mm3;

   366 		pandn	mm4, mm5;

   367 		movq	mm3, mm2;

   368 		movq	mm5, mm4;

   369 		pand	mm2, mm6;

   370 		pand	mm4, mm6;

   371 		pandn	mm3, mm7;

   372 		pandn	mm5, mm7;

   373 		por		mm2, mm3;

   374 		por		mm4, mm5;

   375 

   376 		/* set *dst0 */

   377 		movq	   mm3, mm2;

   378 		punpcklwd  mm2, mm4;

   379 		punpckhwd  mm3, mm4;

   380 		movq qword ptr [edx], mm2;

   381 		movq qword ptr [edx + 8], mm3;

   382 

   383 		/* next */

   384 		add eax, 8;

   385 		add ebx, 8;

   386 		add ecx, 8;

   387 		add edx, 16;

   388 

   389 		/* central runs */

   390 		shr esi, 2;

   391 		jz	label1;

   392 		align 4;

   393 label0:

   394 

   395 		/* set the current, current_pre, current_next registers */

   396 		movq mm0, qword ptr [ebx - 8];

   397 		movq  mm7, qword ptr [ebx];

   398 		movq  mm1, qword ptr [ebx + 8];

   399 		psrlq mm0, 48;

   400 		psllq mm1, 48;

   401 		movq  mm2, mm7;

   402 		movq  mm3, mm7;

   403 		psllq mm2, 16;

   404 		psrlq mm3, 16;

   405 		por	  mm0, mm2;

   406 		por	  mm1, mm3;

   407 

   408 		/* current_upper */

   409 		movq mm6, qword ptr [eax];

   410 

   411 		/* compute the upper-left pixel for dst on %%mm2 */

   412 		/* compute the upper-right pixel for dst on %%mm4 */

   413 		movq	mm2, mm0;

   414 		movq	mm4, mm1;

   415 		movq	mm3, mm0;

   416 		movq	mm5, mm1;

   417 		pcmpeqw mm2, mm6;

   418 		pcmpeqw mm4, mm6;

   419 		pcmpeqw mm3, qword ptr [ecx];

   420 		pcmpeqw mm5, qword ptr [ecx];

   421 		pandn	mm3, mm2;

   422 		pandn	mm5, mm4;

   423 		movq	mm2, mm0;

   424 		movq	mm4, mm1;

   425 		pcmpeqw mm2, mm1;

   426 		pcmpeqw mm4, mm0;

   427 		pandn	mm2, mm3;

   428 		pandn	mm4, mm5;

   429 		movq	mm3, mm2;

   430 		movq	mm5, mm4;

   431 		pand	mm2, mm6;

   432 		pand	mm4, mm6;

   433 		pandn	mm3, mm7;

   434 		pandn	mm5, mm7;

   435 		por		mm2, mm3;

   436 		por		mm4, mm5;

   437 

   438 		/* set *dst */

   439 		movq	   mm3, mm2;

   440 		punpcklwd  mm2, mm4;

   441 		punpckhwd  mm3, mm4;

   442 		movq qword ptr [edx], mm2;

   443 		movq qword ptr [edx + 8], mm3;

   444 

   445 		/* next */

   446 		add eax, 8;

   447 		add ebx, 8;

   448 		add ecx, 8;

   449 		add edx, 16;

   450 

   451 		dec esi;

   452 		jnz label0;

   453 label1:

   454 

   455 		/* final run */

   456 		/* set the current, current_pre, current_next registers */

   457 		movq mm1, qword ptr [ebx];

   458 		movq  mm7, qword ptr [ebx];

   459 		movq  mm0, qword ptr [ebx - 8];

   460 		psrlq mm1, 48;

   461 		psrlq mm0, 48;

   462 		psllq mm1, 48;

   463 		movq  mm2, mm7;

   464 		movq  mm3, mm7;

   465 		psllq mm2, 16;

   466 		psrlq mm3, 16;

   467 		por	  mm0, mm2;

   468 		por	  mm1, mm3;

   469 

   470 		/* current_upper */

   471 		movq mm6, qword ptr [eax];

   472 

   473 		/* compute the upper-left pixel for dst on %%mm2 */

   474 		/* compute the upper-right pixel for dst on %%mm4 */

   475 		movq	mm2, mm0;

   476 		movq	mm4, mm1;

   477 		movq	mm3, mm0;

   478 		movq	mm5, mm1;

   479 		pcmpeqw mm2, mm6;

   480 		pcmpeqw mm4, mm6;

   481 		pcmpeqw mm3, qword ptr [ecx];

   482 		pcmpeqw mm5, qword ptr [ecx];

   483 		pandn	mm3, mm2;

   484 		pandn	mm5, mm4;

   485 		movq	mm2, mm0;

   486 		movq	mm4, mm1;

   487 		pcmpeqw mm2, mm1;

   488 		pcmpeqw mm4, mm0;

   489 		pandn	mm2, mm3;

   490 		pandn	mm4, mm5;

   491 		movq	mm3, mm2;

   492 		movq	mm5, mm4;

   493 		pand	mm2, mm6;

   494 		pand	mm4, mm6;

   495 		pandn	mm3, mm7;

   496 		pandn	mm5, mm7;

   497 		por		mm2, mm3;

   498 		por		mm4, mm5;

   499 

   500 		/* set *dst */

   501 		movq	   mm3, mm2;

   502 		punpcklwd  mm2, mm4;

   503 		punpckhwd  mm3, mm4;

   504 		movq qword ptr [edx], mm2;

   505 		movq qword ptr [edx + 8], mm3;

   506 

   507 		mov src0, eax;

   508 		mov src1, ebx;

   509 		mov src2, ecx;

   510 		mov dst, edx;

   511 		mov count, esi;

   512 

   513 		emms;

   514 	}

   515 #endif

   516 }

   517 

   518 static void internal_scale2x_32_mmx_single(u32 *dst, const u32 *src0, const u32 *src1, const u32 *src2, unsigned count)

   519 {

   520 	/* always do the first and last run */

   521 	count -= 2 * 2;

   522 

   523 #ifdef __GNUC__

   524 	__asm__ __volatile__ (

   525 	    /* first run */

   526 	    /* set the current, current_pre, current_next registers */

   527 	    "movq 0(%1),%%mm0\n"

   528 	    "movq 0(%1),%%mm7\n"

   529 	    "movq 8(%1),%%mm1\n"

   530 	    "psllq $32,%%mm0\n"

   531 	    "psllq $32,%%mm1\n"

   532 	    "psrlq $32,%%mm0\n"

   533 	    "movq %%mm7,%%mm2\n"

   534 	    "movq %%mm7,%%mm3\n"

   535 	    "psllq $32,%%mm2\n"

   536 	    "psrlq $32,%%mm3\n"

   537 	    "por %%mm2,%%mm0\n"

   538 	    "por %%mm3,%%mm1\n"

   539 

   540 	    /* current_upper */

   541 	    "movq (%0),%%mm6\n"

   542 

   543 	    /* compute the upper-left pixel for dst on %%mm2 */

   544 	    /* compute the upper-right pixel for dst on %%mm4 */

   545 	    "movq %%mm0,%%mm2\n"

   546 	    "movq %%mm1,%%mm4\n"

   547 	    "movq %%mm0,%%mm3\n"

   548 	    "movq %%mm1,%%mm5\n"

   549 	    "pcmpeqd %%mm6,%%mm2\n"

   550 	    "pcmpeqd %%mm6,%%mm4\n"

   551 	    "pcmpeqd (%2),%%mm3\n"

   552 	    "pcmpeqd (%2),%%mm5\n"

   553 	    "pandn %%mm2,%%mm3\n"

   554 	    "pandn %%mm4,%%mm5\n"

   555 	    "movq %%mm0,%%mm2\n"

   556 	    "movq %%mm1,%%mm4\n"

   557 	    "pcmpeqd %%mm1,%%mm2\n"

   558 	    "pcmpeqd %%mm0,%%mm4\n"

   559 	    "pandn %%mm3,%%mm2\n"

   560 	    "pandn %%mm5,%%mm4\n"

   561 	    "movq %%mm2,%%mm3\n"

   562 	    "movq %%mm4,%%mm5\n"

   563 	    "pand %%mm6,%%mm2\n"

   564 	    "pand %%mm6,%%mm4\n"

   565 	    "pandn %%mm7,%%mm3\n"

   566 	    "pandn %%mm7,%%mm5\n"

   567 	    "por %%mm3,%%mm2\n"

   568 	    "por %%mm5,%%mm4\n"

   569 

   570 	    /* set *dst */

   571 	    "movq %%mm2,%%mm3\n"

   572 	    "punpckldq %%mm4,%%mm2\n"

   573 	    "punpckhdq %%mm4,%%mm3\n"

   574 	    "movq %%mm2,(%3)\n"

   575 	    "movq %%mm3, 8(%3)\n"

   576 

   577 	    /* next */

   578 	    "addl $8,%0\n"

   579 	    "addl $8,%1\n"

   580 	    "addl $8,%2\n"

   581 	    "addl $16,%3\n"

   582 

   583 	    /* central runs */

   584 	    "shrl $1,%4\n"

   585 	    "jz 1f\n"

   586 

   587 	    "0:\n"

   588 

   589 	    /* set the current, current_pre, current_next registers */

   590 	    "movq -8(%1),%%mm0\n"

   591 	    "movq (%1),%%mm7\n"

   592 	    "movq 8(%1),%%mm1\n"

   593 	    "psrlq $32,%%mm0\n"

   594 	    "psllq $32,%%mm1\n"

   595 	    "movq %%mm7,%%mm2\n"

   596 	    "movq %%mm7,%%mm3\n"

   597 	    "psllq $32,%%mm2\n"

   598 	    "psrlq $32,%%mm3\n"

   599 	    "por %%mm2,%%mm0\n"

   600 	    "por %%mm3,%%mm1\n"

   601 

   602 	    /* current_upper */

   603 	    "movq (%0),%%mm6\n"

   604 

   605 	    /* compute the upper-left pixel for dst on %%mm2 */

   606 	    /* compute the upper-right pixel for dst on %%mm4 */

   607 	    "movq %%mm0,%%mm2\n"

   608 	    "movq %%mm1,%%mm4\n"

   609 	    "movq %%mm0,%%mm3\n"

   610 	    "movq %%mm1,%%mm5\n"

   611 	    "pcmpeqd %%mm6,%%mm2\n"

   612 	    "pcmpeqd %%mm6,%%mm4\n"

   613 	    "pcmpeqd (%2),%%mm3\n"

   614 	    "pcmpeqd (%2),%%mm5\n"

   615 	    "pandn %%mm2,%%mm3\n"

   616 	    "pandn %%mm4,%%mm5\n"

   617 	    "movq %%mm0,%%mm2\n"

   618 	    "movq %%mm1,%%mm4\n"

   619 	    "pcmpeqd %%mm1,%%mm2\n"

   620 	    "pcmpeqd %%mm0,%%mm4\n"

   621 	    "pandn %%mm3,%%mm2\n"

   622 	    "pandn %%mm5,%%mm4\n"

   623 	    "movq %%mm2,%%mm3\n"

   624 	    "movq %%mm4,%%mm5\n"

   625 	    "pand %%mm6,%%mm2\n"

   626 	    "pand %%mm6,%%mm4\n"

   627 	    "pandn %%mm7,%%mm3\n"

   628 	    "pandn %%mm7,%%mm5\n"

   629 	    "por %%mm3,%%mm2\n"

   630 	    "por %%mm5,%%mm4\n"

   631 

   632 	    /* set *dst */

   633 	    "movq %%mm2,%%mm3\n"

   634 	    "punpckldq %%mm4,%%mm2\n"

   635 	    "punpckhdq %%mm4,%%mm3\n"

   636 	    "movq %%mm2,(%3)\n"

   637 	    "movq %%mm3,8(%3)\n"

   638 

   639 	    /* next */

   640 	    "addl $8,%0\n"

   641 	    "addl $8,%1\n"

   642 	    "addl $8,%2\n"

   643 	    "addl $16,%3\n"

   644 

   645 	    "decl %4\n"

   646 	    "jnz 0b\n"

   647 	    "1:\n"

   648 

   649 	    /* final run */

   650 	    /* set the current, current_pre, current_next registers */

   651 	    "movq (%1),%%mm1\n"

   652 	    "movq (%1),%%mm7\n"

   653 	    "movq -8(%1), %%mm0\n"

   654 	    "psrlq $32,%%mm1\n"

   655 	    "psrlq $32,%%mm0\n"

   656 	    "psllq $32,%%mm1\n"

   657 	    "movq %%mm7,%%mm2\n"

   658 	    "movq %%mm7,%%mm3\n"

   659 	    "psllq $32,%%mm2\n"

   660 	    "psrlq $32,%%mm3\n"

   661 	    "por %%mm2,%%mm0\n"

   662 	    "por %%mm3,%%mm1\n"

   663 

   664 	    /* current_upper */

   665 	    "movq (%0),%%mm6\n"

   666 

   667 	    /* compute the upper-left pixel for dst on %%mm2 */

   668 	    /* compute the upper-right pixel for dst on %%mm4 */

   669 	    "movq %%mm0,%%mm2\n"

   670 	    "movq %%mm1,%%mm4\n"

   671 	    "movq %%mm0,%%mm3\n"

   672 	    "movq %%mm1,%%mm5\n"

   673 	    "pcmpeqd %%mm6,%%mm2\n"

   674 	    "pcmpeqd %%mm6,%%mm4\n"

   675 	    "pcmpeqd (%2),%%mm3\n"

   676 	    "pcmpeqd (%2),%%mm5\n"

   677 	    "pandn %%mm2,%%mm3\n"

   678 	    "pandn %%mm4,%%mm5\n"

   679 	    "movq %%mm0,%%mm2\n"

   680 	    "movq %%mm1,%%mm4\n"

   681 	    "pcmpeqd %%mm1,%%mm2\n"

   682 	    "pcmpeqd %%mm0,%%mm4\n"

   683 	    "pandn %%mm3,%%mm2\n"

   684 	    "pandn %%mm5,%%mm4\n"

   685 	    "movq %%mm2,%%mm3\n"

   686 	    "movq %%mm4,%%mm5\n"

   687 	    "pand %%mm6,%%mm2\n"

   688 	    "pand %%mm6,%%mm4\n"

   689 	    "pandn %%mm7,%%mm3\n"

   690 	    "pandn %%mm7,%%mm5\n"

   691 	    "por %%mm3,%%mm2\n"

   692 	    "por %%mm5,%%mm4\n"

   693 

   694 	    /* set *dst */

   695 	    "movq %%mm2,%%mm3\n"

   696 	    "punpckldq %%mm4,%%mm2\n"

   697 	    "punpckhdq %%mm4,%%mm3\n"

   698 	    "movq %%mm2,(%3)\n"

   699 	    "movq %%mm3,8(%3)\n"

   700 	    "emms\n"

   701 

   702 		: "+r" (src0), "+r" (src1), "+r" (src2), "+r" (dst), "+r" (count)

   703 		:

   704 		: "cc"

   705 	    );

   706 #else

   707 	__asm {

   708 		mov eax, src0;

   709 		mov ebx, src1;

   710 		mov ecx, src2;

   711 		mov edx, dst;

   712 		mov esi, count;

   713 

   714 		/* first run */

   715 		/* set the current, current_pre, current_next registers */

   716 		movq  mm0, qword ptr [ebx];

   717 		movq  mm7, qword ptr [ebx];

   718 		movq  mm1, qword ptr [ebx + 8];

   719 		psllq mm0, 32;

   720 		psllq mm1, 32;

   721 		psrlq mm0, 32;

   722 		movq  mm2, mm7;

   723 		movq  mm3, mm7;

   724 		psllq mm2, 32;

   725 		psrlq mm3, 32;

   726 		por	  mm0, mm2;

   727 		por	  mm1, mm3;

   728 

   729 		/* current_upper */

   730 		movq mm6, qword ptr [eax];

   731 

   732 		/* compute the upper-left pixel for dst on %%mm2 */

   733 		/* compute the upper-right pixel for dst on %%mm4 */

   734 		movq	mm2, mm0;

   735 		movq	mm4, mm1;

   736 		movq	mm3, mm0;

   737 		movq	mm5, mm1;

   738 		pcmpeqd mm2, mm6;

   739 		pcmpeqd mm4, mm6;

   740 		pcmpeqd mm3, qword ptr [ecx];

   741 		pcmpeqd mm5, qword ptr [ecx];

   742 		pandn	mm3, mm2;

   743 		pandn	mm5, mm4;

   744 		movq	mm2, mm0;

   745 		movq	mm4, mm1;

   746 		pcmpeqd mm2, mm1;

   747 		pcmpeqd mm4, mm0;

   748 		pandn	mm2, mm3;

   749 		pandn	mm4, mm5;

   750 		movq	mm3, mm2;

   751 		movq	mm5, mm4;

   752 		pand	mm2, mm6;

   753 		pand	mm4, mm6;

   754 		pandn	mm3, mm7;

   755 		pandn	mm5, mm7;

   756 		por		mm2, mm3;

   757 		por		mm4, mm5;

   758 

   759 		/* set *dst */

   760 		movq	   mm3, mm2;

   761 		punpckldq  mm2, mm4;

   762 		punpckhdq  mm3, mm4;

   763 		movq qword ptr [edx], mm2;

   764 		movq qword ptr [edx + 8], mm3;

   765 

   766 		/* next */

   767 		add eax, 8;

   768 		add ebx, 8;

   769 		add ecx, 8;

   770 		add edx, 16;

   771 

   772 		/* central runs */

   773 		shr esi, 1;

   774 		jz	label1;

   775 label0:

   776 

   777 		/* set the current, current_pre, current_next registers */

   778 		movq mm0, qword ptr [ebx - 8];

   779 		movq  mm7, qword ptr [ebx];

   780 		movq  mm1, qword ptr [ebx + 8];

   781 		psrlq mm0, 32;

   782 		psllq mm1, 32;

   783 		movq  mm2, mm7;

   784 		movq  mm3, mm7;

   785 		psllq mm2, 32;

   786 		psrlq mm3, 32;

   787 		por	  mm0, mm2;

   788 		por	  mm1, mm3;

   789 

   790 		/* current_upper */

   791 		movq mm6, qword ptr[eax];

   792 

   793 		/* compute the upper-left pixel for dst on %%mm2 */

   794 		/* compute the upper-right pixel for dst on %%mm4 */

   795 		movq	mm2, mm0;

   796 		movq	mm4, mm1;

   797 		movq	mm3, mm0;

   798 		movq	mm5, mm1;

   799 		pcmpeqd mm2, mm6;

   800 		pcmpeqd mm4, mm6;

   801 		pcmpeqd mm3, qword ptr[ecx];

   802 		pcmpeqd mm5, qword ptr[ecx];

   803 		pandn	mm3, mm2;

   804 		pandn	mm5, mm4;

   805 		movq	mm2, mm0;

   806 		movq	mm4, mm1;

   807 		pcmpeqd mm2, mm1;

   808 		pcmpeqd mm4, mm0;

   809 		pandn	mm2, mm3;

   810 		pandn	mm4, mm5;

   811 		movq	mm3, mm2;

   812 		movq	mm5, mm4;

   813 		pand	mm2, mm6;

   814 		pand	mm4, mm6;

   815 		pandn	mm3, mm7;

   816 		pandn	mm5, mm7;

   817 		por		mm2, mm3;

   818 		por		mm4, mm5;

   819 

   820 		/* set *dst */

   821 		movq	   mm3, mm2;

   822 		punpckldq  mm2, mm4;

   823 		punpckhdq  mm3, mm4;

   824 		movq qword ptr [edx], mm2;

   825 		movq qword ptr [edx + 8], mm3;

   826 

   827 		/* next */

   828 		add eax, 8;

   829 		add ebx, 8;

   830 		add ecx, 8;

   831 		add edx, 16;

   832 

   833 		dec esi;

   834 		jnz label0;

   835 label1:

   836 

   837 		/* final run */

   838 		/* set the current, current_pre, current_next registers */

   839 		movq mm1, qword ptr [ebx];

   840 		movq  mm7, qword ptr [ebx];

   841 		movq  mm0, qword ptr [ebx - 8];

   842 		psrlq mm1, 32;

   843 		psrlq mm0, 32;

   844 		psllq mm1, 32;

   845 		movq  mm2, mm7;

   846 		movq  mm3, mm7;

   847 		psllq mm2, 32;

   848 		psrlq mm3, 32;

   849 		por	  mm0, mm2;

   850 		por	  mm1, mm3;

   851 

   852 		/* current_upper */

   853 		movq mm6, qword ptr [eax];

   854 

   855 		/* compute the upper-left pixel for dst on %%mm2 */

   856 		/* compute the upper-right pixel for dst on %%mm4 */

   857 		movq	mm2, mm0;

   858 		movq	mm4, mm1;

   859 		movq	mm3, mm0;

   860 		movq	mm5, mm1;

   861 		pcmpeqd mm2, mm6;

   862 		pcmpeqd mm4, mm6;

   863 		pcmpeqd mm3, qword ptr [ecx];

   864 		pcmpeqd mm5, qword ptr [ecx];

   865 		pandn	mm3, mm2;

   866 		pandn	mm5, mm4;

   867 		movq	mm2, mm0;

   868 		movq	mm4, mm1;

   869 		pcmpeqd mm2, mm1;

   870 		pcmpeqd mm4, mm0;

   871 		pandn	mm2, mm3;

   872 		pandn	mm4, mm5;

   873 		movq	mm3, mm2;

   874 		movq	mm5, mm4;

   875 		pand	mm2, mm6;

   876 		pand	mm4, mm6;

   877 		pandn	mm3, mm7;

   878 		pandn	mm5, mm7;

   879 		por		mm2, mm3;

   880 		por		mm4, mm5;

   881 

   882 		/* set *dst */

   883 		movq	   mm3, mm2;

   884 		punpckldq  mm2, mm4;

   885 		punpckhdq  mm3, mm4;

   886 		movq qword ptr [edx], mm2;

   887 		movq qword ptr [edx + 8], mm3;

   888 

   889 		mov src0, eax;

   890 		mov src1, ebx;

   891 		mov src2, ecx;

   892 		mov dst, edx;

   893 		mov count, esi;

   894 

   895 		emms;

   896 	}

   897 #endif

   898 }

   899 

   900 static void internal_scale2x_16_mmx(u16 *dst0, u16 *dst1, const u16 *src0, const u16 *src1, const u16 *src2, unsigned count)

   901 {

   902 	//	assert( count >= 2*4 );

   903 	internal_scale2x_16_mmx_single(dst0, src0, src1, src2, count);

   904 	internal_scale2x_16_mmx_single(dst1, src2, src1, src0, count);

   905 }

   906 

   907 static void internal_scale2x_32_mmx(u32 *dst0, u32 *dst1, const u32 *src0, const u32 *src1, const u32 *src2, unsigned count)

   908 {

   909 	//	assert( count >= 2*2 );

   910 	internal_scale2x_32_mmx_single(dst0, src0, src1, src2, count);

   911 	internal_scale2x_32_mmx_single(dst1, src2, src1, src0, count);

   912 }

   913 

   914 #endif

   915 

   916 void AdMame2x(u8 *srcPtr, u32 srcPitch, u8 * /* deltaPtr */,

   917               u8 *dstPtr, u32 dstPitch, int width, int height)

   918 {

   919 	u16 *dst0 = (u16 *)dstPtr;

   920 	u16 *dst1 = dst0 + (dstPitch >> 1);

   921 

   922 	u16 *src0 = (u16 *)srcPtr;

   923 	u16 *src1 = src0 + (srcPitch >> 1);

   924 	u16 *src2 = src1 + (srcPitch >> 1);

   925 #ifdef MMX

   926 	if (cpu_mmx)

   927 	{

   928 		internal_scale2x_16_mmx(dst0, dst1, src0, src0, src1, width);

   929 

   930 		int count = height;

   931 

   932 		count -= 2;

   933 		while (count)

   934 		{

   935 			dst0 += dstPitch;

   936 			dst1 += dstPitch;

   937 			internal_scale2x_16_mmx(dst0, dst1, src0, src1, src2, width);

   938 			src0  = src1;

   939 			src1  = src2;

   940 			src2 += srcPitch >> 1;

   941 			--count;

   942 		}

   943 		dst0 += dstPitch;

   944 		dst1 += dstPitch;

   945 		internal_scale2x_16_mmx(dst0, dst1, src0, src1, src1, width);

   946 	}

   947 	else

   948 	{

   949 #endif

   950 	internal_scale2x_16_def(dst0, src0, src0, src1, width);

   951 	internal_scale2x_16_def(dst1, src1, src0, src0, width);

   952 

   953 	int count = height;

   954 

   955 	count -= 2;

   956 	while (count)

   957 	{

   958 		dst0 += dstPitch;

   959 		dst1 += dstPitch;

   960 		internal_scale2x_16_def(dst0, src0, src1, src2, width);

   961 		internal_scale2x_16_def(dst1, src2, src1, src0, width);

   962 		src0  = src1;

   963 		src1  = src2;

   964 		src2 += srcPitch >> 1;

   965 		--count;

   966 	}

   967 	dst0 += dstPitch;

   968 	dst1 += dstPitch;

   969 	internal_scale2x_16_def(dst0, src0, src1, src1, width);

   970 	internal_scale2x_16_def(dst1, src1, src1, src0, width);

   971 #ifdef MMX

   972 }

   973 

   974 #endif

   975 }

   976 

   977 void AdMame2x32(u8 *srcPtr, u32 srcPitch, u8 * /* deltaPtr */,

   978                 u8 *dstPtr, u32 dstPitch, int width, int height)

   979 {

   980 	u32 *dst0 = (u32 *)dstPtr;

   981 	u32 *dst1 = dst0 + (dstPitch >> 2);

   982 

   983 	u32 *src0 = (u32 *)srcPtr;

   984 	u32 *src1 = src0 + (srcPitch >> 2);

   985 	u32 *src2 = src1 + (srcPitch >> 2);

   986 #ifdef MMX

   987 	if (cpu_mmx)

   988 	{

   989 		internal_scale2x_32_mmx(dst0, dst1, src0, src0, src1, width);

   990 

   991 		int count = height;

   992 

   993 		count -= 2;

   994 		while (count)

   995 		{

   996 			dst0 += dstPitch >> 1;

   997 			dst1 += dstPitch >> 1;

   998 			internal_scale2x_32_mmx(dst0, dst1, src0, src1, src2, width);

   999 			src0  = src1;

  1000 			src1  = src2;

  1001 			src2 += srcPitch >> 2;

  1002 			--count;

  1003 		}

  1004 		dst0 += dstPitch >> 1;

  1005 		dst1 += dstPitch >> 1;

  1006 		internal_scale2x_32_mmx(dst0, dst1, src0, src1, src1, width);

  1007 	}

  1008 	else

  1009 	{

  1010 #endif

  1011 	internal_scale2x_32_def(dst0, src0, src0, src1, width);

  1012 	internal_scale2x_32_def(dst1, src1, src0, src0, width);

  1013 

  1014 	int count = height;

  1015 

  1016 	count -= 2;

  1017 	while (count)

  1018 	{

  1019 		dst0 += dstPitch >> 1;

  1020 		dst1 += dstPitch >> 1;

  1021 		internal_scale2x_32_def(dst0, src0, src1, src2, width);

  1022 		internal_scale2x_32_def(dst1, src2, src1, src0, width);

  1023 		src0  = src1;

  1024 		src1  = src2;

  1025 		src2 += srcPitch >> 2;

  1026 		--count;

  1027 	}

  1028 	dst0 += dstPitch >> 1;

  1029 	dst1 += dstPitch >> 1;

  1030 	internal_scale2x_32_def(dst0, src0, src1, src1, width);

  1031 	internal_scale2x_32_def(dst1, src1, src1, src0, width);

  1032 #ifdef MMX

  1033 }

  1034 

  1035 #endif

  1036 }
author	Dylan Holmes <ocsenave@gmail.com>
date	Sun, 29 Apr 2012 20:35:58 -0500
parents	f9f4f1b99eed
children