dyncode_arm.c

betaplayer的源码 tcpmp的老版本

/*****************************************************************************
 *
 * This program 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.
 *
 * This program 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
 *
 * $Id: dyncode_arm.c 131 2004-12-04 20:36:04Z picard $
 *
 * BetaPlayer DynCode
 * Copyright (c) 2004 Gabor Kovacs
 *
 ****************************************************************************/

#include "../stdafx.h"
#include "dyncode.h"

#if defined( ARM )

static int NextCond;
static bool_t NextSet;
static bool_t NextByte;
static bool_t NextHalf;
static bool_t NextSign;

void InstInit()
{
	NextCond = AL;
	NextSet = 0;
	NextByte = 0;
	NextHalf = 0;
	NextSign = 0;
}

void InstPost(dyninst* p)
{
	InstAdd(p);

	NextCond = AL;
	NextSet = 0;
	NextByte = 0;
	NextHalf = 0;
	NextSign = 0;
}

void Byte()
{
	NextByte = 1;
	NextSign = 0;
}

void Half()
{
	NextHalf = 1;
	NextSign = 0;
}

void SByte()
{
	NextByte = 1;
	NextSign = 1;
}

void SHalf()
{
	NextHalf = 1;
	NextSign = 1;
}

void C( int c )
{
	NextCond = c;
}

void S()
{
	NextSet = 1;
}

void IPLD( int* Code, reg* Dest )
{
	switch (*Code)
	{
	case PLD: NextCond=15; NextByte=1; *Code = LDR; *Dest=PC; break;
	case PLD_PRE: NextCond=15; NextByte=1; *Code = LDR_PRE; *Dest=PC; break;
	case PLD_POST: NextCond=15; NextByte=1; *Code = LDR_POST; *Dest=PC; break;
	case PLD_PRESUB: NextCond=15; NextByte=1; *Code = LDR_PRESUB; *Dest=PC; break;
	case PLD_POSTSUB: NextCond=15; NextByte=1; *Code = LDR_POSTSUB; *Dest=PC; break;
	}
}

#define MODE(x) ((uint32_t)(x) >> 28)
#define MODEMASK ~0xF0000000

void I3C( int Code, reg Dest, reg Op1, reg Op2,int Const )
{
	dyninst* p = NULL;

	if (MODE(Code) == 8 && Const>=0 && Const<8)
	{
		p = InstCreate32( (NextCond << 28) | (Code & MODEMASK) | ((Dest & 15) << 12) | ((Op1 & 15) << 16) | ((Op2 & 15) << 0) | (Const << 20),
				Dest, Op1, Op2, (NextCond != AL)?1:0, 0 );
	}

	InstPost(p);
}

void I3( int Code, reg Dest, reg Op1, reg Op2 )
{
	if (MODE(Code) == 4)
	{
		dyninst* p = InstCreate32( (NextCond << 28) | (Code & MODEMASK) | ((Dest & 15) << 0) | ((Op1 & 15) << 12) | ((Op2 & 15) << 16),
				Dest, Op1, Op2, (NextCond != AL)?1:0, 0 );
		InstPost(p);
	}
	else
	if (MODE(Code) == 7)
	{
		dyninst* p = InstCreate32( (NextCond << 28) | (Code & MODEMASK) | ((Dest & 15) << 12) | ((Op1 & 15) << 16) | ((Op2 & 15) << 0),
				Dest, Op1, Op2, (NextCond != AL)?1:0, 0 );
		InstPost(p);
	}
	else
		I3S(Code,Dest,Op1,Op2,LSL,0);
}

