--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/genericopenlibs/liboil/src/i386/wavelet.c Tue Aug 31 16:54:36 2010 +0300
@@ -0,0 +1,2347 @@
+//Portions Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved.
+/*
+Copyright 2002,2003,2004,2005 David A. Schleef <ds@schleef.org>
+ All rights reserved.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions
+ are met:
+ 1. Redistributions of source code must retain the above copyright
+ notice, this list of conditions and the following disclaimer.
+ 2. Redistributions in binary form must reproduce the above copyright
+ notice, this list of conditions and the following disclaimer in the
+ documentation and/or other materials provided with the distribution.
+
+ THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
+ WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
+ INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
+ (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
+ STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
+ IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include <liboil/liboilfunction.h>
+#include <liboil/liboilclasses.h>
+
+
+void
+split_53_nomix (int16_t *d_2xn, int16_t *s_2xn, int n)
+{
+ int i;
+
+ if (n == 0) return;
+ /* predict */
+ for(i=1;i<n*2-2;i+=2){
+ d_2xn[i] = s_2xn[i] - ((s_2xn[i-1] + s_2xn[i+1]) >> 1);
+ }
+ d_2xn[n*2-1] = s_2xn[n*2-1] - s_2xn[n*2-2];
+
+ /* update */
+ d_2xn[0] = s_2xn[0] + (d_2xn[1] >> 1);
+ for(i=2;i<n*2;i+=2){
+ d_2xn[i] = s_2xn[i] + ((d_2xn[i-1] + d_2xn[i+1]) >> 2);
+ }
+}
+OIL_DEFINE_IMPL (split_53_nomix, split_53);
+
+#if 0
+void
+synth_53_nomix (int16_t *d_2xn, int16_t *s_2xn, int n)
+{
+ int i;
+
+ /* predict */
+ i_n[0] -= i_n[1] >> 1;
+ for(i=2;i<n*2;i+=2){
+ i_n[i] -= (i_n[i-1] + i_n[i+1]) >> 2;
+ }
+
+ /* update */
+ for(i=1;i<n*2-2;i+=2){
+ i_n[i] += (i_n[i+1] + i_n[i-1]) >> 1;
+ }
+ i_n[n*2-1] += i_n[n*2-2];
+}
+#endif
+
+
+void
+split_53_c (int16_t *d_2xn, int16_t *s_2xn, int n)
+{
+ int i;
+
+ if (n == 0) return;
+ if (n == 1) {
+ d_2xn[1] = s_2xn[1] - s_2xn[0];
+ d_2xn[0] = s_2xn[0] + (d_2xn[1] >> 1);
+ } else {
+ d_2xn[1] = s_2xn[1] - ((s_2xn[0] + s_2xn[2]) >> 1);
+ d_2xn[0] = s_2xn[0] + (d_2xn[1] >> 1);
+ d_2xn+=2;
+ s_2xn+=2;
+ for(i=0;i<(n*2-4)/2;i++){
+ d_2xn[1] = s_2xn[1] - ((s_2xn[0] + s_2xn[2]) >> 1);
+ d_2xn[0] = s_2xn[0] + ((d_2xn[-1] + d_2xn[1]) >> 2);
+ d_2xn+=2;
+ s_2xn+=2;
+ }
+ d_2xn[1] = s_2xn[1] - s_2xn[0];
+ d_2xn[0] = s_2xn[0] + ((d_2xn[-1] + d_2xn[1]) >> 2);
+ }
+}
+OIL_DEFINE_IMPL (split_53_c, split_53);
+
+void
+synth_53_c (int16_t *d_2xn, int16_t *s_2xn, int n)
+{
+ int i;
+
+ if (n == 0) return;
+ if (n == 1) {
+ d_2xn[0] = s_2xn[0] - (s_2xn[1] >> 1);
+ d_2xn[1] = s_2xn[1] + d_2xn[0];
+ } else {
+ d_2xn[0] = s_2xn[0] - (s_2xn[1] >> 1);
+ for(i=2;i<n*2-2;i+=2){
+ d_2xn[i] = s_2xn[i] - ((s_2xn[i-1] + s_2xn[i+1]) >> 2);
+ d_2xn[i-1] = s_2xn[i-1] + ((d_2xn[i] + d_2xn[i-2]) >> 1);
+ }
+ d_2xn[n*2-2] = s_2xn[n*2-2] - ((s_2xn[n*2-3] + s_2xn[n*2-1]) >> 2);
+ d_2xn[n*2-3] = s_2xn[n*2-3] + ((d_2xn[n*2-2] + d_2xn[n*2-4]) >> 1);
+ d_2xn[n*2-1] = s_2xn[n*2-1] + d_2xn[n*2-2];
+ }
+}
+OIL_DEFINE_IMPL (synth_53_c, synth_53);
+
+void
+deinterleave2_c_1 (int16_t *d1, int16_t *d2, int16_t *s_2xn, int n)
+{
+ int i;
+
+ for(i=0;i<n;i++) {
+ d1[i] = s_2xn[2*i];
+ d2[i] = s_2xn[2*i + 1];
+ }
+}
+OIL_DEFINE_IMPL (deinterleave2_c_1, deinterleave2_s16);
+
+void
+deinterleave2_asm (int16_t *d1, int16_t *d2, int16_t *s_2xn, int n)
+{
+ if (n == 0) return;
+
+ while (n&1) {
+ d1[0] = s_2xn[0];
+ d2[0] = s_2xn[1];
+ d1++;
+ d2++;
+ s_2xn+=2;
+ n--;
+ }
+
+ asm volatile ("\n"
+ " mov %3, %%ecx\n"
+ " sub $2, %%ecx\n"
+ "1:\n"
+ " movw (%1,%%ecx,4), %%ax\n"
+ " movw %%ax, (%0,%%ecx,2)\n"
+ " movw 2(%1,%%ecx,4), %%ax\n"
+ " movw %%ax, (%2,%%ecx,2)\n"
+ " movw 4(%1,%%ecx,4), %%ax\n"
+ " movw %%ax, 2(%0,%%ecx,2)\n"
+ " movw 6(%1,%%ecx,4), %%ax\n"
+ " movw %%ax, 2(%2,%%ecx,2)\n"
+ " sub $2, %%ecx\n"
+ " jge 1b\n"
+ : "+r" (d1), "+r" (s_2xn), "+r" (d2)
+ : "m" (n)
+ : "eax", "ecx");
+}
+OIL_DEFINE_IMPL (deinterleave2_asm, deinterleave2_s16);
+
+void
+deinterleave2_mmx (int16_t *d1, int16_t *d2, int16_t *s_2xn, int n)
+{
+ while (n&3) {
+ d1[0] = s_2xn[0];
+ d2[0] = s_2xn[1];
+ d1++;
+ d2++;
+ s_2xn+=2;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%1,%%ecx,4), %%mm0\n"
+ " movq 8(%1,%%ecx,4), %%mm1\n"
+ " pslld $16, %%mm0\n"
+ " pslld $16, %%mm1\n"
+ " psrad $16, %%mm0\n"
+ " psrad $16, %%mm1\n"
+ " packssdw %%mm1, %%mm0\n"
+ " movq %%mm0, (%0,%%ecx,2)\n"
+ " movq (%1,%%ecx,4), %%mm0\n"
+ " movq 8(%1,%%ecx,4), %%mm1\n"
+ " psrad $16, %%mm0\n"
+ " psrad $16, %%mm1\n"
+ " packssdw %%mm1, %%mm0\n"
+ " movq %%mm0, (%2,%%ecx,2)\n"
+ " add $4, %%ecx\n"
+ " cmp %3, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s_2xn), "+r" (d2)
+ : "m" (n)
+ : "eax", "ecx");
+}
+OIL_DEFINE_IMPL_FULL (deinterleave2_mmx, deinterleave2_s16, OIL_IMPL_FLAG_MMX);
+
+void
+deinterleave2_mmx_2 (int16_t *d1, int16_t *d2, int16_t *s_2xn, int n)
+{
+ while (n&3) {
+ d1[0] = s_2xn[0];
+ d2[0] = s_2xn[1];
+ d1++;
+ d2++;
+ s_2xn+=2;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " pshufw $0xd8, (%1,%%ecx,4), %%mm0\n"
+ " movd %%mm0, (%0,%%ecx,2)\n"
+ " pshufw $0x8d, (%1,%%ecx,4), %%mm0\n"
+ " movd %%mm0, (%2,%%ecx,2)\n"
+ " add $2, %%ecx\n"
+ " cmp %3, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s_2xn), "+r" (d2)
+ : "m" (n)
+ : "eax", "ecx");
+}
+OIL_DEFINE_IMPL_FULL (deinterleave2_mmx_2, deinterleave2_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+void
+deinterleave2_mmx_3 (int16_t *d1, int16_t *d2, int16_t *s_2xn, int n)
+{
+ while (n&3) {
+ d1[0] = s_2xn[0];
+ d2[0] = s_2xn[1];
+ d1++;
+ d2++;
+ s_2xn+=2;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%1,%%ecx,4), %%mm1\n"
+ " movq (%1,%%ecx,4), %%mm2\n"
+ " movq 8(%1,%%ecx,4), %%mm0\n"
+ " punpcklwd %%mm0, %%mm1\n"
+ " punpckhwd %%mm0, %%mm2\n"
+ " movq %%mm1, %%mm0\n"
+ " punpcklwd %%mm2, %%mm0\n"
+ " punpckhwd %%mm2, %%mm1\n"
+ " movq %%mm0, (%0,%%ecx,2)\n"
+ " movq %%mm1, (%2,%%ecx,2)\n"
+ " add $4, %%ecx\n"
+ " cmp %3, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s_2xn), "+r" (d2)
+ : "m" (n)
+ : "eax", "ecx");
+}
+OIL_DEFINE_IMPL_FULL (deinterleave2_mmx_3, deinterleave2_s16, OIL_IMPL_FLAG_MMX);
+
+void
+deinterleave2_mmx_4 (int16_t *d1, int16_t *d2, int16_t *s_2xn, int n)
+{
+ while (n&7) {
+ d1[0] = s_2xn[0];
+ d2[0] = s_2xn[1];
+ d1++;
+ d2++;
+ s_2xn+=2;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%1,%%ecx,4), %%mm1\n"
+ " movq %%mm1, %%mm2\n"
+ " movq 8(%1,%%ecx,4), %%mm0\n"
+ " movq 16(%1,%%ecx,4), %%mm5\n"
+ " punpcklwd %%mm0, %%mm1\n"
+ " movq %%mm5, %%mm6\n"
+ " punpckhwd %%mm0, %%mm2\n"
+ " movq 24(%1,%%ecx,4), %%mm4\n"
+ " movq %%mm1, %%mm0\n"
+ " punpcklwd %%mm4, %%mm5\n"
+ " punpcklwd %%mm2, %%mm0\n"
+ " punpckhwd %%mm4, %%mm6\n"
+ " punpckhwd %%mm2, %%mm1\n"
+ " movq %%mm5, %%mm4\n"
+ " movq %%mm0, (%0,%%ecx,2)\n"
+ " punpcklwd %%mm6, %%mm4\n"
+ " movq %%mm1, (%2,%%ecx,2)\n"
+ " punpckhwd %%mm6, %%mm5\n"
+ " movq %%mm4, 8(%0,%%ecx,2)\n"
+ " movq %%mm5, 8(%2,%%ecx,2)\n"
+ " add $8, %%ecx\n"
+ " cmp %3, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s_2xn), "+r" (d2)
+ : "m" (n)
+ : "eax", "ecx");
+}
+OIL_DEFINE_IMPL_FULL (deinterleave2_mmx_4, deinterleave2_s16, OIL_IMPL_FLAG_MMX);
+
+
+void
+lift_add_mult_shift12_i386_mmx (int16_t *d, int16_t *s1, int16_t *s2,
+ int16_t *s3, int16_t *s4, int n)
+{
+ uint32_t val = *s4;
+
+ while (n&3) {
+ d[0] = s1[0] + ((s4[0]*(s2[0] + s3[0]))>>12);
+ d++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ if (n==0) return;
+
+ val = ((*(uint16_t *)s4)<<16) | (*(uint16_t *)s4);
+ n>>=2;
+ asm volatile ("\n"
+ " mov %4, %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " punpcklwd %%mm7, %%mm7\n"
+ " mov %5, %%ecx\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " paddsw 0(%3), %%mm0\n"
+ " movq %%mm0, %%mm1\n"
+ " pmullw %%mm7, %%mm0\n"
+ " pmulhw %%mm7, %%mm1\n"
+ " psrlw $12, %%mm0\n"
+ " psllw $4, %%mm1\n"
+ " por %%mm1, %%mm0\n"
+ " paddsw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " add $8, %3\n"
+ " decl %%ecx\n"
+ " jne 1b\n"
+ " emms\n"
+ : "+r" (d), "+r" (s1), "+r" (s2), "+r" (s3)
+ : "m" (val), "m" (n)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lift_add_mult_shift12_i386_mmx, lift_add_mult_shift12, OIL_IMPL_FLAG_MMX);
+
+void
+interleave2_mmx (int16_t *d_2xn, int16_t *s1, int16_t *s2, int n)
+{
+ while (n&3) {
+ d_2xn[0] = s1[0];
+ d_2xn[1] = s2[0];
+ s1++;
+ s2++;
+ d_2xn+=2;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%1,%%ecx,2), %%mm0\n"
+ " movq (%2,%%ecx,2), %%mm1\n"
+ " movq %%mm0, %%mm2\n"
+ " punpckhwd %%mm1, %%mm0\n"
+ " punpcklwd %%mm1, %%mm2\n"
+ " movq %%mm2, (%0,%%ecx,4)\n"
+ " movq %%mm0, 8(%0,%%ecx,4)\n"
+ " add $4, %%ecx\n"
+ " cmp %3, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d_2xn), "+r" (s1), "+r" (s2)
+ : "m" (n)
+ : "eax", "ecx");
+}
+OIL_DEFINE_IMPL_FULL (interleave2_mmx, interleave2_s16, OIL_IMPL_FLAG_MMX);
+
+void
+lift_add_shift1_mmx (int16_t *d, int16_t *s1, int16_t *s2, int16_t *s3, int n)
+{
+ while (n&3) {
+ d[0] = s1[0] + ((s2[0] + s3[0])>>1);
+ d++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%2,%%ecx,2), %%mm1\n"
+ " movq (%3,%%ecx,2), %%mm2\n"
+ " paddw %%mm2, %%mm1\n"
+ " psraw $1, %%mm1\n"
+ " paddw (%1,%%ecx,2), %%mm1\n"
+ " movq %%mm1, (%0,%%ecx,2)\n"
+ " add $4, %%ecx\n"
+ " cmp %4, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d), "+r" (s1), "+r" (s2), "+r" (s3)
+ : "m" (n)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lift_add_shift1_mmx, lift_add_shift1, OIL_IMPL_FLAG_MMX);
+
+void
+lift_sub_shift1_mmx (int16_t *d, int16_t *s1, int16_t *s2, int16_t *s3, int n)
+{
+ while (n&3) {
+ d[0] = s1[0] - ((s2[0] + s3[0])>>1);
+ d++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%2,%%ecx,2), %%mm1\n"
+ " movq (%3,%%ecx,2), %%mm2\n"
+ " movq (%1,%%ecx,2), %%mm0\n"
+ " paddw %%mm2, %%mm1\n"
+ " psraw $1, %%mm1\n"
+ " psubw %%mm1, %%mm0\n"
+ " movq %%mm0, (%0,%%ecx,2)\n"
+ " add $4, %%ecx\n"
+ " cmp %4, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d), "+r" (s1), "+r" (s2), "+r" (s3)
+ : "m" (n)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lift_sub_shift1_mmx, lift_sub_shift1, OIL_IMPL_FLAG_MMX);
+
+void
+lift_add_shift2_mmx (int16_t *d, int16_t *s1, int16_t *s2, int16_t *s3, int n)
+{
+ while (n&3) {
+ d[0] = s1[0] + ((s2[0] + s3[0])>>2);
+ d++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%2,%%ecx,2), %%mm1\n"
+ " movq (%3,%%ecx,2), %%mm2\n"
+ " paddw %%mm2, %%mm1\n"
+ " psraw $2, %%mm1\n"
+ " paddw (%1,%%ecx,2), %%mm1\n"
+ " movq %%mm1, (%0,%%ecx,2)\n"
+ " add $4, %%ecx\n"
+ " cmp %4, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d), "+r" (s1), "+r" (s2), "+r" (s3)
+ : "m" (n)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lift_add_shift2_mmx, lift_add_shift2, OIL_IMPL_FLAG_MMX);
+
+void
+lift_sub_shift2_mmx (int16_t *d, int16_t *s1, int16_t *s2, int16_t *s3, int n)
+{
+ while (n&3) {
+ d[0] = s1[0] - ((s2[0] + s3[0])>>2);
+ d++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ if (n==0) return;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq (%2,%%ecx,2), %%mm1\n"
+ " movq (%3,%%ecx,2), %%mm2\n"
+ " movq (%1,%%ecx,2), %%mm0\n"
+ " paddw %%mm2, %%mm1\n"
+ " psraw $2, %%mm1\n"
+ " psubw %%mm1, %%mm0\n"
+ " movq %%mm0, (%0,%%ecx,2)\n"
+ " add $4, %%ecx\n"
+ " cmp %4, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d), "+r" (s1), "+r" (s2), "+r" (s3)
+ : "m" (n)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lift_sub_shift2_mmx, lift_sub_shift2, OIL_IMPL_FLAG_MMX);
+
+#ifdef ENABLE_BROKEN_IMPLS
+void
+synth_53_mmx (int16_t *d_2xn, int16_t *s_2xn, int n)
+{
+ int i;
+
+ if (n==0) return;
+ if (n == 1) {
+ d_2xn[0] = s_2xn[0] - (s_2xn[1] >> 1);
+ d_2xn[1] = s_2xn[1] + d_2xn[0];
+ } else {
+ int i;
+
+ d_2xn[0] = s_2xn[0] - (s_2xn[1] >> 1);
+
+ if (n > 6) {
+ n-=5;
+
+ asm volatile ("\n"
+ " xor %%ecx, %%ecx\n"
+ " movw 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " movw 0(%0), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ " movw 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+
+ " xor %%ecx, %%ecx\n"
+ "1:\n"
+ " movq 4(%1,%%ecx,4), %%mm1\n" // mm1 = s5 s4 s3 s2
+ " movq %%mm1, %%mm2\n" // mm2 = s5 s4 s3 s2
+ " movq 12(%1,%%ecx,4), %%mm0\n" // mm0 = s9 s8 s7 s6
+ " punpcklwd %%mm0, %%mm1\n" // mm1 = s7 s3 s6 s2
+ " punpckhwd %%mm0, %%mm2\n" // mm2 = s9 s5 s8 s4
+ " movq %%mm1, %%mm0\n" // mm0 = s7 s3 s6 s2
+ " punpcklwd %%mm2, %%mm0\n" // mm0 = s8 s6 s4 s2
+ " punpckhwd %%mm2, %%mm1\n" // mm1 = s9 s7 s5 s3
+ //" movq %%mm0, %%mm3\n" // mm0 = s8 s6 s4 s2
+
+ " movq %%mm1, %%mm2\n" // mm2 = s9 s7 s5 s3
+ " psllq $16, %%mm2\n" // mm2 = s7 s5 s3 00
+ " por %%mm7, %%mm2\n" // mm2 = s7 s5 s3 s1
+ " movq %%mm2, %%mm4\n" // mm4 = s7 s5 s3 s1
+ " paddw %%mm1, %%mm2\n" // mm2 = s9+s7 ...
+ " psraw $2, %%mm2\n" // mm2 = (s9+s7)>>2 ...
+ " movq %%mm1, %%mm7\n" // mm7 = s9 s7 s5 s3
+ " psrlq $48, %%mm7\n" // mm7 = 00 00 00 s9
+ " psubw %%mm2, %%mm0\n" // mm0 = d8 d6 d4 d2
+
+ " movq %%mm0, %%mm1\n" // mm1 = d8 d6 d4 d2
+ " movq %%mm0, %%mm3\n" // mm1 = d8 d6 d4 d2
+ " psllq $16, %%mm0\n" // mm0 = d6 d4 d2 00
+ " por %%mm6, %%mm0\n" // mm0 = d6 d4 d2 d0
+ " psrlq $48, %%mm1\n" // mm1 = 00 00 00 d8
+ " movq %%mm1, %%mm6\n" // mm6 = 00 00 00 d8
+
+ " movq %%mm0, %%mm1\n"
+ " paddw %%mm3, %%mm1\n" // mm0 = d8+d6 ...
+ " psraw $1, %%mm1\n" // mm1 = (d8+d6)>>1 ...
+ " paddw %%mm4, %%mm1\n" // mm1 = d7 d5 d3 d1
+
+ " movq %%mm1, %%mm2\n"
+
+ " movq %%mm0, %%mm1\n"
+ " punpcklwd %%mm2, %%mm0\n"
+ " punpckhwd %%mm2, %%mm1\n"
+
+ " movq %%mm0, (%0, %%ecx, 4)\n"
+ " movq %%mm1, 8(%0, %%ecx, 4)\n"
+
+ " add $4, %%ecx\n"
+ " cmp %3, %%ecx\n"
+ " jl 1b\n"
+ " emms\n"
+ : "+r" (d_2xn), "+r" (s_2xn), "+ecx" (i)
+ : "m" (n));
+
+ i*=2;
+ n+=5;
+ d_2xn[i] = s_2xn[i] - ((s_2xn[i-1] + s_2xn[i+1]) >> 2);
+ i+=2;
+ } else {
+ i = 2;
+ }
+ for(;i<n*2-2;i+=2){
+ d_2xn[i] = s_2xn[i] - ((s_2xn[i-1] + s_2xn[i+1]) >> 2);
+ d_2xn[i-1] = s_2xn[i-1] + ((d_2xn[i] + d_2xn[i-2]) >> 1);
+ }
+ d_2xn[n*2-2] = s_2xn[n*2-2] - ((s_2xn[n*2-3] + s_2xn[n*2-1]) >> 2);
+ d_2xn[n*2-3] = s_2xn[n*2-3] + ((d_2xn[n*2-2] + d_2xn[n*2-4]) >> 1);
+ d_2xn[n*2-1] = s_2xn[n*2-1] + d_2xn[n*2-2];
+ }
+}
+OIL_DEFINE_IMPL_FULL (synth_53_mmx, synth_53, OIL_IMPL_FLAG_MMX);
+#endif
+
+
+void
+mas2_add_s16_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ int shift = s4_2[1];
+
+ while (n&3) {
+ int x;
+
+ x = s4_2[0] + s2[0]*s3_2[0] + s2[1]*s3_2[1];
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movzwl 0(%0), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ " pshufw $0x00, %%mm6, %%mm6\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x44, %%mm5, %%mm5\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n" // mm0 = s0, s1, s2, s3
+ " movq 0(%2), %%mm1\n" // mm1 = s0, s1, s2, s3
+ " pmullw %%mm7, %%mm0\n" // mm0 = lo(s0*a0), lo(s1*a0), ...
+ " pmulhw %%mm7, %%mm1\n" // mm1 = hi(s0*a0), hi(s1*a0), ...
+ " movq %%mm0, %%mm2\n" // mm2 = lo(s0*a0), lo(s1*a0), ...
+ " punpcklwd %%mm1, %%mm0\n" // mm0 = s0*a0, s1*a0
+ " punpckhwd %%mm1, %%mm2\n" // mm2 = s2*a0, s3*a0
+ " movq %%mm2, %%mm1\n" // mm1 = s2*a0, s3*a0
+
+ " movq 2(%2), %%mm2\n"
+ " movq 2(%2), %%mm3\n"
+ " pmullw %%mm6, %%mm2\n"
+ " pmulhw %%mm6, %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n" // mm2 = s1*a1, s2*a1
+ " punpckhwd %%mm3, %%mm4\n" // mm4 = s3*a1, s4*a1
+ " movq %%mm4, %%mm3\n" // mm3 = s3*a1, s4*a1
+
+ " paddd %%mm3, %%mm1\n" // mm1 = s2*a0 + s3*a1, ...
+ " paddd %%mm2, %%mm0\n" // mm0 = s0*a0 + s1*a1, ...
+
+ " paddd %%mm5, %%mm1\n" // mm1 = s2*a0 + s3*a1 + offset, ...
+ " paddd %%mm5, %%mm0\n" // mm0 = s0*a0 + s1*a1 + offset, ...
+
+ " movd %4, %%mm4\n"
+ " psrad %%mm4, %%mm1\n" // mm1 = (s2*a0 + s3*a1 + offset)>>shift, ...
+ " psrad %%mm4, %%mm0\n" // mm0 = (s0*a0 + s1*a1 + offset)>>shift, ...
+
+ " packssdw %%mm1, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ : "r" (shift)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas2_add_s16_mmx, mas2_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+#if 0
+void
+mas2_add_s16_lim_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ int shift = s4_2[1];
+
+ while (n&3) {
+ int x;
+
+ x = s4_2[0] + s2[0]*s3_2[0] + s2[1]*s3_2[1];
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movzwl 0(%0), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ " pshufw $0x00, %%mm6, %%mm6\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x44, %%mm5, %%mm5\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " paddq 2(%2), %%mm0\n"
+
+ " movd %4, %%mm4\n"
+ " psraw %%mm4, %%mm0\n"
+
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ : "r" (shift)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas2_add_s16_lim_mmx, mas2_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+#endif
+
+void
+mas4_add_s16_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_4,
+ int16_t *s4_2, int n)
+{
+ int shift = s4_2[1];
+ //int m;
+
+ //m = n&3;
+#if 1
+ while (n&3) {
+ int x;
+ int i;
+
+ x = s4_2[0];
+ for(i=0;i<4;i++){
+ x += s2[i]*s3_4[i];
+ }
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+#endif
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movq 0(%0), %%mm7\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x44, %%mm5, %%mm5\n"
+ :: "r" (s3_4), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n" // mm0 = s0, s1, s2, s3
+ " movq 0(%2), %%mm1\n" // mm1 = s0, s1, s2, s3
+ " pshufw $0x00, %%mm7, %%mm6\n"
+ " pmullw %%mm6, %%mm0\n" // mm0 = lo(s0*a0), lo(s1*a0), ...
+ " pmulhw %%mm6, %%mm1\n" // mm1 = hi(s0*a0), hi(s1*a0), ...
+ " movq %%mm0, %%mm2\n" // mm2 = lo(s0*a0), lo(s1*a0), ...
+ " punpcklwd %%mm1, %%mm0\n" // mm0 = s0*a0, s1*a0
+ " punpckhwd %%mm1, %%mm2\n" // mm2 = s2*a0, s3*a0
+ " movq %%mm2, %%mm1\n" // mm1 = s2*a0, s3*a0
+
+ " movq 2(%2), %%mm2\n"
+ " movq 2(%2), %%mm3\n"
+ " pshufw $0x55, %%mm7, %%mm6\n"
+ " pmullw %%mm6, %%mm2\n"
+ " pmulhw %%mm6, %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n" // mm2 = s1*a1, s2*a1
+ " punpckhwd %%mm3, %%mm4\n" // mm4 = s3*a1, s4*a1
+ " movq %%mm4, %%mm3\n" // mm3 = s3*a1, s4*a1
+ " paddd %%mm3, %%mm1\n" // mm1 = s2*a0 + s3*a1, ...
+ " paddd %%mm2, %%mm0\n" // mm0 = s0*a0 + s1*a1, ...
+
+ " movq 4(%2), %%mm2\n"
+ " movq 4(%2), %%mm3\n"
+ " pshufw $0xaa, %%mm7, %%mm6\n"
+ " pmullw %%mm6, %%mm2\n"
+ " pmulhw %%mm6, %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " movq %%mm4, %%mm3\n"
+ " paddd %%mm3, %%mm1\n"
+ " paddd %%mm2, %%mm0\n"
+
+ " movq 6(%2), %%mm2\n"
+ " movq 6(%2), %%mm3\n"
+ " pshufw $0xff, %%mm7, %%mm6\n"
+ " pmullw %%mm6, %%mm2\n"
+ " pmulhw %%mm6, %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " movq %%mm4, %%mm3\n"
+ " paddd %%mm3, %%mm1\n"
+ " paddd %%mm2, %%mm0\n"
+
+ " paddd %%mm5, %%mm1\n"
+ " paddd %%mm5, %%mm0\n"
+
+ " movd %4, %%mm4\n"
+ " psrad %%mm4, %%mm1\n"
+ " psrad %%mm4, %%mm0\n"
+
+ " packssdw %%mm1, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ : "r" (shift)
+ );
+#if 0
+ while (m) {
+ int x;
+ int i;
+
+ x = s4_2[0];
+ for(i=0;i<4;i++){
+ x += s2[i]*s3_4[i];
+ }
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ m--;
+ }
+#endif
+}
+OIL_DEFINE_IMPL_FULL (mas4_add_s16_mmx, mas4_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+#if 0
+/* This only does 16-bit intermediates, whereas the ref specifies 32-bit */
+void
+mas2_add_s16_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ while (n&3) {
+ int x;
+
+ x = s4_2[0] + s2[0]*s3_2[0] + s2[1]*s3_2[1];
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movzwl 0(%0), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ " pshufw $0x00, %%mm6, %%mm6\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x00, %%mm5, %%mm5\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmullw %%mm7, %%mm0\n"
+ " movq 2(%2), %%mm1\n"
+ " pmullw %%mm6, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " paddw %%mm5, %%mm0\n"
+ " psraw %%mm4, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas2_add_s16_mmx, mas2_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+#endif
+
+
+#if 0
+/* This only does 16-bit intermediates, whereas the ref specifies 32-bit */
+void
+mas4_add_s16_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ while (n&3) {
+ int x;
+
+ x = s4_2[0] + s2[0]*s3_2[0] + s2[1]*s3_2[1] +
+ s2[2]*s3_2[2] + s2[2]*s3_2[2];
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movzwl 0(%0), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ " pshufw $0x00, %%mm6, %%mm6\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x00, %%mm5, %%mm5\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ " pshufw $0x00, %%mm4, %%mm4\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm3\n"
+ " pshufw $0x00, %%mm3, %%mm3\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm2\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmullw %%mm7, %%mm0\n"
+ " movq 2(%2), %%mm1\n"
+ " pmullw %%mm6, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " movq 4(%2), %%mm1\n"
+ " pmullw %%mm5, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " movq 6(%2), %%mm1\n"
+ " pmullw %%mm4, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " paddw %%mm3, %%mm0\n"
+ " psraw %%mm2, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas4_add_s16_mmx, mas4_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+#endif
+
+
+#if 0
+/* This only does 16-bit intermediates, whereas the ref specifies 32-bit */
+void
+mas8_add_s16_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ while (n&3) {
+ int x;
+ int i;
+
+ x = s4_2[0];
+ for(i=0;i<8;i++){
+ x += s2[i]*s3_2[i];
+ }
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movq 0(%0), %%mm6\n"
+ " movq 8(%0), %%mm7\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm3\n"
+ " pshufw $0x00, %%mm3, %%mm3\n"
+ " pxor %%mm4, %%mm4\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " pshufw $0x00, %%mm6, %%mm1\n"
+ " movq 0(%2), %%mm0\n"
+ " pmullw %%mm1, %%mm0\n"
+ " pshufw $0x55, %%mm6, %%mm2\n"
+ " movq 2(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0xaa, %%mm6, %%mm2\n"
+ " movq 4(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0xff, %%mm6, %%mm2\n"
+ " movq 6(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+
+ " pshufw $0x00, %%mm7, %%mm2\n"
+ " movq 8(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0x55, %%mm7, %%mm2\n"
+ " movq 10(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0xaa, %%mm7, %%mm2\n"
+ " movq 12(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0xff, %%mm7, %%mm2\n"
+ " movq 14(%2), %%mm1\n"
+ " pmullw %%mm2, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+
+ " paddw %%mm3, %%mm0\n"
+ " psraw %%mm4, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas8_add_s16_mmx, mas8_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+#endif
+
+
+void
+mas4_add_s16_pmaddwd (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ if (n==0) return;
+ asm volatile ("\n"
+ " movq 0(%0), %%mm6\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm3\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmaddwd %%mm6, %%mm0\n"
+ " pshufw $0xee, %%mm0, %%mm1\n" // 11 10 11 10
+ " paddd %%mm1, %%mm0\n"
+ " paddd %%mm3, %%mm0\n"
+ " psrad %%mm4, %%mm0\n"
+ " movd %%mm0, %%eax\n"
+ " addw 0(%1), %%ax\n"
+ " movw %%ax, 0(%0)\n"
+ " add $2, %0\n"
+ " add $2, %1\n"
+ " add $2, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ :
+ : "eax"
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas4_add_s16_pmaddwd, mas4_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+void
+mas4_add_s16_pmaddwd_2 (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ if (n==0) return;
+ asm volatile ("\n"
+ " movq 0(%0), %%mm6\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm3\n"
+ " pshufw $0x44, %%mm3, %%mm3\n" // 01 00 01 00
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ if (n&1) {
+ asm volatile ("\n"
+ " movq 0(%2), %%mm0\n"
+ " pmaddwd %%mm6, %%mm0\n"
+ " pshufw $0xee, %%mm0, %%mm1\n" // 11 10 11 10
+ " paddd %%mm1, %%mm0\n"
+ " paddd %%mm3, %%mm0\n"
+ " psrad %%mm4, %%mm0\n"
+ " movd %%mm0, %%eax\n"
+ " addw 0(%1), %%ax\n"
+ " movw %%ax, 0(%0)\n"
+ " add $2, %0\n"
+ " add $2, %1\n"
+ " add $2, %2\n"
+ " decl %3\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ :
+ : "eax"
+ );
+ }
+ n>>=1;
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmaddwd %%mm6, %%mm0\n"
+ " movq 2(%2), %%mm2\n"
+ " pmaddwd %%mm6, %%mm2\n"
+
+ " movq %%mm0, %%mm1\n"
+ " punpckhdq %%mm2, %%mm0\n"
+ " punpckldq %%mm2, %%mm1\n"
+
+ " paddd %%mm1, %%mm0\n"
+ " paddd %%mm3, %%mm0\n"
+ " psrad %%mm4, %%mm0\n"
+ " pshufw $0xd8, %%mm0, %%mm0\n" // 11 01 10 00
+
+ " paddw 0(%1), %%mm0\n"
+ " movd %%mm0, 0(%0)\n"
+ " add $4, %0\n"
+ " add $4, %1\n"
+ " add $4, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ :
+ : "eax"
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas4_add_s16_pmaddwd_2, mas4_add_s16, OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+void
+mas8_add_s16_pmaddwd (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ if (n==0) return;
+ asm volatile ("\n"
+ " movq 0(%0), %%mm6\n"
+ " movq 8(%0), %%mm7\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm3\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmaddwd %%mm6, %%mm0\n"
+ " movq 8(%2), %%mm1\n"
+ " pmaddwd %%mm7, %%mm1\n"
+ " paddd %%mm1, %%mm0\n"
+ " pshufw $0xee, %%mm0, %%mm1\n"
+ " paddd %%mm1, %%mm0\n"
+ " paddd %%mm3, %%mm0\n"
+ " psrad %%mm4, %%mm0\n"
+ " movd %%mm0, %%eax\n"
+ " addw 0(%1), %%ax\n"
+ " movw %%ax, 0(%0)\n"
+ " add $2, %0\n"
+ " add $2, %1\n"
+ " add $2, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ :
+ : "eax"
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas8_add_s16_pmaddwd, mas8_add_s16, OIL_IMPL_FLAG_MMX|OIL_IMPL_FLAG_MMXEXT);
+
+
+
+#if 0
+void
+mas8_add_s16_pmaddwd2 (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ while (n&3) {
+ int x;
+ int i;
+
+ x = s4_2[0];
+ for(i=0;i<8;i++){
+ x += s2[i]*s3_2[i];
+ }
+ x >>= s4_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ asm volatile ("\n"
+ " movq 0(%0), %%mm6\n"
+ " movq 8(%0), %%mm7\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x00, %%mm5, %%mm5\n"
+ " pxor %%mm4, %%mm4\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmaddwd %%mm6, %%mm0\n"
+ " movq 8(%2), %%mm1\n"
+ " pmaddwd %%mm7, %%mm1\n"
+ " paddd %%mm1, %%mm0\n"
+ " pshufw $0xee, %%mm0, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+
+ " movq 2(%2), %%mm2\n"
+ " pmaddwd %%mm6, %%mm2\n"
+ " movq 10(%2), %%mm3\n"
+ " pmaddwd %%mm7, %%mm3\n"
+ " paddd %%mm3, %%mm2\n"
+ " pshufw $0xee, %%mm2, %%mm3\n"
+ " paddw %%mm3, %%mm2\n"
+ " pextrw $0, %%mm2, %%eax\n"
+ " pinsrw $1, %%eax, %%mm0\n"
+
+ " movq 4(%2), %%mm2\n"
+ " pmaddwd %%mm6, %%mm2\n"
+ " movq 12(%2), %%mm3\n"
+ " pmaddwd %%mm7, %%mm3\n"
+ " paddd %%mm3, %%mm2\n"
+ " pshufw $0xee, %%mm2, %%mm3\n"
+ " paddw %%mm3, %%mm2\n"
+ " pextrw $0, %%mm2, %%eax\n"
+ " pinsrw $2, %%eax, %%mm0\n"
+
+ " movq 6(%2), %%mm2\n"
+ " pmaddwd %%mm6, %%mm2\n"
+ " movq 14(%2), %%mm3\n"
+ " pmaddwd %%mm7, %%mm3\n"
+ " paddd %%mm3, %%mm2\n"
+ " pshufw $0xee, %%mm2, %%mm3\n"
+ " paddw %%mm3, %%mm2\n"
+ " pextrw $0, %%mm2, %%eax\n"
+ " pinsrw $3, %%eax, %%mm0\n"
+
+ " paddw %%mm5, %%mm0\n"
+ " psraw %%mm4, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ :
+ : "eax"
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas8_add_s16_pmaddwd2, mas8_add_s16, OIL_IMPL_FLAG_SSE);
+#endif
+
+#if 0
+/* This only does 16-bit intermediates, whereas the ref specifies 32-bit */
+void
+mas8_add_s16_sse2 (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3_2,
+ int16_t *s4_2, int n)
+{
+ asm volatile ("\n"
+ " movq 0(%0), %%mm6\n"
+ " movq 8(%0), %%mm7\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm3\n"
+ " pshufw $0x00, %%mm3, %%mm3\n"
+ " pxor %%mm4, %%mm4\n"
+ " movzwl 2(%1), %%ecx\n"
+ " movd %%ecx, %%mm4\n"
+ :: "r" (s3_2), "r" (s4_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmullw %%mm6, %%mm0\n"
+ " movq 8(%2), %%mm1\n"
+ " pmullw %%mm7, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0xee, %%mm0, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " pshufw $0x01, %%mm0, %%mm1\n"
+ " paddw %%mm1, %%mm0\n"
+ " paddw %%mm3, %%mm0\n"
+ " psraw %%mm4, %%mm0\n"
+ " movd %%mm0, %%eax\n"
+ " addw 0(%1), %%ax\n"
+ " movw %%ax, 0(%0)\n"
+ " add $2, %0\n"
+ " add $2, %1\n"
+ " add $2, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (n)
+ :
+ : "eax"
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas8_add_s16_sse2, mas8_add_s16, OIL_IMPL_FLAG_SSE);
+#endif
+
+void
+mas2_across_add_s16_mmx (int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3,
+ int16_t *s4_2, int16_t *s5_2, int n)
+{
+ int shift = s5_2[1];
+
+ while (n&3) {
+ int x;
+
+ x = s5_2[0] + s2[0]*s4_2[0] + s3[0]*s4_2[1];
+ x >>= s5_2[1];
+ d1[0] = s1[0] + x;
+
+ d1++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ if (n==0) return;
+
+ n>>=2;
+ if (n==0) return;
+ asm volatile ("\n"
+ " movzwl 0(%0), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%0), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ " pshufw $0x00, %%mm6, %%mm6\n"
+ " movzwl 0(%1), %%ecx\n"
+ " movd %%ecx, %%mm5\n"
+ " pshufw $0x44, %%mm5, %%mm5\n"
+ :: "r" (s4_2), "r" (s5_2)
+ : "ecx"
+ );
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n" // mm0 = s0, s1, s2, s3
+ " movq 0(%2), %%mm1\n" // mm1 = s0, s1, s2, s3
+ " pmullw %%mm7, %%mm0\n" // mm0 = lo(s0*a0), lo(s1*a0), ...
+ " pmulhw %%mm7, %%mm1\n" // mm1 = hi(s0*a0), hi(s1*a0), ...
+ " movq %%mm0, %%mm2\n" // mm2 = lo(s0*a0), lo(s1*a0), ...
+ " punpcklwd %%mm1, %%mm0\n" // mm0 = s0*a0, s1*a0
+ " punpckhwd %%mm1, %%mm2\n" // mm2 = s2*a0, s3*a0
+ " movq %%mm2, %%mm1\n" // mm1 = s2*a0, s3*a0
+
+ " movq 0(%3), %%mm2\n"
+ " movq 0(%3), %%mm3\n"
+ " pmullw %%mm6, %%mm2\n"
+ " pmulhw %%mm6, %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n" // mm2 = s1*a1, s2*a1
+ " punpckhwd %%mm3, %%mm4\n" // mm4 = s3*a1, s4*a1
+ " movq %%mm4, %%mm3\n" // mm3 = s3*a1, s4*a1
+
+ " paddd %%mm3, %%mm1\n" // mm1 = s2*a0 + s3*a1, ...
+ " paddd %%mm2, %%mm0\n" // mm0 = s0*a0 + s1*a1, ...
+
+ " paddd %%mm5, %%mm1\n" // mm1 = s2*a0 + s3*a1 + offset, ...
+ " paddd %%mm5, %%mm0\n" // mm0 = s0*a0 + s1*a1 + offset, ...
+
+ " movd %5, %%mm4\n"
+ " psrad %%mm4, %%mm1\n" // mm1 = (s2*a0 + s3*a1 + offset)>>shift, ...
+ " psrad %%mm4, %%mm0\n" // mm0 = (s0*a0 + s1*a1 + offset)>>shift, ...
+
+ " packssdw %%mm1, %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " add $8, %3\n"
+ " decl %4\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (s3), "+m" (n)
+ : "r" (shift)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas2_across_add_s16_mmx, mas2_across_add_s16,
+ OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+void
+add_const_rshift_s16_mmx(int16_t *d1, int16_t *s1, int16_t *s2_2, int n)
+{
+ while(n&3) {
+ d1[0] = (s1[0] + s2_2[0])>>s2_2[1];
+ d1++;
+ s1++;
+ n--;
+ }
+ n>>=2;
+ if (n==0) return;
+ asm volatile ("\n"
+ " movzwl 0(%2), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%2), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ "1:\n"
+ " movq 0(%1), %%mm0\n"
+ " paddsw %%mm7, %%mm0\n"
+ " psraw %%mm6, %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2_2), "+r" (n)
+ :
+ : "ecx"
+ );
+
+}
+OIL_DEFINE_IMPL_FULL (add_const_rshift_s16_mmx, add_const_rshift_s16,
+ OIL_IMPL_FLAG_MMX | OIL_IMPL_FLAG_MMXEXT);
+
+void
+multiply_and_add_s16_mmx(int16_t *d1, int16_t *s1, int16_t *s2, int16_t *s3, int n)
+{
+ while(n&3) {
+ d1[0] = s1[0] + s2[0]*s3[0];
+ d1++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ n>>=2;
+ if (n==0) return;
+ asm volatile ("\n"
+ "1:\n"
+ " movq 0(%2), %%mm0\n"
+ " pmullw 0(%3), %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " add $8, %3\n"
+ " decl %4\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (s3), "+r" (n)
+ );
+
+}
+OIL_DEFINE_IMPL_FULL (multiply_and_add_s16_mmx, multiply_and_add_s16,
+ OIL_IMPL_FLAG_MMX);
+
+void
+multiply_and_add_s16_u8_mmx(int16_t *d1, int16_t *s1, int16_t *s2,
+ uint8_t *s3, int n)
+{
+ while(n&3) {
+ d1[0] = s1[0] + s2[0]*s3[0];
+ d1++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ n>>=2;
+ if (n==0) return;
+ asm volatile ("\n"
+ " pxor %%mm7, %%mm7\n"
+ "1:\n"
+ " movd 0(%3), %%mm0\n"
+ " punpcklbw %%mm7, %%mm0\n"
+ " pmullw 0(%2), %%mm0\n"
+ " paddw 0(%1), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " add $8, %0\n"
+ " add $8, %1\n"
+ " add $8, %2\n"
+ " add $4, %3\n"
+ " decl %4\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (s3), "+r" (n)
+ );
+
+}
+OIL_DEFINE_IMPL_FULL (multiply_and_add_s16_u8_mmx, multiply_and_add_s16_u8,
+ OIL_IMPL_FLAG_MMX);
+
+void
+multiply_and_add_s16_u8_mmx_2(int16_t *d1, int16_t *s1, int16_t *s2,
+ uint8_t *s3, int n)
+{
+ while(n&7) {
+ d1[0] = s1[0] + s2[0]*s3[0];
+ d1++;
+ s1++;
+ s2++;
+ s3++;
+ n--;
+ }
+ n>>=3;
+ if (n==0) return;
+ asm volatile ("\n"
+ " pxor %%mm7, %%mm7\n"
+ "1:\n"
+ " movd 0(%3), %%mm0\n"
+ " punpcklbw %%mm7, %%mm0\n"
+ " movd 4(%3), %%mm1\n"
+ " pmullw 0(%2), %%mm0\n"
+ " punpcklbw %%mm7, %%mm1\n"
+ " paddw 0(%1), %%mm0\n"
+ " pmullw 8(%2), %%mm1\n"
+ " movq %%mm0, 0(%0)\n"
+ " paddw 8(%1), %%mm1\n"
+ " movq %%mm1, 8(%0)\n"
+
+ " add $16, %0\n"
+ " add $16, %1\n"
+ " add $16, %2\n"
+ " add $8, %3\n"
+ " decl %4\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (d1), "+r" (s1), "+r" (s2), "+r" (s3), "+r" (n)
+ );
+
+}
+OIL_DEFINE_IMPL_FULL (multiply_and_add_s16_u8_mmx_2, multiply_and_add_s16_u8,
+ OIL_IMPL_FLAG_MMX);
+
+void
+multiply_and_acc_12xn_s16_u8_mmx (int16_t *i1, int is1, int16_t *s1,
+ int ss1, uint8_t *s2, int ss2, int n)
+{
+ if (n==0) return;
+ __asm__ __volatile__ ("\n"
+ " pxor %%mm7, %%mm7\n"
+ "1:\n"
+ " movd 0(%2), %%mm0\n"
+ " punpcklbw %%mm7, %%mm0\n"
+ " pmullw 0(%1), %%mm0\n"
+ " paddw 0(%0), %%mm0\n"
+ " movq %%mm0, 0(%0)\n"
+ " movd 4(%2), %%mm1\n"
+ " punpcklbw %%mm7, %%mm1\n"
+ " pmullw 8(%1), %%mm1\n"
+ " paddw 8(%0), %%mm1\n"
+ " movq %%mm1, 8(%0)\n"
+ " movd 8(%2), %%mm2\n"
+ " punpcklbw %%mm7, %%mm2\n"
+ " pmullw 16(%1), %%mm2\n"
+ " paddw 16(%0), %%mm2\n"
+ " movq %%mm2, 16(%0)\n"
+
+ " addl %4, %0\n"
+ " addl %5, %1\n"
+ " addl %6, %2\n"
+ " decl %3\n"
+ " jnz 1b\n"
+ " emms\n"
+ : "+r" (i1), "+r" (s1), "+r" (s2), "+r" (n)
+ : "m" (is1), "m" (ss1), "m" (ss2)
+ );
+}
+OIL_DEFINE_IMPL_FULL (multiply_and_acc_12xn_s16_u8_mmx,
+ multiply_and_acc_12xn_s16_u8, OIL_IMPL_FLAG_MMX);
+
+#ifdef ENABLE_BROKEN_IMPLS
+void
+mas4_across_add_s16_mmx (int16_t *d, int16_t *s1, int16_t *s2_nx4, int sstr2,
+ int16_t *s3_4, int16_t *s4_2, int n)
+{
+ int16_t *s2_nx4_off;
+
+ while (n&3) {
+ int x;
+ int j;
+ x = s4_2[0];
+ for(j=0;j<4;j++){
+ x += OIL_GET(s2_nx4, j*sstr2, int16_t)*s3_4[j];
+ }
+ x >>= s4_2[1];
+ d[0] = s1[0] + x;
+
+ n--;
+ d++;
+ s1++;
+ s2_nx4++;
+ }
+ if (n==0) return;
+
+ s2_nx4_off = OIL_OFFSET(s2_nx4, 3*sstr2);
+
+ n >>= 2;
+ __asm__ __volatile__ ("\n"
+ " movq 0(%[s3_4]), %%mm0\n"
+ " pshufw $0x55, %%mm0, %%mm1\n"
+ " pshufw $0xaa, %%mm0, %%mm2\n"
+ " pshufw $0xff, %%mm0, %%mm3\n"
+ " pshufw $0x00, %%mm0, %%mm0\n"
+ " movzwl 0(%[s4_2]), %%ecx\n"
+ " movd %%ecx, %%mm7\n"
+ " pshufw $0x00, %%mm7, %%mm7\n"
+ " movzwl 2(%[s4_2]), %%ecx\n"
+ " movd %%ecx, %%mm6\n"
+ :
+ : [s3_4] "r" (s3_4),
+ [s4_2] "r" (s4_2)
+ : "ecx"
+ );
+
+ __asm__ __volatile__ ("\n"
+ "1:\n"
+ " movq 0(%[s2_nx4]), %%mm4\n"
+ " pmullw %%mm0, %%mm4\n"
+ " movq (%[s2_nx4],%[sstr]), %%mm5\n"
+ " pmullw %%mm1, %%mm5\n"
+ " paddsw %%mm5,%%mm4\n"
+ " movq (%[s2_nx4],%[sstr],2), %%mm5\n"
+ " pmullw %%mm2, %%mm5\n"
+ " paddsw %%mm5,%%mm4\n"
+ " movq (%[s2_nx4_off]), %%mm5\n"
+ " pmullw %%mm3, %%mm5\n"
+ " paddsw %%mm5,%%mm4\n"
+ " paddsw %%mm7, %%mm4\n"
+ " psraw %%mm6, %%mm4\n"
+ " paddsw (%[s1]),%%mm4\n"
+ " movq %%mm4, 0(%[d])\n"
+
+ " addl $8, %[s2_nx4]\n"
+ " addl $8, %[s2_nx4_off]\n"
+ " addl $8, %[s1]\n"
+ " addl $8, %[d]\n"
+ " decl %[n]\n"
+ " jnz 1b\n"
+ " emms\n"
+ : [s2_nx4] "+r" (s2_nx4),
+ [d] "+r" (d),
+ [s2_nx4_off] "+r" (s2_nx4_off),
+ [n] "+m" (n),
+ [s1] "+r" (s1)
+ : [sstr] "r" (sstr2)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas4_across_add_s16_mmx, mas4_across_add_s16,
+ OIL_IMPL_FLAG_MMX|OIL_IMPL_FLAG_MMXEXT);
+#endif
+
+void
+mas4_across_add_s16_mmx (int16_t *d, int16_t *s1, int16_t *s2_nx4, int sstr2,
+ int16_t *s3_4, int16_t *s4_2, int n)
+{
+ int16_t *s2_nx4_off;
+
+ while (n&3) {
+ int x;
+ int j;
+ x = s4_2[0];
+ for(j=0;j<4;j++){
+ x += OIL_GET(s2_nx4, j*sstr2, int16_t)*s3_4[j];
+ }
+ x >>= s4_2[1];
+ d[0] = s1[0] + x;
+
+ n--;
+ d++;
+ s1++;
+ s2_nx4++;
+ }
+ if (n==0) return;
+
+ s2_nx4_off = OIL_OFFSET(s2_nx4, 3*sstr2);
+
+ n >>= 2;
+ __asm__ __volatile__ ("\n"
+ " movq 0(%[s3_4]), %%mm0\n"
+ " pxor %%mm5, %%mm5\n"
+ " movd 0(%[s4_2]), %%mm5\n"
+ :
+ : [s3_4] "r" (s3_4),
+ [s4_2] "r" (s4_2)
+ );
+
+ __asm__ __volatile__ ("\n"
+ "1:\n"
+ " pshufw $0x00, %%mm0, %%mm6\n"
+ " pmullw 0(%[s2_nx4]), %%mm6\n"
+ " pshufw $0x00, %%mm0, %%mm3\n"
+ " pmulhw 0(%[s2_nx4]), %%mm3\n"
+ " movq %%mm6, %%mm7\n"
+ " punpcklwd %%mm3, %%mm6\n"
+ " punpckhwd %%mm3, %%mm7\n"
+
+ " pshufw $0x55, %%mm0, %%mm2\n"
+ " pmullw 0(%[s2_nx4],%[sstr]), %%mm2\n"
+ " pshufw $0x55, %%mm0, %%mm3\n"
+ " pmulhw 0(%[s2_nx4],%[sstr]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " pshufw $0xaa, %%mm0, %%mm2\n"
+ " pmullw 0(%[s2_nx4],%[sstr],2), %%mm2\n"
+ " pshufw $0xaa, %%mm0, %%mm3\n"
+ " pmulhw 0(%[s2_nx4],%[sstr],2), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " pshufw $0xff, %%mm0, %%mm2\n"
+ " pmullw 0(%[s2_nx4_off]), %%mm2\n"
+ " pshufw $0xff, %%mm0, %%mm3\n"
+ " pmulhw 0(%[s2_nx4_off]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " pshufw $0xcc, %%mm5, %%mm1\n"
+ " paddd %%mm1, %%mm6\n"
+ " paddd %%mm1, %%mm7\n"
+
+ " pshufw $0xfd, %%mm5, %%mm1\n"
+ " psrad %%mm1, %%mm6\n"
+ " psrad %%mm1, %%mm7\n"
+ " packssdw %%mm7, %%mm6\n"
+
+ " paddsw (%[s1]),%%mm6\n"
+ " movq %%mm6, 0(%[d])\n"
+
+ " addl $8, %[s2_nx4]\n"
+ " addl $8, %[s2_nx4_off]\n"
+ " addl $8, %[s1]\n"
+ " addl $8, %[d]\n"
+ " decl %[n]\n"
+ " jnz 1b\n"
+ " emms\n"
+ : [s2_nx4] "+r" (s2_nx4),
+ [d] "+r" (d),
+ [s2_nx4_off] "+r" (s2_nx4_off),
+ [n] "+m" (n),
+ [s1] "+r" (s1)
+ : [sstr] "r" (sstr2)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas4_across_add_s16_mmx, mas4_across_add_s16,
+ OIL_IMPL_FLAG_MMX|OIL_IMPL_FLAG_MMXEXT);
+
+void
+mas8_across_add_s16_mmx (int16_t *d, int16_t *s1, int16_t *s2_nx8, int sstr2,
+ int16_t *s3_8, int16_t *s4_2, int n)
+{
+ int16_t *s2_nx8_off;
+ void *tmp = NULL;
+
+ while (n&3) {
+ int x;
+ int j;
+ x = s4_2[0];
+ for(j=0;j<8;j++){
+ x += OIL_GET(s2_nx8, j*sstr2, int16_t)*s3_8[j];
+ }
+ x >>= s4_2[1];
+ d[0] = s1[0] + x;
+
+ n--;
+ d++;
+ s1++;
+ s2_nx8++;
+ }
+ if (n==0) return;
+
+ s2_nx8_off = OIL_OFFSET(s2_nx8, 7*sstr2);
+
+ n >>= 2;
+ __asm__ __volatile__ ("\n"
+ " movq 0(%[s3_8]), %%mm0\n"
+ " pxor %%mm5, %%mm5\n"
+ " movd 0(%[s4_2]), %%mm5\n"
+ :
+ : [s3_8] "r" (s3_8),
+ [s4_2] "r" (s4_2)
+ );
+
+ __asm__ __volatile__ ("\n"
+ "1:\n"
+ " movl %[s2_nx8], %[tmp]\n"
+ " movq 0(%[s3_8]), %%mm0\n"
+
+ " pshufw $0x00, %%mm0, %%mm6\n"
+ " pmullw 0(%[tmp]), %%mm6\n"
+ " pshufw $0x00, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm6, %%mm7\n"
+ " punpcklwd %%mm3, %%mm6\n"
+ " punpckhwd %%mm3, %%mm7\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0x55, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0x55, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0xaa, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0xaa, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0xff, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0xff, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " movq 8(%[s3_8]), %%mm0\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0x00, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0x00, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0x55, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0x55, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0xaa, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0xaa, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " addl %[sstr], %[tmp]\n"
+ " pshufw $0xff, %%mm0, %%mm2\n"
+ " pmullw 0(%[tmp]), %%mm2\n"
+ " pshufw $0xff, %%mm0, %%mm3\n"
+ " pmulhw 0(%[tmp]), %%mm3\n"
+ " movq %%mm2, %%mm4\n"
+ " punpcklwd %%mm3, %%mm2\n"
+ " punpckhwd %%mm3, %%mm4\n"
+ " paddd %%mm2, %%mm6\n"
+ " paddd %%mm4, %%mm7\n"
+
+ " pshufw $0xcc, %%mm5, %%mm1\n"
+ " paddd %%mm1, %%mm6\n"
+ " paddd %%mm1, %%mm7\n"
+
+ " pshufw $0xfd, %%mm5, %%mm1\n"
+ " psrad %%mm1, %%mm6\n"
+ " psrad %%mm1, %%mm7\n"
+ " packssdw %%mm7, %%mm6\n"
+
+ " paddsw (%[s1]),%%mm6\n"
+ " movq %%mm6, 0(%[d])\n"
+
+ " addl $8, %[s2_nx8]\n"
+ " addl $8, %[s1]\n"
+ " addl $8, %[d]\n"
+ " decl %[n]\n"
+ " jnz 1b\n"
+ " emms\n"
+ : [s2_nx8] "+r" (s2_nx8),
+ [tmp] "+r" (tmp),
+ [s3_8] "+r" (s3_8),
+ [d] "+r" (d),
+ [n] "+m" (n),
+ [s1] "+r" (s1)
+ : [sstr] "m" (sstr2)
+ );
+}
+OIL_DEFINE_IMPL_FULL (mas8_across_add_s16_mmx, mas8_across_add_s16,
+ OIL_IMPL_FLAG_MMX|OIL_IMPL_FLAG_MMXEXT);
+
+void
+lshift_s16_mmx(int16_t *d1, int16_t *s1, int16_t *s3_1, int n)
+{
+ while (n&3) {
+ d1[0] = s1[0]<<s3_1[0];
+ d1++;
+ s1++;
+ n--;
+ }
+ n >>= 2;
+ __asm__ __volatile__ ("\n"
+ " movzwl 0(%[s3_1]), %%ecx\n"
+ " movd %%ecx, %%mm1\n"
+ "1:\n"
+ " movq 0(%[s1]), %%mm0\n"
+ " psllw %%mm1, %%mm0\n"
+ " movq %%mm0, 0(%[d1])\n"
+ " add $8, %[d1]\n"
+ " add $8, %[s1]\n"
+ " decl %[n]\n"
+ " jnz 1b\n"
+ " emms"
+ : [d1] "+r" (d1),
+ [s1] "+r" (s1),
+ [n] "+r" (n)
+ : [s3_1] "r" (s3_1)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lshift_s16_mmx, lshift_s16, OIL_IMPL_FLAG_MMX);
+
+void
+lshift_s16_mmx_2(int16_t *d1, int16_t *s1, int16_t *s3_1, int n)
+{
+ while (n&7) {
+ d1[0] = s1[0]<<s3_1[0];
+ d1++;
+ s1++;
+ n--;
+ }
+ n >>= 3;
+ if (n == 0) return;
+ __asm__ __volatile__ ("\n"
+ " movzwl 0(%[s3_1]), %%ecx\n"
+ " movd %%ecx, %%mm1\n"
+ "1:\n"
+ " movq 0(%[s1]), %%mm0\n"
+ " psllw %%mm1, %%mm0\n"
+ " movq %%mm0, 0(%[d1])\n"
+ " movq 8(%[s1]), %%mm0\n"
+ " psllw %%mm1, %%mm0\n"
+ " movq %%mm0, 8(%[d1])\n"
+ " add $16, %[d1]\n"
+ " add $16, %[s1]\n"
+ " decl %[n]\n"
+ " jnz 1b\n"
+ " emms"
+ : [d1] "+r" (d1),
+ [s1] "+r" (s1),
+ [n] "+r" (n)
+ : [s3_1] "r" (s3_1)
+ : "ecx");
+}
+OIL_DEFINE_IMPL_FULL (lshift_s16_mmx_2, lshift_s16, OIL_IMPL_FLAG_MMX);
+
+
+
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_deinterleave2_mmx, deinterleave2_s16() {
+ return &_oil_function_impl_deinterleave2_mmx, deinterleave2_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_deinterleave2_mmx_2, deinterleave2_s16() {
+ return &_oil_function_impl_deinterleave2_mmx_2, deinterleave2_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_deinterleave2_mmx_3, deinterleave2_s16() {
+ return &_oil_function_impl_deinterleave2_mmx_3, deinterleave2_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_deinterleave2_mmx_4, deinterleave2_s16() {
+ return &_oil_function_impl_deinterleave2_mmx_4, deinterleave2_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lift_add_mult_shift12_i386_mmx, lift_add_mult_shift12() {
+ return &_oil_function_impl_lift_add_mult_shift12_i386_mmx, lift_add_mult_shift12;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_interleave2_mmx, interleave2_s16() {
+ return &_oil_function_impl_interleave2_mmx, interleave2_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lift_add_shift1_mmx, lift_add_shift1() {
+ return &_oil_function_impl_lift_add_shift1_mmx, lift_add_shift1;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lift_sub_shift1_mmx, lift_sub_shift1() {
+ return &_oil_function_impl_lift_sub_shift1_mmx, lift_sub_shift1;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lift_add_shift2_mmx, lift_add_shift2() {
+ return &_oil_function_impl_lift_add_shift2_mmx, lift_add_shift2;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lift_sub_shift2_mmx, lift_sub_shift2() {
+ return &_oil_function_impl_lift_sub_shift2_mmx, lift_sub_shift2;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_synth_53_mmx, synth_53() {
+ return &_oil_function_impl_synth_53_mmx, synth_53;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas2_add_s16_mmx, mas2_add_s16() {
+ return &_oil_function_impl_mas2_add_s16_mmx, mas2_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas2_add_s16_lim_mmx, mas2_add_s16() {
+ return &_oil_function_impl_mas2_add_s16_lim_mmx, mas2_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas4_add_s16_mmx, mas4_add_s16() {
+ return &_oil_function_impl_mas4_add_s16_mmx, mas4_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas2_add_s16_mmx, mas2_add_s16() {
+ return &_oil_function_impl_mas2_add_s16_mmx, mas2_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas4_add_s16_mmx, mas4_add_s16() {
+ return &_oil_function_impl_mas4_add_s16_mmx, mas4_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas8_add_s16_mmx, mas8_add_s16() {
+ return &_oil_function_impl_mas8_add_s16_mmx, mas8_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas4_add_s16_pmaddwd, mas4_add_s16() {
+ return &_oil_function_impl_mas4_add_s16_pmaddwd, mas4_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas4_add_s16_pmaddwd_2, mas4_add_s16() {
+ return &_oil_function_impl_mas4_add_s16_pmaddwd_2, mas4_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas8_add_s16_pmaddwd, mas8_add_s16() {
+ return &_oil_function_impl_mas8_add_s16_pmaddwd, mas8_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas8_add_s16_pmaddwd2, mas8_add_s16() {
+ return &_oil_function_impl_mas8_add_s16_pmaddwd2, mas8_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas8_add_s16_sse2, mas8_add_s16() {
+ return &_oil_function_impl_mas8_add_s16_sse2, mas8_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas2_across_add_s16_mmx, mas2_across_add_s16() {
+ return &_oil_function_impl_mas2_across_add_s16_mmx, mas2_across_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_add_const_rshift_s16_mmx, add_const_rshift_s16() {
+ return &_oil_function_impl_add_const_rshift_s16_mmx, add_const_rshift_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_multiply_and_add_s16_mmx, multiply_and_add_s16() {
+ return &_oil_function_impl_multiply_and_add_s16_mmx, multiply_and_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_multiply_and_add_s16_u8_mmx, multiply_and_add_s16_u8() {
+ return &_oil_function_impl_multiply_and_add_s16_u8_mmx, multiply_and_add_s16_u8;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_multiply_and_add_s16_u8_mmx_2, multiply_and_add_s16_u8() {
+ return &_oil_function_impl_multiply_and_add_s16_u8_mmx_2, multiply_and_add_s16_u8;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_multiply_and_acc_12xn_s16_u8_mmx() {
+ return &_oil_function_impl_multiply_and_acc_12xn_s16_u8_mmx;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas4_across_add_s16_mmx, mas4_across_add_s16() {
+ return &_oil_function_impl_mas4_across_add_s16_mmx, mas4_across_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas4_across_add_s16_mmx, mas4_across_add_s16() {
+ return &_oil_function_impl_mas4_across_add_s16_mmx, mas4_across_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_mas8_across_add_s16_mmx, mas8_across_add_s16() {
+ return &_oil_function_impl_mas8_across_add_s16_mmx, mas8_across_add_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lshift_s16_mmx, lshift_s16() {
+ return &_oil_function_impl_lshift_s16_mmx, lshift_s16;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_lshift_s16_mmx_2, lshift_s16() {
+ return &_oil_function_impl_lshift_s16_mmx_2, lshift_s16;
+}
+#endif
+
+
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_split_53_nomix() {
+ return &_oil_function_impl_split_53_nomix;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_split_53_c() {
+ return &_oil_function_impl_split_53_c;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_synth_53_c() {
+ return &_oil_function_impl_synth_53_c;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_deinterleave2_c_1() {
+ return &_oil_function_impl_deinterleave2_c_1;
+}
+#endif
+
+#ifdef __SYMBIAN32__
+
+OilFunctionImpl* __oil_function_impl_deinterleave2_asm() {
+ return &_oil_function_impl_deinterleave2_asm;
+}
+#endif
+