--- /dev/null
+#include <stdio.h>
+#include <stdlib.h>
+#include <time.h>
+
+
+
+static unsigned long MMX_AVGDIFF_1[] = {0x00010001, 0x00010001};
+static unsigned long MMX_ACCUM_AND[] = {0xffffffff, 0x00000000};
+
+void inline mmx_start_block()
+{
+ asm("
+ .align 8
+ pxor %%mm7, %%mm7; // Zero totals
+ " : : );
+}
+
+void inline mmx_avgdiff(unsigned char *p1, unsigned char *p2, unsigned char *p3)
+{
+ asm("
+ .align 8
+ movq (%%ebx), %%mm0; // Load 8 pixels from a
+ pxor %%mm4, %%mm4; // Zero out temp for unpacking a
+ movq %%mm0, %%mm2; // Make a copy of a for unpacking
+ movq (%%ecx), %%mm1; // Load 8 pixels from b
+ pxor %%mm3, %%mm3; // Zero out b's upper unpacked destination
+ punpcklbw %%mm4, %%mm2; // Unpack lower 4 pixels from a for addition
+ movq %%mm1, %%mm5; // Copy b for unpacking
+ punpckhbw %%mm4, %%mm0; // Unpack upper 4 pixels from a for addition
+ punpcklbw %%mm3, %%mm5; // Unpack lower 4 pixels from b for addition
+ paddw %%mm2, %%mm5; // Add lower a and lower b unpacked
+ punpckhbw %%mm3, %%mm1; // Unpack upper 4 pixels from b for addition
+ paddw %%mm0, %%mm1; // Add upper a and upper b unpacked
+ movq (%%edx), %%mm2; // Load c for difference
+ paddw MMX_AVGDIFF_1, %%mm5; // Add 1 to the result of lower a + b
+ pxor %%mm4, %%mm4; // Zero out temp for c unpacking
+ movq %%mm2, %%mm3; // Make a copy of c for unpacking
+ paddw MMX_AVGDIFF_1, %%mm1; // Add 1 to the result of upper a + b
+ punpcklbw %%mm4, %%mm3; // Unpack lower 4 pixels from c for subtraction
+ punpckhbw %%mm4, %%mm2; // Unpack upper 4 pixels from c
+ movq %%mm3, %%mm0; // Make a copy of lower c for absdiff
+ psraw $1, %%mm5; // Divide result of lower a + b by 2
+ movq %%mm2, %%mm4; // Make a copy of upper c for absdiff
+ psraw $1, %%mm1; // Divide result of upper a + b by 2
+ psubusw %%mm5, %%mm3; // Subtract lower pixels one way
+ psubusw %%mm1, %%mm2; // Subtract upper pixels one way
+ psubusw %%mm0, %%mm5; // Subtract lower pixels the other way
+ por %%mm5, %%mm3; // Or the result of the lower pixels
+ psubusw %%mm4, %%mm1; // Subtract upper pixels the other way
+ por %%mm1, %%mm2; // Or the result of the upper pixels
+ paddw %%mm3, %%mm7; // Accumulate lower pixels
+ paddw %%mm2, %%mm7; // Accumulate upper pixels
+ "
+ :
+ : "b" (p1), "c" (p2), "d" (p3));
+}
+
+unsigned int mmx_accum_avgdiff()
+{
+ unsigned long long r = 0;
+ asm("
+ .align 8
+ pxor %%mm5, %%mm5; // Clear temp for unpacking
+ movq %%mm7, %%mm6; // Make a copy for unpacking
+ punpcklwd %%mm5, %%mm6; // Unpack lower 2 pixels for accumulation
+ punpckhwd %%mm5, %%mm7; // Unpack high 2 pixels for accumulation
+ paddw %%mm6, %%mm7; // Add 2 doublewords in each register
+ movq %%mm7, %%mm6; // Copy the result for a final add
+ pand MMX_ACCUM_AND, %%mm7; // And the result for accumulation
+ psrlq $32, %%mm6; // Shift the copy right for accumulation
+ paddd %%mm6, %%mm7; // Add the results
+ movq %%mm7, (%%ebx); // Store result
+ emms;
+ "
+ : : "b" (&r));
+
+ return (unsigned int)r;
+}
+
+
+unsigned int mmx_test(unsigned char *result)
+{
+ unsigned long long r = 255;
+ asm("
+ .align 8
+ movq (%%ecx), %%mm0;
+ movq (%%ecx), %%mm1;
+ paddd %%mm0, %%mm1;
+ movq %%mm1, (%%ebx);
+ movq %%mm0, (%%ecx);
+ "
+ :
+ : "b" (result), "c" (&r));
+ return r;
+}
+
+int main(int argc, char *argv[])
+{
+ unsigned char pixels1[9] = { 13, 13, 12, 11, 11, 10, 9, 9, 10 };
+ unsigned char pixels3[8] = { 15, 10, 7, 8, 14, 19, 21, 20 };
+ unsigned char *p1, *p2, *p3;
+ unsigned int result;
+
+ p1 = &pixels1[0];
+ p2 = &pixels1[1];
+ p3 = &pixels3[0];
+
+ printf("%d %d %d %d %d %d %d %d %d\n", p1[0], p1[1], p1[2], p1[3], p1[4], p1[5], p1[6], p1[7], p1[8]);
+ printf("%d %d %d %d %d %d %d %d\n", p3[0], p3[1], p3[2], p3[3], p3[4], p3[5], p3[6], p3[7]);
+ printf("-----------------------\n");
+ mmx_start_block();
+ mmx_avgdiff(p1, p2, p3);
+ result = mmx_accum_avgdiff();
+// p3[0] = p3[1] = p3[2] = p3[4] = p3[5] = p3[6] = p3[7] = 0;
+// result = mmx_test(p3);
+ printf("%d %d %d %d %d %d %d %d %d\n", p1[0], p1[1], p1[2], p1[3], p1[4], p1[5], p1[6], p1[7], p1[8]);
+ printf("%d %d %d %d %d %d %d %d\n", p3[0], p3[1], p3[2], p3[3], p3[4], p3[5], p3[6], p3[7]);
+ printf("%d\n", result);
+}