motion_comp.c

君正早期ucos系统(只有早期的才不没有打包成库),MPLAYER,文件系统,图片解码,浏览,电子书,录音,想学ucos,识货的人就下吧 russblock fmradio explore set

/*
 * motion_comp.c
 * Copyright (C) 2000-2003 Michel Lespinasse <[e-mail]>
 * Copyright (C) 1999-2000 Aaron Holtzman <[e-mail]>
 *
 * This file is part of mpeg2dec, a free MPEG-2 video stream decoder.
 * See http://libmpeg2.sourceforge.net/ for updates.
 *
 * mpeg2dec is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * mpeg2dec is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 * Modified for use with MPlayer, see libmpeg-0.4.1.diff for the exact changes.
 * detailed changelog at http://svn.mplayerhq.hu/mplayer/trunk/
 * $Id: motion_comp.c,v 1.7 2008/07/29 01:45:00 xjyu Exp $
 */

#include "config.h"

#include <inttypes.h>

#include "mpeg2.h"
#include "attributes.h"
#include "mpeg2_internal.h"
#ifdef JZ4740_MXU_OPT
#include "jzmedia.h"
#endif
mpeg2_mc_t mpeg2_mc;

void mpeg2_mc_init (uint32_t accel)
{
#ifdef HAVE_MMX2
    if (accel & MPEG2_ACCEL_X86_MMXEXT)
	mpeg2_mc = mpeg2_mc_mmxext;
    else
#endif
#ifdef HAVE_3DNOW
    if (accel & MPEG2_ACCEL_X86_3DNOW)
	mpeg2_mc = mpeg2_mc_3dnow;
    else
#endif
#ifdef HAVE_MMX
    if (accel & MPEG2_ACCEL_X86_MMX)
	mpeg2_mc = mpeg2_mc_mmx;
    else
#endif
#if defined(ARCH_PPC) && defined(HAVE_ALTIVEC)
    if (accel & MPEG2_ACCEL_PPC_ALTIVEC)
	mpeg2_mc = mpeg2_mc_altivec;
    else
#endif
#ifdef ARCH_ALPHA
    if (accel & MPEG2_ACCEL_ALPHA)
	mpeg2_mc = mpeg2_mc_alpha;
    else
#endif
#if defined(ARCH_SPARC) && defined(HAVE_VIS)
    if (accel & MPEG2_ACCEL_SPARC_VIS)
	mpeg2_mc = mpeg2_mc_vis;
    else
#endif
#ifdef ARCH_ARM
    if (1 /*accel & MPEG2_ACCEL_ARM*/) {
#ifdef HAVE_IWMMXT
	if (1 /*accel & MPEG2_ACCEL_ARM_IWMMXT*/)
	    mpeg2_mc = mpeg2_mc_iwmmxt;
	else
#endif  
	    mpeg2_mc = mpeg2_mc_arm;
    } else
#endif
	mpeg2_mc = mpeg2_mc_c;
}
#define avg2(a,b) ((a+b+1)>>1)
#define avg4(a,b,c,d) ((a+b+c+d+2)>>2)

#define predict_o(i) (ref[i])
#define predict_x(i) (avg2 (ref[i], ref[i+1]))
#define predict_y(i) (avg2 (ref[i], (ref+stride)[i]))
#define predict_xy(i) (avg4 (ref[i], ref[i+1], \
			     (ref+stride)[i], (ref+stride)[i+1]))

#define put(predictor,i) dest[i] = predictor (i)
#define avg(predictor,i) dest[i] = avg2 (predictor (i), dest[i])