void I3S( int Code, reg Dest, reg Op1, reg Op2, int ShiftType, int Shift )
{
	dyninst* p = NULL;

	if (Shift == 0)
		ShiftType = LSL;

	if (ShiftType == LSL && Shift < 0)
	{
		ShiftType = LSR;
		Shift = -Shift;
	}
	if ((ShiftType == LSR || ShiftType == ASR) && Shift < 0)
	{
		ShiftType = LSL;
		Shift = -Shift;
	}
	if (ShiftType == ROR && Shift < 0)
		Shift = Shift & 31;

	if (Shift >= 0 && Shift < 32)
	{
		if (Code >= 0 && Code < 16)
		{
			if (Code == CMP || Code == TST || Code == CMN || Code == TEQ) 
				NextSet = 1;

			p = InstCreate32( (NextCond << 28) | (Code << 21) | ((NextSet?1:0)<<20) |
				((Op1==NONE?R0:Op1) << 16) | ((Dest==NONE?R0:Dest) << 12) | (Shift << 7) | (ShiftType << 5) | (Op2),
				Dest, Op1, Op2, (NextCond != AL)?1:0, NextSet?1:0 );
		}
		if (Shift == 0)
		{
			if (Code == MUL && Dest != Op1)
			{
				p = InstCreate32( (NextCond << 28) | ((NextSet?1:0)<<20) |
					(Dest << 16) | (Op2 << 8) | 0x90 | (Op1),
					Dest, Op1, Op2, (NextCond != AL)?1:0, NextSet?1:0 );
			}
			if (Code >= QADD && Code <= QDSUB)
			{
				p = InstCreate32( (NextCond << 28) | 
					(Dest << 12) | (Op1) | (Op2 << 16) | (0x5 << 4) | (1<<24) | ((Code-QADD)<<21),
					Dest, Op1, Op2, (NextCond != AL)?1:0, NextSet?1:0 );
			}
		}

		IPLD(&Code,&Dest);

		if (Code == LDR || Code == STR || 
			Code == LDR_PRE || Code == STR_PRE || 
			Code == LDR_POST|| Code == STR_POST ||
			Code == LDR_PRESUB || Code == STR_PRESUB || 
			Code == LDR_POSTSUB || Code == STR_POSTSUB)
		{
			bool_t Pre = (Code != LDR_POST) && (Code != STR_POST) && (Code != LDR_POSTSUB) && (Code != STR_POSTSUB);
			bool_t PreWrite = (Code == LDR_PRE) || (Code == STR_PRE) || (Code == LDR_PRESUB) || (Code == STR_PRESUB);
			bool_t Load = (Code == LDR) || (Code == LDR_PRE) || (Code == LDR_POST) || (Code == LDR_PRESUB) || (Code == LDR_POSTSUB);
			bool_t Unsigned = (Code != LDR_PRESUB) && (Code != STR_PRESUB) && (Code != LDR_POSTSUB) && (Code != STR_POSTSUB);

			if (NextHalf || NextSign)
			{
				if (Shift==0 && (NextHalf || NextByte))
					p = InstCreate32( (NextCond << 28) | 
						((Pre?1:0)<<24) | (Unsigned<<23) | 
						((PreWrite?1:0)<<21) | (Load<<20) | (NextSign << 6) | (NextHalf << 5) |
						(Op1 << 16) | (Dest << 12) | (9 << 4) | Op2,
						NONE, Op1, Op2, (NextCond != AL)?1:0, 0 );
			}
			else
				p = InstCreate32( (NextCond << 28) | (3 << 25) |
					((Pre?1:0)<<24) | (Unsigned<<23) | (NextByte<<22) |
					((PreWrite?1:0)<<21) | (Load<<20) |
					(Op1 << 16) | (Dest << 12) | (Shift << 7) | (ShiftType << 5) | Op2,
					NONE, Op1, Op2, (NextCond != AL)?1:0, 0 );

			if (p)
			{
				if (Load)
					p->WrRegs |= 1 << Dest;
				else
					p->RdRegs |= 1 << Dest;

				if (!Pre || PreWrite)
					p->WrRegs |= 1 << Op1;
			}
		}
	}
	InstPost(p);
}

void I4( int Code, reg Dest, reg Op1, reg Op2, reg Op3 )
{
	dyninst* p = NULL;
	if (Code == MLA)
	{
		p = InstCreate32( (NextCond << 28) | (1 << 21) | ((NextSet?1:0)<<20) |
			(Dest << 16) | (Op3 << 12) | (Op2 << 8) | 0x90 | (Op1),
			Dest, Op1, Op2, (NextCond != AL)?1:0, NextSet?1:0 );

		if (p) p->RdRegs |= 1 << Op3;

	}
	InstPost(p);
}

