--- /dev/null
+#include <stdio.h>
+#include <stdint.h>
+#include <stdlib.h>
+
+#define USE_MMX
+#define MMX_ACCURATE
+
+#ifdef USE_MMX
+#include "mmx.h"
+#define m_(v) (*(mmx_t*)(((long long *)(v))))
+#ifdef MMX_ACCURATE
+static uint32_t sadd1[2] = { 0x00010001, 0x00010001 };
+static uint32_t sadd2[2] = { 0x00020002, 0x00020002 };
+#else
+static uint32_t bmask[2] = { 0x7f7f7f7f, 0x7f7f7f7f };
+static uint32_t badd1[2] = { 0x01010101, 0x01010101 };
+#endif
+#endif
+
+static inline void reca(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ int j; for( j=0; j<h; ++j ) {
+ dp[0] = (uint32_t)(dp[0] + sp[0] + 1) >> 1;
+ dp[1] = (uint32_t)(dp[1] + sp[1] + 1) >> 1;
+ dp[2] = (uint32_t)(dp[2] + sp[2] + 1) >> 1;
+ dp[3] = (uint32_t)(dp[3] + sp[3] + 1) >> 1;
+ dp[4] = (uint32_t)(dp[4] + sp[4] + 1) >> 1;
+ dp[5] = (uint32_t)(dp[5] + sp[5] + 1) >> 1;
+ dp[6] = (uint32_t)(dp[6] + sp[6] + 1) >> 1;
+ dp[7] = (uint32_t)(dp[7] + sp[7] + 1) >> 1;
+ dp[8] = (uint32_t)(dp[8] + sp[8] + 1) >> 1;
+ dp[9] = (uint32_t)(dp[9] + sp[9] + 1) >> 1;
+ dp[10] = (uint32_t)(dp[10] + sp[10] + 1) >> 1;
+ dp[11] = (uint32_t)(dp[11] + sp[11] + 1) >> 1;
+ dp[12] = (uint32_t)(dp[12] + sp[12] + 1) >> 1;
+ dp[13] = (uint32_t)(dp[13] + sp[13] + 1) >> 1;
+ dp[14] = (uint32_t)(dp[14] + sp[14] + 1) >> 1;
+ dp[15] = (uint32_t)(dp[15] + sp[15] + 1) >> 1;
+ sp += lx2; dp += lx2;
+ }
+}
+
+static inline void mreca(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp+0),mm1);
+ movq_m2r(m_(dp+0),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp+8),mm1);
+ movq_m2r(m_(dp+8),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; dp += lx2;
+ }
+ emms();
+}
+
+static inline void recac(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ int j; for( j=0; j<h; ++j ) {
+ dp[0] = (uint32_t)(dp[0] + sp[0] + 1)>>1;
+ dp[1] = (uint32_t)(dp[1] + sp[1] + 1)>>1;
+ dp[2] = (uint32_t)(dp[2] + sp[2] + 1)>>1;
+ dp[3] = (uint32_t)(dp[3] + sp[3] + 1)>>1;
+ dp[4] = (uint32_t)(dp[4] + sp[4] + 1)>>1;
+ dp[5] = (uint32_t)(dp[5] + sp[5] + 1)>>1;
+ dp[6] = (uint32_t)(dp[6] + sp[6] + 1)>>1;
+ dp[7] = (uint32_t)(dp[7] + sp[7] + 1)>>1;
+ sp += lx2; dp += lx2;
+ }
+}
+
+static inline void mrecac(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp+0),mm1);
+ movq_m2r(m_(dp+0),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; dp += lx2;
+ }
+ emms();
+}
+
+static inline void recv(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ int j; for( j=0; j<h; ++j ) {
+ dp[0] = (uint32_t)(sp[0] + sp2[0] + 1) >> 1;
+ dp[1] = (uint32_t)(sp[1] + sp2[1] + 1) >> 1;
+ dp[2] = (uint32_t)(sp[2] + sp2[2] + 1) >> 1;
+ dp[3] = (uint32_t)(sp[3] + sp2[3] + 1) >> 1;
+ dp[4] = (uint32_t)(sp[4] + sp2[4] + 1) >> 1;
+ dp[5] = (uint32_t)(sp[5] + sp2[5] + 1) >> 1;
+ dp[6] = (uint32_t)(sp[6] + sp2[6] + 1) >> 1;
+ dp[7] = (uint32_t)(sp[7] + sp2[7] + 1) >> 1;
+ dp[8] = (uint32_t)(sp[8] + sp2[8] + 1) >> 1;
+ dp[9] = (uint32_t)(sp[9] + sp2[9] + 1) >> 1;
+ dp[10] = (uint32_t)(sp[10] + sp2[10] + 1) >> 1;
+ dp[11] = (uint32_t)(sp[11] + sp2[11] + 1) >> 1;
+ dp[12] = (uint32_t)(sp[12] + sp2[12] + 1) >> 1;
+ dp[13] = (uint32_t)(sp[13] + sp2[13] + 1) >> 1;
+ dp[14] = (uint32_t)(sp[14] + sp2[14] + 1) >> 1;
+ dp[15] = (uint32_t)(sp[15] + sp2[15] + 1) >> 1;
+ sp += lx2; sp2 += lx2 ; dp += lx2;
+ }
+}
+
+static inline void mrecv(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp2+0),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp +8),mm1);
+ movq_m2r(m_(sp2+8),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; sp2 += lx2 ; dp += lx2;
+ }
+ emms();
+}
+
+static inline void recvc(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ int j; for( j=0; j<h; ++j ) {
+ dp[0] = (uint32_t)(sp[0]+sp2[0]+1)>>1;
+ dp[1] = (uint32_t)(sp[1]+sp2[1]+1)>>1;
+ dp[2] = (uint32_t)(sp[2]+sp2[2]+1)>>1;
+ dp[3] = (uint32_t)(sp[3]+sp2[3]+1)>>1;
+ dp[4] = (uint32_t)(sp[4]+sp2[4]+1)>>1;
+ dp[5] = (uint32_t)(sp[5]+sp2[5]+1)>>1;
+ dp[6] = (uint32_t)(sp[6]+sp2[6]+1)>>1;
+ dp[7] = (uint32_t)(sp[7]+sp2[7]+1)>>1;
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+}
+
+static inline void mrecvc(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp2+0),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void recva(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ int j; for( j=0; j<h; ++j ) {
+ dp[0] = (dp[0] + ((uint32_t)(sp[0]+sp2[0]+1)>>1) + 1)>>1;
+ dp[1] = (dp[1] + ((uint32_t)(sp[1]+sp2[1]+1)>>1) + 1)>>1;
+ dp[2] = (dp[2] + ((uint32_t)(sp[2]+sp2[2]+1)>>1) + 1)>>1;
+ dp[3] = (dp[3] + ((uint32_t)(sp[3]+sp2[3]+1)>>1) + 1)>>1;
+ dp[4] = (dp[4] + ((uint32_t)(sp[4]+sp2[4]+1)>>1) + 1)>>1;
+ dp[5] = (dp[5] + ((uint32_t)(sp[5]+sp2[5]+1)>>1) + 1)>>1;
+ dp[6] = (dp[6] + ((uint32_t)(sp[6]+sp2[6]+1)>>1) + 1)>>1;
+ dp[7] = (dp[7] + ((uint32_t)(sp[7]+sp2[7]+1)>>1) + 1)>>1;
+ dp[8] = (dp[8] + ((uint32_t)(sp[8]+sp2[8]+1)>>1) + 1)>>1;
+ dp[9] = (dp[9] + ((uint32_t)(sp[9]+sp2[9]+1)>>1) + 1)>>1;
+ dp[10] = (dp[10] + ((uint32_t)(sp[10]+sp2[10]+1)>>1) + 1)>>1;
+ dp[11] = (dp[11] + ((uint32_t)(sp[11]+sp2[11]+1)>>1) + 1)>>1;
+ dp[12] = (dp[12] + ((uint32_t)(sp[12]+sp2[12]+1)>>1) + 1)>>1;
+ dp[13] = (dp[13] + ((uint32_t)(sp[13]+sp2[13]+1)>>1) + 1)>>1;
+ dp[14] = (dp[14] + ((uint32_t)(sp[14]+sp2[14]+1)>>1) + 1)>>1;
+ dp[15] = (dp[15] + ((uint32_t)(sp[15]+sp2[15]+1)>>1) + 1)>>1;
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+}
+
+static inline void mrecva(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp2+0),mm3);
+ movq_m2r(m_(dp +0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm6,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp +8),mm1);
+ movq_m2r(m_(sp2+8),mm3);
+ movq_m2r(m_(dp +8),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm6,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void recvac(uint8_t *s, uint8_t *d, int lx,int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ int j; for( j=0; j<h; ++j ) {
+ dp[0] = (dp[0] + ((uint32_t)(sp[0]+sp2[0]+1)>>1) + 1)>>1;
+ dp[1] = (dp[1] + ((uint32_t)(sp[1]+sp2[1]+1)>>1) + 1)>>1;
+ dp[2] = (dp[2] + ((uint32_t)(sp[2]+sp2[2]+1)>>1) + 1)>>1;
+ dp[3] = (dp[3] + ((uint32_t)(sp[3]+sp2[3]+1)>>1) + 1)>>1;
+ dp[4] = (dp[4] + ((uint32_t)(sp[4]+sp2[4]+1)>>1) + 1)>>1;
+ dp[5] = (dp[5] + ((uint32_t)(sp[5]+sp2[5]+1)>>1) + 1)>>1;
+ dp[6] = (dp[6] + ((uint32_t)(sp[6]+sp2[6]+1)>>1) + 1)>>1;
+ dp[7] = (dp[7] + ((uint32_t)(sp[7]+sp2[7]+1)>>1) + 1)>>1;
+ sp += lx2; sp2 += lx2; dp+= lx2;
+ }
+}
+
+static inline void mrecvac(uint8_t *s, uint8_t *d, int lx,int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp2+0),mm3);
+ movq_m2r(m_(dp +0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm6,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rech(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ uint32_t s1, s2;
+ int j; for( j=0; j<h; ++j ) {
+ s1=sp[0];
+ dp[0] = (uint32_t)(s1+(s2=sp[1])+1)>>1;
+ dp[1] = (uint32_t)(s2+(s1=sp[2])+1)>>1;
+ dp[2] = (uint32_t)(s1+(s2=sp[3])+1)>>1;
+ dp[3] = (uint32_t)(s2+(s1=sp[4])+1)>>1;
+ dp[4] = (uint32_t)(s1+(s2=sp[5])+1)>>1;
+ dp[5] = (uint32_t)(s2+(s1=sp[6])+1)>>1;
+ dp[6] = (uint32_t)(s1+(s2=sp[7])+1)>>1;
+ dp[7] = (uint32_t)(s2+(s1=sp[8])+1)>>1;
+ dp[8] = (uint32_t)(s1+(s2=sp[9])+1)>>1;
+ dp[9] = (uint32_t)(s2+(s1=sp[10])+1)>>1;
+ dp[10] = (uint32_t)(s1+(s2=sp[11])+1)>>1;
+ dp[11] = (uint32_t)(s2+(s1=sp[12])+1)>>1;
+ dp[12] = (uint32_t)(s1+(s2=sp[13])+1)>>1;
+ dp[13] = (uint32_t)(s2+(s1=sp[14])+1)>>1;
+ dp[14] = (uint32_t)(s1+(s2=sp[15])+1)>>1;
+ dp[15] = (uint32_t)(s2+sp[16]+1)>>1;
+ sp += lx2; dp += lx2;
+ }
+}
+
+static inline void mrech(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp+0),mm1);
+ movq_m2r(m_(sp+1),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp+8),mm1);
+ movq_m2r(m_(sp+9),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rechc(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ uint32_t s1, s2;
+ int j; for( j=0; j<h; ++j ) {
+ s1=sp[0];
+ dp[0] = (uint32_t)(s1+(s2=sp[1])+1)>>1;
+ dp[1] = (uint32_t)(s2+(s1=sp[2])+1)>>1;
+ dp[2] = (uint32_t)(s1+(s2=sp[3])+1)>>1;
+ dp[3] = (uint32_t)(s2+(s1=sp[4])+1)>>1;
+ dp[4] = (uint32_t)(s1+(s2=sp[5])+1)>>1;
+ dp[5] = (uint32_t)(s2+(s1=sp[6])+1)>>1;
+ dp[6] = (uint32_t)(s1+(s2=sp[7])+1)>>1;
+ dp[7] = (uint32_t)(s2+sp[8]+1)>>1;
+ sp += lx2; dp += lx2;
+ }
+}
+
+static inline void mrechc(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp+0),mm1);
+ movq_m2r(m_(sp+1),mm3);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; dp += lx2;
+ }
+ emms();
+}
+
+static inline void recha(uint8_t *s, uint8_t *d,int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ uint32_t s1, s2;
+ int j; for( j=0; j<h; ++j ) {
+ s1 = sp[0];
+ dp[0] = (dp[0] + ((uint32_t)(s1 + (s2 = sp[1]) + 1) >> 1) + 1) >> 1;
+ dp[1] = (dp[1] + ((uint32_t)(s2 + (s1 = sp[2]) + 1) >> 1) + 1) >> 1;
+ dp[2] = (dp[2] + ((uint32_t)(s1 + (s2 = sp[3]) + 1) >> 1) + 1) >> 1;
+ dp[3] = (dp[3] + ((uint32_t)(s2 + (s1 = sp[4]) + 1) >> 1) + 1) >> 1;
+ dp[4] = (dp[4] + ((uint32_t)(s1 + (s2 = sp[5]) + 1) >> 1) + 1) >> 1;
+ dp[5] = (dp[5] + ((uint32_t)(s2 + (s1 = sp[6]) + 1) >> 1) + 1) >> 1;
+ dp[6] = (dp[6] + ((uint32_t)(s1 + (s2 = sp[7]) + 1) >> 1) + 1) >> 1;
+ dp[7] = (dp[7] + ((uint32_t)(s2 + (s1 = sp[8]) + 1) >> 1) + 1) >> 1;
+ dp[8] = (dp[8] + ((uint32_t)(s1 + (s2 = sp[9]) + 1) >> 1) + 1) >> 1;
+ dp[9] = (dp[9] + ((uint32_t)(s2 + (s1 = sp[10]) + 1) >> 1) + 1) >> 1;
+ dp[10] = (dp[10] + ((uint32_t)(s1 + (s2 = sp[11]) + 1) >> 1) + 1) >> 1;
+ dp[11] = (dp[11] + ((uint32_t)(s2 + (s1 = sp[12]) + 1) >> 1) + 1) >> 1;
+ dp[12] = (dp[12] + ((uint32_t)(s1 + (s2 = sp[13]) + 1) >> 1) + 1) >> 1;
+ dp[13] = (dp[13] + ((uint32_t)(s2 + (s1 = sp[14]) + 1) >> 1) + 1) >> 1;
+ dp[14] = (dp[14] + ((uint32_t)(s1 + (s2 = sp[15]) + 1) >> 1) + 1) >> 1;
+ dp[15] = (dp[15] + ((uint32_t)(s2 + sp[16] + 1) >> 1) + 1) >> 1;
+ sp += lx2; dp += lx2;
+ }
+}
+
+static inline void mrecha(uint8_t *s, uint8_t *d,int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp+0),mm1);
+ movq_m2r(m_(sp+1),mm3);
+ movq_m2r(m_(dp+0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm6,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp+8),mm1);
+ movq_m2r(m_(sp+9),mm3);
+ movq_m2r(m_(dp+8),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm6,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rechac(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ uint32_t s1, s2;
+ int j; for( j=0; j<h; ++j ) {
+ s1 = sp[0];
+ dp[0] = (dp[0] + ((uint32_t)(s1 + (s2 = sp[1]) + 1) >> 1) + 1) >> 1;
+ dp[1] = (dp[1] + ((uint32_t)(s2 + (s1 = sp[2]) + 1) >> 1) + 1) >> 1;
+ dp[2] = (dp[2] + ((uint32_t)(s1 + (s2 = sp[3]) + 1) >> 1) + 1) >> 1;
+ dp[3] = (dp[3] + ((uint32_t)(s2 + (s1 = sp[4]) + 1) >> 1) + 1) >> 1;
+ dp[4] = (dp[4] + ((uint32_t)(s1 + (s2 = sp[5]) + 1) >> 1) + 1) >> 1;
+ dp[5] = (dp[5] + ((uint32_t)(s2 + (s1 = sp[6]) + 1) >> 1) + 1) >> 1;
+ dp[6] = (dp[6] + ((uint32_t)(s1 + (s2 = sp[7]) + 1) >> 1) + 1) >> 1;
+ dp[7] = (dp[7] + ((uint32_t)(s2 + sp[8] + 1) >> 1) + 1) >> 1;
+ sp += lx2; dp += lx2;
+ }
+}
+
+static inline void mrechac(uint8_t *s, uint8_t *d, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd1),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp+0),mm1);
+ movq_m2r(m_(sp+1),mm3);
+ movq_m2r(m_(dp+0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm6,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rec4(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ uint32_t s1, s2, s3, s4;
+ int j; for( j=0; j<h; ++j ) {
+ s1=sp[0]; s3=sp2[0];
+ dp[0] = (uint32_t)(s1+(s2=sp[1])+s3+(s4=sp2[1])+2)>>2;
+ dp[1] = (uint32_t)(s2+(s1=sp[2])+s4+(s3=sp2[2])+2)>>2;
+ dp[2] = (uint32_t)(s1+(s2=sp[3])+s3+(s4=sp2[3])+2)>>2;
+ dp[3] = (uint32_t)(s2+(s1=sp[4])+s4+(s3=sp2[4])+2)>>2;
+ dp[4] = (uint32_t)(s1+(s2=sp[5])+s3+(s4=sp2[5])+2)>>2;
+ dp[5] = (uint32_t)(s2+(s1=sp[6])+s4+(s3=sp2[6])+2)>>2;
+ dp[6] = (uint32_t)(s1+(s2=sp[7])+s3+(s4=sp2[7])+2)>>2;
+ dp[7] = (uint32_t)(s2+(s1=sp[8])+s4+(s3=sp2[8])+2)>>2;
+ dp[8] = (uint32_t)(s1+(s2=sp[9])+s3+(s4=sp2[9])+2)>>2;
+ dp[9] = (uint32_t)(s2+(s1=sp[10])+s4+(s3=sp2[10])+2)>>2;
+ dp[10] = (uint32_t)(s1+(s2=sp[11])+s3+(s4=sp2[11])+2)>>2;
+ dp[11] = (uint32_t)(s2+(s1=sp[12])+s4+(s3=sp2[12])+2)>>2;
+ dp[12] = (uint32_t)(s1+(s2=sp[13])+s3+(s4=sp2[13])+2)>>2;
+ dp[13] = (uint32_t)(s2+(s1=sp[14])+s4+(s3=sp2[14])+2)>>2;
+ dp[14] = (uint32_t)(s1+(s2=sp[15])+s3+(s4=sp2[15])+2)>>2;
+ dp[15] = (uint32_t)(s2+sp[16]+s4+sp2[16]+2)>>2;
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+}
+
+static inline void mrec4(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd2),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp +1),mm3);
+ movq_m2r(m_(sp2+0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ movq_m2r(m_(sp2+1),mm3);
+ paddusw_r2r(mm4,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm5,mm3);
+ paddusw_r2r(mm6,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(2,mm1);
+ psrlw_i2r(2,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp +8),mm1);
+ movq_m2r(m_(sp +9),mm3);
+ movq_m2r(m_(sp2+8),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ movq_m2r(m_(sp2+9),mm3);
+ paddusw_r2r(mm4,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm5,mm3);
+ paddusw_r2r(mm6,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(2,mm1);
+ psrlw_i2r(2,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rec4c(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ uint32_t s1, s2, s3, s4;
+ int j; for( j=0; j<h; ++j ) {
+ s1=sp[0]; s3=sp2[0];
+ dp[0] = (uint32_t)(s1+(s2=sp[1])+s3+(s4=sp2[1])+2)>>2;
+ dp[1] = (uint32_t)(s2+(s1=sp[2])+s4+(s3=sp2[2])+2)>>2;
+ dp[2] = (uint32_t)(s1+(s2=sp[3])+s3+(s4=sp2[3])+2)>>2;
+ dp[3] = (uint32_t)(s2+(s1=sp[4])+s4+(s3=sp2[4])+2)>>2;
+ dp[4] = (uint32_t)(s1+(s2=sp[5])+s3+(s4=sp2[5])+2)>>2;
+ dp[5] = (uint32_t)(s2+(s1=sp[6])+s4+(s3=sp2[6])+2)>>2;
+ dp[6] = (uint32_t)(s1+(s2=sp[7])+s3+(s4=sp2[7])+2)>>2;
+ dp[7] = (uint32_t)(s2+sp[8]+s4+sp2[8]+2)>>2;
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+}
+
+static inline void mrec4c(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd2),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp +1),mm3);
+ movq_m2r(m_(sp2+0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ movq_m2r(m_(sp2+1),mm3);
+ paddusw_r2r(mm4,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm5,mm3);
+ paddusw_r2r(mm6,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm7,mm1);
+ paddusw_r2r(mm7,mm2);
+ psrlw_i2r(2,mm1);
+ psrlw_i2r(2,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rec4a(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ uint32_t s1, s2, s3, s4;
+ int j; for( j=0; j<h; ++j ) {
+ s1 = sp[0]; s3 = sp2[0];
+ dp[0] = (dp[0] + ((uint32_t)(s1+(s2=sp[1])+s3+(s4=sp2[1])+2)>>2) + 1)>>1;
+ dp[1] = (dp[1] + ((uint32_t)(s2+(s1=sp[2])+s4+(s3=sp2[2])+2)>>2) + 1)>>1;
+ dp[2] = (dp[2] + ((uint32_t)(s1+(s2=sp[3])+s3+(s4=sp2[3])+2)>>2) + 1)>>1;
+ dp[3] = (dp[3] + ((uint32_t)(s2+(s1=sp[4])+s4+(s3=sp2[4])+2)>>2) + 1)>>1;
+ dp[4] = (dp[4] + ((uint32_t)(s1+(s2=sp[5])+s3+(s4=sp2[5])+2)>>2) + 1)>>1;
+ dp[5] = (dp[5] + ((uint32_t)(s2+(s1=sp[6])+s4+(s3=sp2[6])+2)>>2) + 1)>>1;
+ dp[6] = (dp[6] + ((uint32_t)(s1+(s2=sp[7])+s3+(s4=sp2[7])+2)>>2) + 1)>>1;
+ dp[7] = (dp[7] + ((uint32_t)(s2+(s1=sp[8])+s4+(s3=sp2[8])+2)>>2) + 1)>>1;
+ dp[8] = (dp[8] + ((uint32_t)(s1+(s2=sp[9])+s3+(s4=sp2[9])+2)>>2) + 1)>>1;
+ dp[9] = (dp[9] + ((uint32_t)(s2+(s1=sp[10])+s4+(s3=sp2[10])+2)>>2) + 1)>>1;
+ dp[10] = (dp[10] + ((uint32_t)(s1+(s2=sp[11])+s3+(s4=sp2[11])+2)>>2) + 1)>>1;
+ dp[11] = (dp[11] + ((uint32_t)(s2+(s1=sp[12])+s4+(s3=sp2[12])+2)>>2) + 1)>>1;
+ dp[12] = (dp[12] + ((uint32_t)(s1+(s2=sp[13])+s3+(s4=sp2[13])+2)>>2) + 1)>>1;
+ dp[13] = (dp[13] + ((uint32_t)(s2+(s1=sp[14])+s4+(s3=sp2[14])+2)>>2) + 1)>>1;
+ dp[14] = (dp[14] + ((uint32_t)(s1+(s2=sp[15])+s3+(s4=sp2[15])+2)>>2) + 1)>>1;
+ dp[15] = (dp[15] + ((uint32_t)(s2+sp[16]+s4+sp2[16]+2)>>2) + 1)>>1;
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+}
+
+static inline void mrec4a(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd2),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp +1),mm3);
+ movq_m2r(m_(sp2+0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ movq_m2r(m_(sp2+1),mm3);
+ paddusw_r2r(mm4,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm5,mm3);
+ paddusw_r2r(mm6,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ movq_m2r(m_(dp +0),mm3);
+ paddusw_r2r(mm7,mm1);
+ movq_r2r(mm3,mm4);
+ paddusw_r2r(mm7,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ psrlw_i2r(2,mm1);
+ psrlw_i2r(2,mm2);
+ movq_m2r(m_(sadd1),mm5);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm5,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ movq_m2r(m_(sp +8),mm1);
+ movq_m2r(m_(sp +9),mm3);
+ movq_m2r(m_(sp2+8),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ movq_m2r(m_(sp2+9),mm3);
+ paddusw_r2r(mm4,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm5,mm3);
+ paddusw_r2r(mm6,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ movq_m2r(m_(dp +8),mm3);
+ paddusw_r2r(mm7,mm1);
+ movq_r2r(mm3,mm4);
+ paddusw_r2r(mm7,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ psrlw_i2r(2,mm1);
+ psrlw_i2r(2,mm2);
+ movq_m2r(m_(sadd1),mm5);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm5,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+8));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+static inline void rec4ac(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ uint32_t s1,s2,s3,s4;
+ int j; for( j=0; j<h; ++j ) {
+ s1=sp[0]; s3=sp2[0];
+ dp[0] = (dp[0] + ((uint32_t)(s1+(s2=sp[1])+s3+(s4=sp2[1])+2)>>2) + 1)>>1;
+ dp[1] = (dp[1] + ((uint32_t)(s2+(s1=sp[2])+s4+(s3=sp2[2])+2)>>2) + 1)>>1;
+ dp[2] = (dp[2] + ((uint32_t)(s1+(s2=sp[3])+s3+(s4=sp2[3])+2)>>2) + 1)>>1;
+ dp[3] = (dp[3] + ((uint32_t)(s2+(s1=sp[4])+s4+(s3=sp2[4])+2)>>2) + 1)>>1;
+ dp[4] = (dp[4] + ((uint32_t)(s1+(s2=sp[5])+s3+(s4=sp2[5])+2)>>2) + 1)>>1;
+ dp[5] = (dp[5] + ((uint32_t)(s2+(s1=sp[6])+s4+(s3=sp2[6])+2)>>2) + 1)>>1;
+ dp[6] = (dp[6] + ((uint32_t)(s1+(s2=sp[7])+s3+(s4=sp2[7])+2)>>2) + 1)>>1;
+ dp[7] = (dp[7] + ((uint32_t)(s2+sp[8]+s4+sp2[8]+2)>>2) + 1)>>1;
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+}
+
+static inline void mrec4ac(uint8_t *s, uint8_t *d, int lx, int lx2, int h)
+{
+ uint8_t *dp=d, *sp=s, *sp2=s+lx;
+ pxor_r2r(mm0,mm0);
+ movq_m2r(m_(sadd2),mm7);
+ int j; for( j=0; j<h; ++j ) {
+ movq_m2r(m_(sp +0),mm1);
+ movq_m2r(m_(sp +1),mm3);
+ movq_m2r(m_(sp2+0),mm5);
+ movq_r2r(mm1,mm2);
+ movq_r2r(mm3,mm4);
+ movq_r2r(mm5,mm6);
+ punpcklbw_r2r(mm0,mm1);
+ punpckhbw_r2r(mm0,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ punpcklbw_r2r(mm0,mm5);
+ punpckhbw_r2r(mm0,mm6);
+ paddusw_r2r(mm3,mm1);
+ movq_m2r(m_(sp2+1),mm3);
+ paddusw_r2r(mm4,mm2);
+ movq_r2r(mm3,mm4);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ paddusw_r2r(mm5,mm3);
+ paddusw_r2r(mm6,mm4);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ movq_m2r(m_(dp +0),mm3);
+ paddusw_r2r(mm7,mm1);
+ movq_r2r(mm3,mm4);
+ paddusw_r2r(mm7,mm2);
+ punpcklbw_r2r(mm0,mm3);
+ punpckhbw_r2r(mm0,mm4);
+ psrlw_i2r(2,mm1);
+ psrlw_i2r(2,mm2);
+ movq_m2r(m_(sadd1),mm5);
+ paddusw_r2r(mm3,mm1);
+ paddusw_r2r(mm4,mm2);
+ paddusw_r2r(mm5,mm1);
+ paddusw_r2r(mm5,mm2);
+ psrlw_i2r(1,mm1);
+ psrlw_i2r(1,mm2);
+ packuswb_r2r(mm2,mm1);
+ movq_r2m(mm1,m_(dp+0));
+ sp += lx2; sp2 += lx2; dp += lx2;
+ }
+ emms();
+}
+
+
+
+int main(int ac, char **av)
+{
+ int i, j, k, l, m, n, done;
+ uint8_t dat0[32], dat1[32], dat2[32];
+ for( m=0; m<14; ++m ) {
+ done = 0;
+ printf("m=%d\n",m);
+ n = 16 - 8*(m&1);
+ for( i=0; i<256 && !done ; ++i ) {
+ for( j=0; j<256 && !done; j+=n ) {
+ k = 0;
+ for( k=0; k<256; k+=n ) {
+ for( l=0; l<n; ++l ) {
+ dat0[l] = i;
+ dat1[l] = dat2[l] = j+l;
+ dat0[l+16] = dat1[l+16] = dat2[l+16] = k;
+ }
+ switch( m ) {
+ case 0:
+ reca (&dat0[0], &dat1[0], 16, 1);
+ mreca (&dat0[0], &dat2[0], 16, 1);
+ break;
+ case 1:
+ recac (&dat0[0], &dat1[0], 16, 1);
+ mrecac (&dat0[0], &dat2[0], 16, 1);
+ break;
+ case 2:
+ recv (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrecv (&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 3:
+ recvc (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrecvc (&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 4:
+ recva (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrecva (&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 5:
+ recvac (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrecvac(&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 6:
+ rech (&dat0[0], &dat1[0], 16, 1);
+ mrech (&dat0[0], &dat2[0], 16, 1);
+ break;
+ case 7:
+ rechc (&dat0[0], &dat1[0], 16, 1);
+ mrechc (&dat0[0], &dat2[0], 16, 1);
+ break;
+ case 8:
+ recha (&dat0[0], &dat1[0], 16, 1);
+ mrecha (&dat0[0], &dat2[0], 16, 1);
+ break;
+ case 9:
+ rechac (&dat0[0], &dat1[0], 16, 1);
+ mrechac(&dat0[0], &dat2[0], 16, 1);
+ break;
+ case 10:
+ rec4 (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrec4 (&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 11:
+ rec4c (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrec4c (&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 12:
+ rec4a (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrec4a (&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ case 13:
+ rec4ac (&dat0[0], &dat1[0], 0x10, 16, 1);
+ mrec4ac(&dat0[0], &dat2[0], 0x10, 16, 1);
+ break;
+ }
+ }
+ if( (m&1) ) {
+ if( *(uint64_t *)&dat1[0] != *(uint64_t *)&dat2[0] )
+ {
+ printf("k=%d\n",k);
+ printf(" i=%5d %02x %02x %02x %02x %02x %02x %02x %02x\n", i,
+ dat1[0], dat1[1], dat1[2], dat1[3], dat1[4], dat1[5], dat1[6], dat1[7]);
+ printf(" j=%5d %02x %02x %02x %02x %02x %02x %02x %02x\n", j,
+ dat2[0], dat2[1], dat2[2], dat2[3], dat2[4], dat2[5], dat2[6], dat2[7]);
+ done = 1;
+ break;
+ }
+ }
+ else {
+ if( *(uint64_t *)&dat1[0] != *(uint64_t *)&dat2[0] ||
+ *(uint64_t *)&dat1[8] != *(uint64_t *)&dat2[8] )
+ {
+ printf("k=%d\n",k);
+ printf(" i=%5d %02x %02x %02x %02x %02x %02x %02x %02x", i,
+ dat1[0], dat1[1], dat1[2], dat1[3], dat1[4], dat1[5], dat1[6], dat1[7]);
+ printf(" %02x %02x %02x %02x %02x %02x %02x %02x\n", dat1[8],
+ dat1[9], dat1[10], dat1[11], dat1[12], dat1[13], dat1[14], dat1[15]);
+ printf(" j=%5d %02x %02x %02x %02x %02x %02x %02x %02x", j,
+ dat2[0], dat2[1], dat2[2], dat2[3], dat2[4], dat2[5], dat2[6], dat2[7]);
+ printf(" %02x %02x %02x %02x %02x %02x %02x %02x\n", dat2[8],
+ dat2[9], dat2[10], dat2[11], dat2[12], dat2[13], dat2[14], dat2[15]);
+ done = 1;
+ break;
+ }
+ }
+ }
+ }
+ }
+ return 0;
+}
+