/* mc function template */
#if 0
#define MC_FUNC(op,xy)							\
static void MC_##op##_##xy##_16_c (uint8_t * dest, const uint8_t * ref,	\
				   const int stride, int height)	\
{									\
    do {								\
	op (predict_##xy, 0);						\
	op (predict_##xy, 1);						\
	op (predict_##xy, 2);						\
	op (predict_##xy, 3);						\
	op (predict_##xy, 4);						\
	op (predict_##xy, 5);						\
	op (predict_##xy, 6);						\
	op (predict_##xy, 7);						\
	op (predict_##xy, 8);						\
	op (predict_##xy, 9);						\
	op (predict_##xy, 10);						\
	op (predict_##xy, 11);						\
	op (predict_##xy, 12);						\
	op (predict_##xy, 13);						\
	op (predict_##xy, 14);						\
	op (predict_##xy, 15);						\
	ref += stride;							\
	dest += stride;							\
    } while (--height);							\
}									\
static void MC_##op##_##xy##_8_c (uint8_t * dest, const uint8_t * ref,	\
				  const int stride, int height)		\
{									\
    do {								\
	op (predict_##xy, 0);						\
	op (predict_##xy, 1);						\
	op (predict_##xy, 2);						\
	op (predict_##xy, 3);						\
	op (predict_##xy, 4);						\
	op (predict_##xy, 5);						\
	op (predict_##xy, 6);						\
	op (predict_##xy, 7);						\
	ref += stride;							\
	dest += stride;							\
    } while (--height);							\
}
/* definitions of the actual mc functions */
#else
#endif
/*MC_FUNC (put,o)
MC_FUNC (avg,o)
MC_FUNC (put,x)
MC_FUNC (avg,x)
MC_FUNC (put,y)
MC_FUNC (avg,y)
MC_FUNC (put,xy)
MC_FUNC (avg,xy)
 
MPEG2_MC_EXTERN (c)
*/
#ifdef JZ4740_MXU_OPT
static void MC_put_o_16_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 {
   uint32_t  ref_aln, ref_rs;
   ref_aln = (uint32_t)(ref-stride) & 0xfffffffc;
   ref_rs  = 4 - ((uint32_t)(ref-stride) & 3);
   dest -= stride; 
   do { 
        S32LDIV(xr1,ref_aln,stride,0x0);
        S32LDD(xr2,ref_aln,0x4);
        S32ALN(xr3,xr2,xr1,ref_rs);
        S32LDD(xr4,ref_aln,0x8);
        S32ALN(xr5,xr4,xr2,ref_rs);
        S32LDD(xr6,ref_aln,0xc);
        S32ALN(xr7,xr6,xr4,ref_rs);
        S32LDD(xr8,ref_aln,0x10);
        S32ALN(xr9,xr8,xr6,ref_rs);
        
        S32SDIV(xr3,dest,stride,0x0);
        S32STD(xr5,dest,0x4);
        S32STD(xr7,dest,0x8);
        S32STD(xr9,dest,0xc);
      } while (--height);
  }
#else
static void MC_put_o_16_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 { do { dest[0] = (ref[0]); 
        dest[1] = (ref[1]);
        dest[2] = (ref[2]);
        dest[3] = (ref[3]);
        dest[4] = (ref[4]);
        dest[5] = (ref[5]);
        dest[6] = (ref[6]);
        dest[7] = (ref[7]);
        dest[8] = (ref[8]);
        dest[9] = (ref[9]);
        dest[10] = (ref[10]);
        dest[11] = (ref[11]);
        dest[12] = (ref[12]);
        dest[13] = (ref[13]);
        dest[14] = (ref[14]); 
        dest[15] = (ref[15]);
        ref += stride;
        dest += stride;
      } while (--height); 
  } 
#endif
#ifdef JZ4740_MXU_OPT
static void MC_put_o_8_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 {
   uint32_t  ref_aln, ref_rs;
   ref_aln = (uint32_t)(ref-stride) & 0xfffffffc;
   ref_rs  = 4 - ((uint32_t)(ref-stride) & 3);
   dest -= stride;
   do {
        S32LDIV(xr1,ref_aln,stride,0x0);
        S32LDD(xr2,ref_aln,0x4);
        S32ALN(xr3,xr2,xr1,ref_rs);
        S32LDD(xr4,ref_aln,0x8);
        S32ALN(xr5,xr4,xr2,ref_rs);

        S32SDIV(xr3,dest,stride,0x0);
        S32STD(xr5,dest,0x4);
      } while (--height);
 }
#else
static void MC_put_o_8_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 { do { dest[0] = (ref[0]);
        dest[1] = (ref[1]);
        dest[2] = (ref[2]);
        dest[3] = (ref[3]);
        dest[4] = (ref[4]);
        dest[5] = (ref[5]);
        dest[6] = (ref[6]); 
        dest[7] = (ref[7]);
        ref += stride;
        dest += stride;
       } while (--height);
 }
#endif
static void MC_avg_o_16_c (uint8_t * dest, const uint8_t * ref, const int stride, int height) 
 { do { dest[0] = (((ref[0])+dest[0]+1)>>1); 
        dest[1] = (((ref[1])+dest[1]+1)>>1); 
        dest[2] = (((ref[2])+dest[2]+1)>>1); 
        dest[3] = (((ref[3])+dest[3]+1)>>1); 
        dest[4] = (((ref[4])+dest[4]+1)>>1);
        dest[5] = (((ref[5])+dest[5]+1)>>1); 
        dest[6] = (((ref[6])+dest[6]+1)>>1); 
        dest[7] = (((ref[7])+dest[7]+1)>>1); 
        dest[8] = (((ref[8])+dest[8]+1)>>1); 
        dest[9] = (((ref[9])+dest[9]+1)>>1); 
        dest[10] = (((ref[10])+dest[10]+1)>>1);
        dest[11] = (((ref[11])+dest[11]+1)>>1);
        dest[12] = (((ref[12])+dest[12]+1)>>1); 
        dest[13] = (((ref[13])+dest[13]+1)>>1);
        dest[14] = (((ref[14])+dest[14]+1)>>1);
        dest[15] = (((ref[15])+dest[15]+1)>>1);
        ref += stride; 
        dest += stride; 
      } while (--height);
  }
 static void MC_avg_o_8_c (uint8_t * dest, const uint8_t * ref, const int stride, int height) 
 { do { dest[0] = (((ref[0])+dest[0]+1)>>1); 
        dest[1] = (((ref[1])+dest[1]+1)>>1); 
        dest[2] = (((ref[2])+dest[2]+1)>>1); 
        dest[3] = (((ref[3])+dest[3]+1)>>1); 
        dest[4] = (((ref[4])+dest[4]+1)>>1); 
        dest[5] = (((ref[5])+dest[5]+1)>>1); 
        dest[6] = (((ref[6])+dest[6]+1)>>1); 
        dest[7] = (((ref[7])+dest[7]+1)>>1); 
        ref += stride; 
        dest += stride;
       } while (--height); 
 }
#ifdef JZ4740_MXU_OPT
static void MC_put_x_16_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 { 
   uint32_t ref_aln,ref_aln1,ref_rs0,ref_rs1;
   ref_aln  = ((uint32_t)ref-stride) & 0xFFFFFFFC;
   ref_aln1 = ((uint32_t)ref + 1-stride) & 0xFFFFFFFC;
   ref_rs0  = 4 - ((uint32_t)(ref) & 3);
   ref_rs1  = 4 - (((uint32_t)ref + 1) & 3);
   dest -= stride;
   do {
       S32LDIV(xr1,ref_aln,stride,0x0);
       S32LDD(xr2,ref_aln,0x4);
       S32LDD(xr3,ref_aln,0x8);
       S32LDD(xr4,ref_aln,0xc);
       S32LDD(xr5,ref_aln,0x10);       
       
       S32ALN(xr1,xr2,xr1,ref_rs0); //xr1:ref[3]-[0]
       S32ALN(xr2,xr3,xr2,ref_rs0); //xr2:ref[7]-[4]
       S32ALN(xr3,xr4,xr3,ref_rs0); //xr3:ref[11]-[8]
       S32ALN(xr4,xr5,xr4,ref_rs0); //xr4:ref[15]-[12]
       
       S32LDIV(xr5,ref_aln1,stride,0x0);
       S32LDD(xr6,ref_aln1,0x4);
       S32LDD(xr7,ref_aln1,0x8);
       S32LDD(xr8,ref_aln1,0xc);
       S32LDD(xr9,ref_aln1,0x10);
     
       S32ALN(xr5,xr6,xr5,ref_rs1); //xr5:ref[4]-[1]
       S32ALN(xr6,xr7,xr6,ref_rs1); //xr6:ref[8]-[5]
       S32ALN(xr7,xr8,xr7,ref_rs1); //xr7:ref[12]-[9]
       S32ALN(xr8,xr9,xr8,ref_rs1); //xr8:ref[16]-[13]
 
       Q8AVGR(xr5,xr5,xr1);
       Q8AVGR(xr6,xr6,xr2);
       Q8AVGR(xr7,xr7,xr3);
       Q8AVGR(xr8,xr8,xr4);
      
       S32SDIV(xr5,dest,stride,0x0);
       S32STD(xr6,dest,0x4);
       S32STD(xr7,dest,0x8);
       S32STD(xr8,dest,0xc);
      } while (--height);
 }
#else
static void MC_put_x_16_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 { 
   do {
        dest[0] = (((ref[0]+ref[0 +1]+1)>>1)); 
        dest[1] = (((ref[1]+ref[1 +1]+1)>>1));
        dest[2] = (((ref[2]+ref[2 +1]+1)>>1));
        dest[3] = (((ref[3]+ref[3 +1]+1)>>1));
        dest[4] = (((ref[4]+ref[4 +1]+1)>>1));
        dest[5] = (((ref[5]+ref[5 +1]+1)>>1)); 
        dest[6] = (((ref[6]+ref[6 +1]+1)>>1)); 
        dest[7] = (((ref[7]+ref[7 +1]+1)>>1));
        dest[8] = (((ref[8]+ref[8 +1]+1)>>1));
        dest[9] = (((ref[9]+ref[9 +1]+1)>>1));
        dest[10] = (((ref[10]+ref[10 +1]+1)>>1));
        dest[11] = (((ref[11]+ref[11 +1]+1)>>1)); 
        dest[12] = (((ref[12]+ref[12 +1]+1)>>1)); 
        dest[13] = (((ref[13]+ref[13 +1]+1)>>1)); 
        dest[14] = (((ref[14]+ref[14 +1]+1)>>1));
        dest[15] = (((ref[15]+ref[15 +1]+1)>>1)); 
        ref  += stride; 
        dest += stride;
       } while (--height);
  }
#endif
#ifdef JZ4740_MXU_OPT
static void MC_put_x_8_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 { 
   int32_t ref_aln,ref_aln1,ref_rs0,ref_rs1;
   ref_aln  = ((uint32_t)ref-stride) & 0xFFFFFFFC;
   ref_aln1 = ((uint32_t)ref + 1-stride) & 0xFFFFFFFC;

   ref_rs0  = 4 - ((uint32_t)(ref) & 3);
   ref_rs1  = 4 - (((uint32_t)ref + 1) & 3);
   dest -= stride;
   do {
       S32LDIV(xr1,ref_aln,stride,0x0);
       S32LDD(xr2,ref_aln,0x4);
       S32LDD(xr3,ref_aln,0x8);

       S32ALN(xr1,xr2,xr1,ref_rs0); //xr1:ref[3]-[0]
       S32ALN(xr2,xr3,xr2,ref_rs0); //xr2:ref[7]-[4]

       S32LDIV(xr5,ref_aln1,stride,0x0);
       S32LDD(xr6,ref_aln1,0x4);
       S32LDD(xr7,ref_aln1,0x8);

       S32ALN(xr5,xr6,xr5,ref_rs1); //xr5:ref[4]-[1]
       S32ALN(xr6,xr7,xr6,ref_rs1); //xr6:ref[8]-[5]
       Q8AVGR(xr5,xr5,xr1);
       Q8AVGR(xr6,xr6,xr2);

       S32SDIV(xr5,dest,stride,0x0);
       S32STD(xr6,dest,0x4);
      } while (--height);
 }
#else
static void MC_put_x_8_c (uint8_t * dest, const uint8_t * ref, const int stride, int height)
 { do { dest[0] = (((ref[0]+ref[0 +1]+1)>>1)); 
        dest[1] = (((ref[1]+ref[1 +1]+1)>>1)); 
        dest[2] = (((ref[2]+ref[2 +1]+1)>>1)); 
        dest[3] = (((ref[3]+ref[3 +1]+1)>>1)); 
        dest[4] = (((ref[4]+ref[4 +1]+1)>>1)); 
        dest[5] = (((ref[5]+ref[5 +1]+1)>>1)); 
        dest[6] = (((ref[6]+ref[6 +1]+1)>>1)); 
        dest[7] = (((ref[7]+ref[7 +1]+1)>>1)); 
        ref += stride; 
        dest += stride; 
      } while (--height);
 }
#endif
 static void MC_avg_x_16_c (uint8_t * dest, const uint8_t * ref, const int stride, int height) 
 { do { dest[0] = (((((ref[0]+ref[0 +1]+1)>>1))+dest[0]+1)>>1); 
        dest[1] = (((((ref[1]+ref[1 +1]+1)>>1))+dest[1]+1)>>1); 
        dest[2] = (((((ref[2]+ref[2 +1]+1)>>1))+dest[2]+1)>>1); 
        dest[3] = (((((ref[3]+ref[3 +1]+1)>>1))+dest[3]+1)>>1); 
        dest[4] = (((((ref[4]+ref[4 +1]+1)>>1))+dest[4]+1)>>1); 
        dest[5] = (((((ref[5]+ref[5 +1]+1)>>1))+dest[5]+1)>>1); 
        dest[6] = (((((ref[6]+ref[6 +1]+1)>>1))+dest[6]+1)>>1); 
        dest[7] = (((((ref[7]+ref[7 +1]+1)>>1))+dest[7]+1)>>1); 
        dest[8] = (((((ref[8]+ref[8 +1]+1)>>1))+dest[8]+1)>>1); 
        dest[9] = (((((ref[9]+ref[9 +1]+1)>>1))+dest[9]+1)>>1); 
        dest[10] = (((((ref[10]+ref[10 +1]+1)>>1))+dest[10]+1)>>1);