void IMul( reg Dest, reg Op1, int Mul )
{
	if (Dest == Op1)
		InstPost(NULL); //assert

	switch (Mul)
	{
	case 0: I2C(MOV,Dest,NONE,0); break;
	case 1: I3(MOV,Dest,NONE,Op1); break;
	case 2: I3S(MOV,Dest,NONE,Op1,LSL,1); break;
	case 3: I3S(ADD,Dest,Op1,Op1,LSL,1); break;
	case 4: I3S(MOV,Dest,NONE,Op1,LSL,2); break;
	case 5: I3S(ADD,Dest,Op1,Op1,LSL,2); break;
	case 6: I3S(MOV,Dest,NONE,Op1,LSL,1); I3S(ADD,Dest,Dest,Dest,LSL,1); break; //2*3
	case 7: I3S(RSB,Dest,Op1,Op1,LSL,3); break;
	case 8: I3S(MOV,Dest,NONE,Op1,LSL,3); break;
	case 9: I3S(ADD,Dest,Op1,Op1,LSL,3); break;
	case 10: I3S(MOV,Dest,NONE,Op1,LSL,1); I3S(ADD,Dest,Dest,Dest,LSL,2); break; //2*5
	case 11: I3S(RSB,Dest,Op1,Op1,LSL,3); I3S(ADD,Dest,Dest,Op1,LSL,2); break;  //7+4
	case 12: I3S(ADD,Dest,Op1,Op1,LSL,1); I3S(MOV,Dest,NONE,Dest,LSL,2); break; //3*4
	case 13: I3S(ADD,Dest,Op1,Op1,LSL,3); I3S(ADD,Dest,Dest,Op1,LSL,2); break;  //9+4
	case 14: I3S(RSB,Dest,Op1,Op1,LSL,3); I3(ADD,Dest,Dest,Dest); break;  //7*2
	case 15: I3S(RSB,Dest,Op1,Op1,LSL,4); break;
	case 16: I3S(MOV,Dest,NONE,Op1,LSL,4); break;
	case 17: I3S(ADD,Dest,Op1,Op1,LSL,4); break;
	default: I2C(MOV,Dest,NONE,Mul); I3(MUL,Dest,Op1,Dest); break;
	}
}

void IConst(reg Dest, int Const )
{
	dyninst* p = NULL;
	int Shift,Code;

	if (Const < 0)
	{
		Code = MVN;
		Const = -Const-1;
	}
	else
		Code = MOV;

	Const = (Const << 8) | ((Const >> 24) & 255);
	for (Shift=8;Shift<=32;Shift+=2)
	{
		if (Const & 0xC0)
			break;
		Const = (Const << 2) | ((Const >> 30) & 3);
	}
	Shift &= 31;
	Const &= 255;

	p = InstCreate32( (NextCond << 28) | (1<<25) | (Code << 21) | ((NextSet?1:0)<<20) |
		(Dest << 12) | (Shift << 7) | Const,
		Dest, NONE, NONE, (NextCond != AL)?1:0, NextSet?1:0 );

	InstPost(p);
}

void I2( int Code, reg Dest, reg Op1 )
{
	if (MODE(Code) == 1)
	{
		dyninst* p = InstCreate32( (NextCond << 28) | (Code & MODEMASK) | ((Dest & 15) << 16) | ((Op1 & 15) << 12),
				Dest, Op1, NONE, (NextCond != AL)?1:0, 0 );
		InstPost(p);
	}
	else
	if (MODE(Code) == 6)
	{
		dyninst* p = InstCreate32( (NextCond << 28) | (Code & MODEMASK) | ((Dest & 15) << 12) | ((Op1 & 15) << 16),
				Dest, Op1, NONE, (NextCond != AL)?1:0, 0 );
		InstPost(p);
	}
	else
		I2C(Code,Dest,Op1,0);
}

void I2C( int Code, reg Dest, reg Op1, int Const )
{
	int Shift;
	dyninst* p = NULL;