view sh4/idct_sh4.c @ 2809:75400dfbe117 libavcodec

fixing colocated mv if colocated block is L1 predicted for the temporal direct case untested (none of the conformance streams laying around on my disk seems affected by this change)

/*
 * idct for sh4
 *
 * Copyright (c) 2001-2003 BERO <[e-mail]>
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library 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
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#include "../dsputil.h"
#define c1	1.38703984532214752434	/* sqrt(2)*cos(1*pi/16) */
#define c2	1.30656296487637657577	/* sqrt(2)*cos(2*pi/16) */
#define c3	1.17587560241935884520	/* sqrt(2)*cos(3*pi/16) */
#define c4	1.00000000000000000000	/* sqrt(2)*cos(4*pi/16) */
#define c5	0.78569495838710234903	/* sqrt(2)*cos(5*pi/16) */
#define c6	0.54119610014619712324	/* sqrt(2)*cos(6*pi/16) */
#define c7	0.27589937928294311353	/* sqrt(2)*cos(7*pi/16) */

const	static float even_table[] __attribute__ ((aligned(8))) = {
	 c4, c4, c4, c4,
	 c2, c6,-c6,-c2,
	 c4,-c4,-c4, c4,
	 c6,-c2, c2,-c6
};

const	static float odd_table[] __attribute__ ((aligned(8))) = {
	 c1, c3, c5, c7,
	 c3,-c7,-c1,-c5,
	 c5,-c1, c7, c3,
	 c7,-c5, c3,-c1
};

#undef	c1
#undef	c2
#undef	c3
#undef	c4
#undef	c5
#undef	c6
#undef	c7

#if defined(__SH4_SINGLE__) || defined(__SH4_SINGLE_ONLY__)

#define	load_matrix(table) \
	__asm__ volatile( \
	"	fschg\n" \
	"	fmov	@%0+,xd0\n" \
	"	fmov	@%0+,xd2\n" \
	"	fmov	@%0+,xd4\n" \
	"	fmov	@%0+,xd6\n" \
	"	fmov	@%0+,xd8\n" \
	"	fmov	@%0+,xd10\n" \
	"	fmov	@%0+,xd12\n" \
	"	fmov	@%0+,xd14\n" \
	"	fschg\n" \
	:\
	: "r"(table)\
	: "0" \
	)

#define	ftrv() \
		__asm__ volatile("ftrv xmtrx,fv0" \
		: "=f"(fr0),"=f"(fr1),"=f"(fr2),"=f"(fr3) \
		:  "0"(fr0), "1"(fr1), "2"(fr2), "3"(fr3) );

#define	DEFREG	\
	register float fr0 __asm__("fr0"); \
	register float fr1 __asm__("fr1"); \
	register float fr2 __asm__("fr2"); \
	register float fr3 __asm__("fr3")

#else

/* generic C code for check */

static void ftrv_(const float xf[],float fv[])
{
	float f0,f1,f2,f3;
	f0 = fv[0];
	f1 = fv[1];
	f2 = fv[2];
	f3 = fv[3];
	fv[0] = xf[0]*f0 + xf[4]*f1 + xf[ 8]*f2 + xf[12]*f3;
	fv[1] = xf[1]*f0 + xf[5]*f1 + xf[ 9]*f2 + xf[13]*f3;
	fv[2] = xf[2]*f0 + xf[6]*f1 + xf[10]*f2 + xf[14]*f3;
	fv[3] = xf[3]*f0 + xf[7]*f1 + xf[11]*f2 + xf[15]*f3;
}

static void load_matrix_(float xf[],const float table[])
{
	int i;
	for(i=0;i<16;i++) xf[i]=table[i];
}

#define	ftrv()	ftrv_(xf,fv)
#define	load_matrix(table)	load_matrix_(xf,table)

#define	DEFREG \
	float fv[4],xf[16]

#define	fr0	fv[0]
#define	fr1	fv[1]
#define	fr2	fv[2]
#define	fr3	fv[3]

#endif

#if 1
#define	DESCALE(x,n)	(x)*(1.0f/(1<<(n)))
#else
#define	DESCALE(x,n)	(((int)(x)+(1<<(n-1)))>>(n))
#endif

/* this code work worse on gcc cvs. 3.2.3 work fine */


#if 1
//optimized 

void idct_sh4(DCTELEM *block)
{
	DEFREG;

	int i;
	float	tblock[8*8],*fblock;
	int ofs1,ofs2,ofs3;

#if defined(__SH4__)
#error	"FIXME!! change to single float"
#endif

	/* row */

	/* even part */
	load_matrix(even_table);

	fblock = tblock+4;
	i = 8;
	do {
		fr0 = block[0];
		fr1 = block[2];
		fr2 = block[4];
		fr3 = block[6];
		block+=8;
		ftrv();
		*--fblock = fr3;
		*--fblock = fr2;
		*--fblock = fr1;
		*--fblock = fr0;
		fblock+=8+4;
	} while(--i);
	block-=8*8;
	fblock-=8*8+4;

	load_matrix(odd_table);

	i = 8;

//	ofs1 = sizeof(float)*1;
//	ofs2 = sizeof(float)*2;
//	ofs3 = sizeof(float)*3;

	do {
		float t0,t1,t2,t3;
		fr0 = block[1];
		fr1 = block[3];
		fr2 = block[5];
		fr3 = block[7];
		block+=8;
		ftrv();
		t0 = *fblock++;
		t1 = *fblock++;
		t2 = *fblock++;
		t3 = *fblock++;
		fblock+=4;
		*--fblock = t0 - fr0;
		*--fblock = t1 - fr1;
		*--fblock = t2 - fr2;
		*--fblock = t3 - fr3;
		*--fblock = t3 + fr3;
		*--fblock = t2 + fr2;
		*--fblock = t1 + fr1;
		*--fblock = t0 + fr0;
		fblock+=8;
	} while(--i);
	block-=8*8;
	fblock-=8*8;

	/* col */

	/* even part */
	load_matrix(even_table);

	ofs1 = sizeof(float)*2*8;
	ofs2 = sizeof(float)*4*8;
	ofs3 = sizeof(float)*6*8;

	i = 8;

#define	OA(fblock,ofs)	*(float*)((char*)fblock + ofs)

	do {
		fr0 = OA(fblock,   0);
		fr1 = OA(fblock,ofs1);
		fr2 = OA(fblock,ofs2);
		fr3 = OA(fblock,ofs3);
		ftrv();
		OA(fblock,0   ) = fr0;
		OA(fblock,ofs1) = fr1;
		OA(fblock,ofs2) = fr2;
		OA(fblock,ofs3) = fr3;
		fblock++;
	} while(--i);
	fblock-=8;

	load_matrix(odd_table);

	i=8;
	do {
		float t0,t1,t2,t3;
		t0 = OA(fblock,   0); /* [8*0] */
		t1 = OA(fblock,ofs1); /* [8*2] */
		t2 = OA(fblock,ofs2); /* [8*4] */
		t3 = OA(fblock,ofs3); /* [8*6] */
		fblock+=8;
		fr0 = OA(fblock,   0); /* [8*1] */
		fr1 = OA(fblock,ofs1); /* [8*3] */
		fr2 = OA(fblock,ofs2); /* [8*5] */
		fr3 = OA(fblock,ofs3); /* [8*7] */
		fblock+=-8+1;
		ftrv();
		block[8*0] = DESCALE(t0 + fr0,3);
		block[8*7] = DESCALE(t0 - fr0,3);
		block[8*1] = DESCALE(t1 + fr1,3);
		block[8*6] = DESCALE(t1 - fr1,3);
		block[8*2] = DESCALE(t2 + fr2,3);
		block[8*5] = DESCALE(t2 - fr2,3);
		block[8*3] = DESCALE(t3 + fr3,3);
		block[8*4] = DESCALE(t3 - fr3,3);
		block++;
	} while(--i);

#if defined(__SH4__)
#error	"FIXME!! change to double"
#endif
}
#else
void idct_sh4(DCTELEM *block)
{
	DEFREG;

	int i;
	float	tblock[8*8],*fblock;

	/* row */

	/* even part */
	load_matrix(even_table);

	fblock = tblock;
	i = 8;
	do {
		fr0 = block[0];
		fr1 = block[2];
		fr2 = block[4];
		fr3 = block[6];
		block+=8;
		ftrv();
		fblock[0] = fr0;
		fblock[2] = fr1;
		fblock[4] = fr2;
		fblock[6] = fr3;
		fblock+=8;
	} while(--i);
	block-=8*8;
	fblock-=8*8;

	load_matrix(odd_table);

	i = 8;

	do {
		float t0,t1,t2,t3;
		fr0 = block[1];
		fr1 = block[3];
		fr2 = block[5];
		fr3 = block[7];
		block+=8;
		ftrv();
		t0 = fblock[0];
		t1 = fblock[2];
		t2 = fblock[4];
		t3 = fblock[6];
		fblock[0] = t0 + fr0;
		fblock[7] = t0 - fr0;
		fblock[1] = t1 + fr1;
		fblock[6] = t1 - fr1;
		fblock[2] = t2 + fr2;
		fblock[5] = t2 - fr2;
		fblock[3] = t3 + fr3;
		fblock[4] = t3 - fr3;
		fblock+=8;
	} while(--i);
	block-=8*8;
	fblock-=8*8;

	/* col */

	/* even part */
	load_matrix(even_table);

	i = 8;

	do {
		fr0 = fblock[8*0];
		fr1 = fblock[8*2];
		fr2 = fblock[8*4];
		fr3 = fblock[8*6];
		ftrv();
		fblock[8*0] = fr0;
		fblock[8*2] = fr1;
		fblock[8*4] = fr2;
		fblock[8*6] = fr3;
		fblock++;
	} while(--i);
	fblock-=8;

	load_matrix(odd_table);

	i=8;
	do {
		float t0,t1,t2,t3;
		fr0 = fblock[8*1];
		fr1 = fblock[8*3];
		fr2 = fblock[8*5];
		fr3 = fblock[8*7];
		ftrv();
		t0 = fblock[8*0];
		t1 = fblock[8*2];
		t2 = fblock[8*4];
		t3 = fblock[8*6];
		fblock++;
		block[8*0] = DESCALE(t0 + fr0,3);
		block[8*7] = DESCALE(t0 - fr0,3);
		block[8*1] = DESCALE(t1 + fr1,3);
		block[8*6] = DESCALE(t1 - fr1,3);
		block[8*2] = DESCALE(t2 + fr2,3);
		block[8*5] = DESCALE(t2 - fr2,3);
		block[8*3] = DESCALE(t3 + fr3,3);
		block[8*4] = DESCALE(t3 - fr3,3);
		block++;
	} while(--i);
}
#endif