#include "main/main.h"
int cycle_count;
int last_count;
int pcaddr;
int pending_exception;
int branch_target;
uint64_t readmem_dword;
static precomp_instr fake_pc;
u_int memory_map[1048576];
ALIGN(8, static u_int mini_ht[32][2]);
ALIGN(4, u_char restore_candidate[512]);
#ifdef __cplusplus
extern "C" {
#endif
void do_interrupt();
void jump_vaddr_eax();
void jump_vaddr_ecx();
void jump_vaddr_edx();
void jump_vaddr_ebx();
void jump_vaddr_ebp();
void jump_vaddr_edi();
#ifdef __cplusplus
}
#endif
static const u_int jump_vaddr_reg[8] = {
(int)jump_vaddr_eax,
(int)jump_vaddr_ecx,
(int)jump_vaddr_edx,
(int)jump_vaddr_ebx,
0,
(int)jump_vaddr_ebp,
0,
(int)jump_vaddr_edi };
#ifdef __cplusplus
extern "C" {
#endif
void invalidate_block_eax();
void invalidate_block_ecx();
void invalidate_block_edx();
void invalidate_block_ebx();
void invalidate_block_ebp();
void invalidate_block_esi();
void invalidate_block_edi();
#ifdef __cplusplus
}
#endif
static const u_int invalidate_block_reg[8] = {
(int)invalidate_block_eax,
(int)invalidate_block_ecx,
(int)invalidate_block_edx,
(int)invalidate_block_ebx,
0,
(int)invalidate_block_ebp,
(int)invalidate_block_esi,
(int)invalidate_block_edi };
static const u_short rounding_modes[4] = {
0x33F, 0xF3F, 0xB3F, 0x73F};
#include "../fpu.h"
static const u_int const_zero=0;
static const u_int const_one=1;
static void set_jump_target(int addr,int target)
{
u_char *ptr=(u_char *)addr;
if(*ptr==0x0f)
{
assert(ptr[1]>=0x80&&ptr[1]<=0x8f);
u_int *ptr2=(u_int *)(ptr+2);
*ptr2=target-(int)ptr2-4;
}
else if(*ptr==0xe8||*ptr==0xe9) {
u_int *ptr2=(u_int *)(ptr+1);
*ptr2=target-(int)ptr2-4;
}
else
{
assert(*ptr==0xc7);
u_int *ptr2=(u_int *)(ptr+6);
*ptr2=target;
}
}
static void *kill_pointer(void *stub)
{
int *i_ptr=*((int **)((int)stub+6));
*i_ptr=(int)stub-(int)i_ptr-4;
return i_ptr;
}
static int get_pointer(void *stub)
{
int *i_ptr=*((int **)((int)stub+6));
return *i_ptr+(int)i_ptr+4;
}
static u_int get_clean_addr(int addr)
{
u_char *ptr=(u_char *)addr;
assert(ptr[20]==0xE8); assert(ptr[25]==0x83); if(ptr[28]==0xE9) return *(u_int *)(ptr+29)+addr+33; else return(addr+28);
}
static int verify_dirty(void *addr)
{
u_char *ptr=(u_char *)addr;
assert(ptr[5]==0xB8);
u_int source=*(u_int *)(ptr+6);
u_int copy=*(u_int *)(ptr+11);
u_int len=*(u_int *)(ptr+16);
assert(ptr[20]==0xE8); u_int verifier=*(u_int *)(ptr+21)+(u_int)ptr+25;
if(verifier==(u_int)verify_code_vm||verifier==(u_int)verify_code_ds) {
unsigned int page=source>>12;
unsigned int map_value=memory_map[page];
if(map_value>=0x80000000) return 0;
while(page<((source+len-1)>>12)) {
if((memory_map[++page]<<2)!=(map_value<<2)) return 0;
}
source = source+(map_value<<2);
}
return !memcmp((void *)source,(void *)copy,len);
}
static int isclean(int addr)
{
u_char *ptr=(u_char *)addr;
if(ptr[5]!=0xB8) return 1; if(ptr[10]!=0xBB) return 1; if(ptr[15]!=0xB9) return 1; if(ptr[20]!=0xE8) return 1; if(ptr[25]!=0x83) return 1; return 0;
}
static void get_bounds(int addr,u_int *start,u_int *end)
{
u_char *ptr=(u_char *)addr;
assert(ptr[5]==0xB8);
u_int source=*(u_int *)(ptr+6);
u_int len=*(u_int *)(ptr+16);
assert(ptr[20]==0xE8); u_int verifier=*(u_int *)(ptr+21)+(u_int)ptr+25;
if(verifier==(u_int)verify_code_vm||verifier==(u_int)verify_code_ds) {
if(memory_map[source>>12]>=0x80000000) source = 0;
else source = source+(memory_map[source>>12]<<2);
}
if(start) *start=source;
if(end) *end=source+len;
}
static void alloc_reg(struct regstat *cur,int i,signed char reg)
{
int r,hr;
int preferred_reg = (reg&3)+(reg>28)*4-(reg==32)+2*(reg==36)-(reg==40);
if((cur->u>>reg)&1) return;
for(hr=0;hr<HOST_REGS;hr++)
{
if(cur->regmap[hr]==reg) return;
}
preferred_reg = loop_reg(i,reg,preferred_reg);
if(cur->regmap[preferred_reg]==-1) {
cur->regmap[preferred_reg]=reg;
cur->dirty&=~(1<<preferred_reg);
cur->isconst&=~(1<<preferred_reg);
return;
}
r=cur->regmap[preferred_reg];
if(r<64&&((cur->u>>r)&1)) {
cur->regmap[preferred_reg]=reg;
cur->dirty&=~(1<<preferred_reg);
cur->isconst&=~(1<<preferred_reg);
return;
}
if(r>=64&&((cur->uu>>(r&63))&1)) {
cur->regmap[preferred_reg]=reg;
cur->dirty&=~(1<<preferred_reg);
cur->isconst&=~(1<<preferred_reg);
return;
}
for(hr=0;hr<4;hr++) {
if(cur->regmap[hr]==-1) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
for(hr=0;hr<HOST_REGS;hr++)
{
r=cur->regmap[hr];
if(r>=0) {
if(r<64) {
if((cur->u>>r)&1)
if(i==0||(unneeded_reg[i-1]>>r)&1) {cur->regmap[hr]=-1;break;}
}
else
{
if((cur->uu>>(r&63))&1)
if(i==0||(unneeded_reg_upper[i-1]>>(r&63))&1) {cur->regmap[hr]=-1;break;}
}
}
}
if(i>0) {
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=EXCLUDE_REG&&cur->regmap[hr]==-1) {
if(regs[i-1].regmap[hr]!=rs1[i-1]&®s[i-1].regmap[hr]!=rs2[i-1]&®s[i-1].regmap[hr]!=rt1[i-1]&®s[i-1].regmap[hr]!=rt2[i-1]) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=EXCLUDE_REG&&cur->regmap[hr]==-1) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
u_char hsn[MAXREG+1];
memset(hsn,10,sizeof(hsn));
int j;
lsn(hsn,i,&preferred_reg);
if(i>0) {
if(bt[i]&&hsn[CCREG]>2) hsn[CCREG]=2;
if(i>1&&hsn[CCREG]>2&&(itype[i-2]==RJUMP||itype[i-2]==UJUMP||itype[i-2]==CJUMP||itype[i-2]==SJUMP||itype[i-2]==FJUMP)) hsn[CCREG]=2;
for(j=10;j>=3;j--)
{
if(hsn[r=cur->regmap[preferred_reg]&63]==j) {
for(hr=0;hr<HOST_REGS;hr++) {
if((cur->regmap[hr]&63)==r) {
cur->regmap[hr]=-1;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
}
}
cur->regmap[preferred_reg]=reg;
return;
}
for(r=1;r<=MAXREG;r++)
{
if(hsn[r]==j&&r!=rs1[i-1]&&r!=rs2[i-1]&&r!=rt1[i-1]&&r!=rt2[i-1]) {
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=HOST_CCREG||j<hsn[CCREG]) {
if(cur->regmap[hr]==r+64) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=HOST_CCREG||j<hsn[CCREG]) {
if(cur->regmap[hr]==r) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
}
}
for(j=10;j>=0;j--)
{
for(r=1;r<=MAXREG;r++)
{
if(hsn[r]==j) {
for(hr=0;hr<HOST_REGS;hr++) {
if(cur->regmap[hr]==r+64) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(cur->regmap[hr]==r) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
DebugMessage(M64MSG_ERROR, "This shouldn't happen (alloc_reg)");exit(1);
}
static void alloc_reg64(struct regstat *cur,int i,signed char reg)
{
int preferred_reg = 5+reg%3;
int r,hr;
alloc_reg(cur,i,reg);
if((cur->uu>>reg)&1) return;
for(hr=0;hr<HOST_REGS;hr++)
{
if(cur->regmap[hr]==reg+64) return;
}
preferred_reg = loop_reg(i,reg,preferred_reg);
if(cur->regmap[preferred_reg]==-1) {
cur->regmap[preferred_reg]=reg|64;
cur->dirty&=~(1<<preferred_reg);
cur->isconst&=~(1<<preferred_reg);
return;
}
r=cur->regmap[preferred_reg];
if(r<64&&((cur->u>>r)&1)) {
cur->regmap[preferred_reg]=reg|64;
cur->dirty&=~(1<<preferred_reg);
cur->isconst&=~(1<<preferred_reg);
return;
}
if(r>=64&&((cur->uu>>(r&63))&1)) {
cur->regmap[preferred_reg]=reg|64;
cur->dirty&=~(1<<preferred_reg);
cur->isconst&=~(1<<preferred_reg);
return;
}
for(hr=5;hr<8;hr++) {
if(cur->regmap[hr]==-1) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
for(hr=HOST_REGS-1;hr>=0;hr--)
{
r=cur->regmap[hr];
if(r>=0) {
if(r<64) {
if((cur->u>>r)&1) {cur->regmap[hr]=-1;break;}
}
else
{
if((cur->uu>>(r&63))&1) {cur->regmap[hr]=-1;break;}
}
}
}
if(i>0) {
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=EXCLUDE_REG&&cur->regmap[hr]==-1) {
if(regs[i-1].regmap[hr]!=rs1[i-1]&®s[i-1].regmap[hr]!=rs2[i-1]&®s[i-1].regmap[hr]!=rt1[i-1]&®s[i-1].regmap[hr]!=rt2[i-1]) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=EXCLUDE_REG&&cur->regmap[hr]==-1) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
u_char hsn[MAXREG+1];
memset(hsn,10,sizeof(hsn));
int j;
lsn(hsn,i,&preferred_reg);
if(i>0) {
if(bt[i]&&hsn[CCREG]>2) hsn[CCREG]=2;
if(i>1&&hsn[CCREG]>2&&(itype[i-2]==RJUMP||itype[i-2]==UJUMP||itype[i-2]==CJUMP||itype[i-2]==SJUMP||itype[i-2]==FJUMP)) hsn[CCREG]=2;
for(j=10;j>=3;j--)
{
if(hsn[r=cur->regmap[preferred_reg]&63]==j) {
for(hr=0;hr<HOST_REGS;hr++) {
if((cur->regmap[hr]&63)==r) {
cur->regmap[hr]=-1;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
}
}
cur->regmap[preferred_reg]=reg|64;
return;
}
for(r=1;r<=MAXREG;r++)
{
if(hsn[r]==j&&r!=rs1[i-1]&&r!=rs2[i-1]&&r!=rt1[i-1]&&r!=rt2[i-1]) {
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=HOST_CCREG||j<hsn[CCREG]) {
if(cur->regmap[hr]==r+64) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=HOST_CCREG||j<hsn[CCREG]) {
if(cur->regmap[hr]==r) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
}
}
for(j=10;j>=0;j--)
{
for(r=1;r<=MAXREG;r++)
{
if(hsn[r]==j) {
for(hr=0;hr<HOST_REGS;hr++) {
if(cur->regmap[hr]==r+64) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(cur->regmap[hr]==r) {
cur->regmap[hr]=reg|64;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
DebugMessage(M64MSG_ERROR, "This shouldn't happen");exit(1);
}
static void alloc_reg_temp(struct regstat *cur,int i,signed char reg)
{
int r,hr;
int preferred_reg = -1;
for(hr=0;hr<HOST_REGS;hr++)
{
if(hr!=EXCLUDE_REG&&cur->regmap[hr]==reg) return;
}
for(hr=HOST_REGS-1;hr>=0;hr--) {
if(hr!=EXCLUDE_REG&&cur->regmap[hr]==-1) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
for(hr=HOST_REGS-1;hr>=0;hr--)
{
r=cur->regmap[hr];
if(r>=0) {
if(r<64) {
if((cur->u>>r)&1) {
if(i==0||((unneeded_reg[i-1]>>r)&1)) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
else
{
if((cur->uu>>(r&63))&1) {
if(i==0||((unneeded_reg_upper[i-1]>>(r&63))&1)) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
u_char hsn[MAXREG+1];
memset(hsn,10,sizeof(hsn));
int j;
lsn(hsn,i,&preferred_reg);
if(i>0) {
if(bt[i]&&hsn[CCREG]>2) hsn[CCREG]=2;
if(i>1&&hsn[CCREG]>2&&(itype[i-2]==RJUMP||itype[i-2]==UJUMP||itype[i-2]==CJUMP||itype[i-2]==SJUMP||itype[i-2]==FJUMP)) hsn[CCREG]=2;
for(j=10;j>=3;j--)
{
for(r=1;r<=MAXREG;r++)
{
if(hsn[r]==j&&r!=rs1[i-1]&&r!=rs2[i-1]&&r!=rt1[i-1]&&r!=rt2[i-1]) {
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=HOST_CCREG||hsn[CCREG]>2) {
if(cur->regmap[hr]==r+64) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(hr!=HOST_CCREG||hsn[CCREG]>2) {
if(cur->regmap[hr]==r) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
}
}
for(j=10;j>=0;j--)
{
for(r=1;r<=MAXREG;r++)
{
if(hsn[r]==j) {
for(hr=0;hr<HOST_REGS;hr++) {
if(cur->regmap[hr]==r+64) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
for(hr=0;hr<HOST_REGS;hr++) {
if(cur->regmap[hr]==r) {
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->isconst&=~(1<<hr);
return;
}
}
}
}
}
DebugMessage(M64MSG_ERROR, "This shouldn't happen");exit(1);
}
static void alloc_x86_reg(struct regstat *cur,int i,signed char reg,int hr)
{
int n;
int dirty=0;
for(n=0;n<HOST_REGS;n++)
{
if(n!=ESP&&cur->regmap[n]==reg) {
dirty=(cur->dirty>>n)&1;
cur->regmap[n]=-1;
}
}
cur->regmap[hr]=reg;
cur->dirty&=~(1<<hr);
cur->dirty|=dirty<<hr;
cur->isconst&=~(1<<hr);
}
static void alloc_cc(struct regstat *cur,int i)
{
alloc_x86_reg(cur,i,CCREG,ESI);
}
static void multdiv_alloc_x86(struct regstat *current,int i)
{
clear_const(current,rs1[i]);
clear_const(current,rs2[i]);
if(rs1[i]&&rs2[i])
{
if((opcode2[i]&4)==0) {
current->u&=~(1LL<<HIREG);
current->u&=~(1LL<<LOREG);
alloc_x86_reg(current,i,HIREG,EDX);
alloc_x86_reg(current,i,LOREG,EAX);
alloc_reg(current,i,rs1[i]);
alloc_reg(current,i,rs2[i]);
current->is32|=1LL<<HIREG;
current->is32|=1LL<<LOREG;
dirty_reg(current,HIREG);
dirty_reg(current,LOREG);
}
else {
alloc_x86_reg(current,i,HIREG|64,EDX);
alloc_x86_reg(current,i,HIREG,EAX);
alloc_reg64(current,i,rs1[i]);
alloc_reg64(current,i,rs2[i]);
alloc_all(current,i);
current->is32&=~(1LL<<HIREG);
current->is32&=~(1LL<<LOREG);
dirty_reg(current,HIREG);
dirty_reg(current,LOREG);
}
}
else
{
alloc_reg(current,i,HIREG);
alloc_reg(current,i,LOREG);
current->is32|=1LL<<HIREG;
current->is32|=1LL<<LOREG;
dirty_reg(current,HIREG);
dirty_reg(current,LOREG);
}
}
#define multdiv_alloc multdiv_alloc_x86
static const char regname[8][4] = {
"eax",
"ecx",
"edx",
"ebx",
"esp",
"ebp",
"esi",
"edi"};
static void output_byte(u_char byte)
{
*(out++)=byte;
}
static void output_modrm(u_char mod,u_char rm,u_char ext)
{
assert(mod<4);
assert(rm<8);
assert(ext<8);
u_char byte=(mod<<6)|(ext<<3)|rm;
*(out++)=byte;
}
static void output_sib(u_char scale,u_char index,u_char base)
{
assert(scale<4);
assert(index<8);
assert(base<8);
u_char byte=(scale<<6)|(index<<3)|base;
*(out++)=byte;
}
static void output_w32(u_int word)
{
*((u_int *)out)=word;
out+=4;
}
static void emit_mov(int rs,int rt)
{
assem_debug("mov %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x89);
output_modrm(3,rt,rs);
}
static void emit_add(int rs1,int rs2,int rt)
{
if(rs1==rt) {
assem_debug("add %%%s,%%%s",regname[rs2],regname[rs1]);
output_byte(0x01);
output_modrm(3,rs1,rs2);
}else if(rs2==rt) {
assem_debug("add %%%s,%%%s",regname[rs1],regname[rs2]);
output_byte(0x01);
output_modrm(3,rs2,rs1);
}else {
assem_debug("mov %%%s,%%%s",regname[rs1],regname[rt]);
output_byte(0x89);
output_modrm(3,rt,rs1);
assem_debug("add %%%s,%%%s",regname[rs2],regname[rt]);
output_byte(0x01);
output_modrm(3,rt,rs2);
}
}
static void emit_adc(int rs1,int rs2,int rt)
{
if(rs1==rt) {
assem_debug("adc %%%s,%%%s",regname[rs2],regname[rs1]);
output_byte(0x11);
output_modrm(3,rs1,rs2);
}else if(rs2==rt) {
assem_debug("adc %%%s,%%%s",regname[rs1],regname[rs2]);
output_byte(0x11);
output_modrm(3,rs2,rs1);
}else {
assem_debug("mov %%%s,%%%s",regname[rs1],regname[rt]);
output_byte(0x89);
output_modrm(3,rt,rs1);
assem_debug("adc %%%s,%%%s",regname[rs2],regname[rt]);
output_byte(0x11);
output_modrm(3,rt,rs2);
}
}
static void emit_adds(int rs1,int rs2,int rt)
{
emit_add(rs1,rs2,rt);
}
static void emit_lea8(int rs1,int rt)
{
assem_debug("lea 0(%%%s,8),%%%s",regname[rs1],regname[rt]);
output_byte(0x8D);
output_modrm(0,4,rt);
output_sib(3,rs1,5);
output_w32(0);
}
static void emit_leairrx1(int imm,int rs1,int rs2,int rt)
{
assem_debug("lea %x(%%%s,%%%s,1),%%%s",imm,regname[rs1],regname[rs2],regname[rt]);
output_byte(0x8D);
if(imm!=0||rs1==EBP) {
output_modrm(2,4,rt);
output_sib(0,rs2,rs1);
output_w32(imm);
}else{
output_modrm(0,4,rt);
output_sib(0,rs2,rs1);
}
}
static void emit_leairrx4(int imm,int rs1,int rs2,int rt)
{
assem_debug("lea %x(%%%s,%%%s,4),%%%s",imm,regname[rs1],regname[rs2],regname[rt]);
output_byte(0x8D);
if(imm!=0||rs1==EBP) {
output_modrm(2,4,rt);
output_sib(2,rs2,rs1);
output_w32(imm);
}else{
output_modrm(0,4,rt);
output_sib(2,rs2,rs1);
}
}
static void emit_neg(int rs, int rt)
{
if(rs!=rt) emit_mov(rs,rt);
assem_debug("neg %%%s",regname[rt]);
output_byte(0xF7);
output_modrm(3,rt,3);
}
static void emit_negs(int rs, int rt)
{
emit_neg(rs,rt);
}
static void emit_sub(int rs1,int rs2,int rt)
{
if(rs1==rt) {
assem_debug("sub %%%s,%%%s",regname[rs2],regname[rs1]);
output_byte(0x29);
output_modrm(3,rs1,rs2);
} else if(rs2==rt) {
emit_neg(rs2,rs2);
emit_add(rs2,rs1,rs2);
} else {
emit_mov(rs1,rt);
emit_sub(rt,rs2,rt);
}
}
static void emit_subs(int rs1,int rs2,int rt)
{
emit_sub(rs1,rs2,rt);
}
static void emit_zeroreg(int rt)
{
output_byte(0x31);
output_modrm(3,rt,rt);
assem_debug("xor %%%s,%%%s",regname[rt],regname[rt]);
}
static void emit_loadreg(int r, int hr)
{
if((r&63)==0)
emit_zeroreg(hr);
else {
int addr=((int)reg)+((r&63)<<3)+((r&64)>>4);
if((r&63)==HIREG) addr=(int)&hi+((r&64)>>4);
if((r&63)==LOREG) addr=(int)&lo+((r&64)>>4);
if(r==CCREG) addr=(int)&cycle_count;
if(r==CSREG) addr=(int)&g_cp0_regs[CP0_STATUS_REG];
if(r==FSREG) addr=(int)&FCR31;
assem_debug("mov %x+%d,%%%s",addr,r,regname[hr]);
output_byte(0x8B);
output_modrm(0,5,hr);
output_w32(addr);
}
}
static void emit_storereg(int r, int hr)
{
int addr=((int)reg)+((r&63)<<3)+((r&64)>>4);
if((r&63)==HIREG) addr=(int)&hi+((r&64)>>4);
if((r&63)==LOREG) addr=(int)&lo+((r&64)>>4);
if(r==CCREG) addr=(int)&cycle_count;
if(r==FSREG) addr=(int)&FCR31;
assem_debug("mov %%%s,%x+%d",regname[hr],addr,r);
output_byte(0x89);
output_modrm(0,5,hr);
output_w32(addr);
}
static void emit_test(int rs, int rt)
{
assem_debug("test %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x85);
output_modrm(3,rs,rt);
}
static void emit_testimm(int rs,int imm)
{
assem_debug("test $0x%x,%%%s",imm,regname[rs]);
if(imm<128&&imm>=-128&&rs<4) {
output_byte(0xF6);
output_modrm(3,rs,0);
output_byte(imm);
}
else
{
output_byte(0xF7);
output_modrm(3,rs,0);
output_w32(imm);
}
}
static void emit_not(int rs,int rt)
{
if(rs!=rt) emit_mov(rs,rt);
assem_debug("not %%%s",regname[rt]);
output_byte(0xF7);
output_modrm(3,rt,2);
}
static void emit_and(u_int rs1,u_int rs2,u_int rt)
{
assert(rs1<8);
assert(rs2<8);
assert(rt<8);
if(rs1==rt) {
assem_debug("and %%%s,%%%s",regname[rs2],regname[rt]);
output_byte(0x21);
output_modrm(3,rs1,rs2);
}
else
if(rs2==rt) {
assem_debug("and %%%s,%%%s",regname[rs1],regname[rt]);
output_byte(0x21);
output_modrm(3,rs2,rs1);
}
else {
emit_mov(rs1,rt);
emit_and(rt,rs2,rt);
}
}
static void emit_or(u_int rs1,u_int rs2,u_int rt)
{
assert(rs1<8);
assert(rs2<8);
assert(rt<8);
if(rs1==rt) {
assem_debug("or %%%s,%%%s",regname[rs2],regname[rt]);
output_byte(0x09);
output_modrm(3,rs1,rs2);
}
else
if(rs2==rt) {
assem_debug("or %%%s,%%%s",regname[rs1],regname[rt]);
output_byte(0x09);
output_modrm(3,rs2,rs1);
}
else {
emit_mov(rs1,rt);
emit_or(rt,rs2,rt);
}
}
static void emit_or_and_set_flags(int rs1,int rs2,int rt)
{
emit_or(rs1,rs2,rt);
}
static void emit_xor(u_int rs1,u_int rs2,u_int rt)
{
assert(rs1<8);
assert(rs2<8);
assert(rt<8);
if(rs1==rt) {
assem_debug("xor %%%s,%%%s",regname[rs2],regname[rt]);
output_byte(0x31);
output_modrm(3,rs1,rs2);
}
else
if(rs2==rt) {
assem_debug("xor %%%s,%%%s",regname[rs1],regname[rt]);
output_byte(0x31);
output_modrm(3,rs2,rs1);
}
else {
emit_mov(rs1,rt);
emit_xor(rt,rs2,rt);
}
}
static void emit_movimm(int imm,u_int rt)
{
assem_debug("mov $%d,%%%s",imm,regname[rt]);
assert(rt<8);
output_byte(0xB8+rt);
output_w32(imm);
}
static void emit_addimm(int rs,int imm,int rt)
{
if(rs==rt) {
if(imm!=0) {
assem_debug("add $%d,%%%s",imm,regname[rt]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,0);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,0);
output_w32(imm);
}
}
}
else {
if(imm!=0) {
assem_debug("lea %d(%%%s),%%%s",imm,regname[rs],regname[rt]);
output_byte(0x8D);
if(imm<128&&imm>=-128) {
output_modrm(1,rs,rt);
output_byte(imm);
}else{
output_modrm(2,rs,rt);
output_w32(imm);
}
}else{
emit_mov(rs,rt);
}
}
}
static void emit_addimm_and_set_flags(int imm,int rt)
{
assem_debug("add $%d,%%%s",imm,regname[rt]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,0);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,0);
output_w32(imm);
}
}
static void emit_addimm_no_flags(int imm,int rt)
{
if(imm!=0) {
assem_debug("lea %d(%%%s),%%%s",imm,regname[rt],regname[rt]);
output_byte(0x8D);
if(imm<128&&imm>=-128) {
output_modrm(1,rt,rt);
output_byte(imm);
}else{
output_modrm(2,rt,rt);
output_w32(imm);
}
}
}
static void emit_adcimm(int imm,u_int rt)
{
assem_debug("adc $%d,%%%s",imm,regname[rt]);
assert(rt<8);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,2);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,2);
output_w32(imm);
}
}
static void emit_sbbimm(int imm,u_int rt)
{
assem_debug("sbb $%d,%%%s",imm,regname[rt]);
assert(rt<8);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,3);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,3);
output_w32(imm);
}
}
static void emit_addimm64_32(int rsh,int rsl,int imm,int rth,int rtl)
{
if(rsh==rth&&rsl==rtl) {
assem_debug("add $%d,%%%s",imm,regname[rtl]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rtl,0);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rtl,0);
output_w32(imm);
}
assem_debug("adc $%d,%%%s",imm>>31,regname[rth]);
output_byte(0x83);
output_modrm(3,rth,2);
output_byte(imm>>31);
}
else {
emit_mov(rsh,rth);
emit_mov(rsl,rtl);
emit_addimm64_32(rth,rtl,imm,rth,rtl);
}
}
static void emit_sub64_32(int rs1l,int rs1h,int rs2l,int rs2h,int rtl,int rth)
{
if((rs1l==rtl)&&(rs1h==rth)) {
assem_debug("sub %%%s,%%%s",regname[rs2l],regname[rs1l]);
output_byte(0x29);
output_modrm(3,rs1l,rs2l);
assem_debug("sbb %%%s,%%%s",regname[rs2h],regname[rs1h]);
output_byte(0x19);
output_modrm(3,rs1h,rs2h);
} else if((rs2l==rtl)&&(rs2h==rth)) {
emit_neg(rs2l,rs2l);
emit_adcimm(-1,rs2h);
assem_debug("add %%%s,%%%s",regname[rs1l],regname[rs2l]);
output_byte(0x01);
output_modrm(3,rs2l,rs1l);
emit_not(rs2h,rs2h);
assem_debug("adc %%%s,%%%s",regname[rs1h],regname[rs2h]);
output_byte(0x11);
output_modrm(3,rs2h,rs1h);
} else {
emit_mov(rs1l,rtl);
assem_debug("sub %%%s,%%%s",regname[rs2l],regname[rtl]);
output_byte(0x29);
output_modrm(3,rtl,rs2l);
emit_mov(rs1h,rth);
assem_debug("sbb %%%s,%%%s",regname[rs2h],regname[rth]);
output_byte(0x19);
output_modrm(3,rth,rs2h);
}
}
static void emit_sbb(int rs1,int rs2)
{
assem_debug("sbb %%%s,%%%s",regname[rs1],regname[rs2]);
output_byte(0x19);
output_modrm(3,rs2,rs1);
}
static void emit_andimm(int rs,int imm,int rt)
{
if(imm==0) {
emit_zeroreg(rt);
}
else if(rs==rt) {
assem_debug("and $%d,%%%s",imm,regname[rt]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,4);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,4);
output_w32(imm);
}
}
else {
emit_mov(rs,rt);
emit_andimm(rt,imm,rt);
}
}
static void emit_orimm(int rs,int imm,int rt)
{
if(rs==rt) {
if(imm!=0) {
assem_debug("or $%d,%%%s",imm,regname[rt]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,1);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,1);
output_w32(imm);
}
}
}
else {
emit_mov(rs,rt);
emit_orimm(rt,imm,rt);
}
}
static void emit_xorimm(int rs,int imm,int rt)
{
if(rs==rt) {
if(imm!=0) {
assem_debug("xor $%d,%%%s",imm,regname[rt]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rt,6);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rt,6);
output_w32(imm);
}
}
}
else {
emit_mov(rs,rt);
emit_xorimm(rt,imm,rt);
}
}
static void emit_shlimm(int rs,u_int imm,int rt)
{
if(rs==rt) {
assem_debug("shl %%%s,%d",regname[rt],imm);
assert(imm>0);
if(imm==1) output_byte(0xD1);
else output_byte(0xC1);
output_modrm(3,rt,4);
if(imm>1) output_byte(imm);
}
else {
emit_mov(rs,rt);
emit_shlimm(rt,imm,rt);
}
}
static void emit_shrimm(int rs,u_int imm,int rt)
{
if(rs==rt) {
assem_debug("shr %%%s,%d",regname[rt],imm);
assert(imm>0);
if(imm==1) output_byte(0xD1);
else output_byte(0xC1);
output_modrm(3,rt,5);
if(imm>1) output_byte(imm);
}
else {
emit_mov(rs,rt);
emit_shrimm(rt,imm,rt);
}
}
static void emit_sarimm(int rs,u_int imm,int rt)
{
if(rs==rt) {
assem_debug("sar %%%s,%d",regname[rt],imm);
assert(imm>0);
if(imm==1) output_byte(0xD1);
else output_byte(0xC1);
output_modrm(3,rt,7);
if(imm>1) output_byte(imm);
}
else {
emit_mov(rs,rt);
emit_sarimm(rt,imm,rt);
}
}
static void emit_rorimm(int rs,u_int imm,int rt)
{
if(rs==rt) {
assem_debug("ror %%%s,%d",regname[rt],imm);
assert(imm>0);
if(imm==1) output_byte(0xD1);
else output_byte(0xC1);
output_modrm(3,rt,1);
if(imm>1) output_byte(imm);
}
else {
emit_mov(rs,rt);
emit_rorimm(rt,imm,rt);
}
}
static void emit_shldimm(int rs,int rs2,u_int imm,int rt)
{
if(rs==rt) {
assem_debug("shld %%%s,%%%s,%d",regname[rt],regname[rs2],imm);
assert(imm>0);
output_byte(0x0F);
output_byte(0xA4);
output_modrm(3,rt,rs2);
output_byte(imm);
}
else {
emit_mov(rs,rt);
emit_shldimm(rt,rs2,imm,rt);
}
}
static void emit_shrdimm(int rs,int rs2,u_int imm,int rt)
{
if(rs==rt) {
assem_debug("shrd %%%s,%%%s,%d",regname[rt],regname[rs2],imm);
assert(imm>0);
output_byte(0x0F);
output_byte(0xAC);
output_modrm(3,rt,rs2);
output_byte(imm);
}
else {
emit_mov(rs,rt);
emit_shrdimm(rt,rs2,imm,rt);
}
}
static void emit_shlcl(int r)
{
assem_debug("shl %%%s,%%cl",regname[r]);
output_byte(0xD3);
output_modrm(3,r,4);
}
static void emit_shrcl(int r)
{
assem_debug("shr %%%s,%%cl",regname[r]);
output_byte(0xD3);
output_modrm(3,r,5);
}
static void emit_sarcl(int r)
{
assem_debug("sar %%%s,%%cl",regname[r]);
output_byte(0xD3);
output_modrm(3,r,7);
}
static void emit_shldcl(int r1,int r2)
{
assem_debug("shld %%%s,%%%s,%%cl",regname[r1],regname[r2]);
output_byte(0x0F);
output_byte(0xA5);
output_modrm(3,r1,r2);
}
static void emit_shrdcl(int r1,int r2)
{
assem_debug("shrd %%%s,%%%s,%%cl",regname[r1],regname[r2]);
output_byte(0x0F);
output_byte(0xAD);
output_modrm(3,r1,r2);
}
static void emit_cmpimm(int rs,int imm)
{
assem_debug("cmp $%d,%%%s",imm,regname[rs]);
if(imm<128&&imm>=-128) {
output_byte(0x83);
output_modrm(3,rs,7);
output_byte(imm);
}
else
{
output_byte(0x81);
output_modrm(3,rs,7);
output_w32(imm);
}
}
static void emit_cmovne(const u_int *addr,int rt)
{
assem_debug("cmovne %x,%%%s",(int)addr,regname[rt]);
if(addr==&const_zero) assem_debug(" [zero]");
else if(addr==&const_one) assem_debug(" [one]");
else assem_debug("");
output_byte(0x0F);
output_byte(0x45);
output_modrm(0,5,rt);
output_w32((int)addr);
}
static void emit_cmovl(const u_int *addr,int rt)
{
assem_debug("cmovl %x,%%%s",(int)addr,regname[rt]);
if(addr==&const_zero) assem_debug(" [zero]");
else if(addr==&const_one) assem_debug(" [one]");
else assem_debug("");
output_byte(0x0F);
output_byte(0x4C);
output_modrm(0,5,rt);
output_w32((int)addr);
}
static void emit_cmovs(const u_int *addr,int rt)
{
assem_debug("cmovs %x,%%%s",(int)addr,regname[rt]);
if(addr==&const_zero) assem_debug(" [zero]");
else if(addr==&const_one) assem_debug(" [one]");
else assem_debug("");
output_byte(0x0F);
output_byte(0x48);
output_modrm(0,5,rt);
output_w32((int)addr);
}
static void emit_cmovne_reg(int rs,int rt)
{
assem_debug("cmovne %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x45);
output_modrm(3,rs,rt);
}
static void emit_cmovl_reg(int rs,int rt)
{
assem_debug("cmovl %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x4C);
output_modrm(3,rs,rt);
}
static void emit_cmovs_reg(int rs,int rt)
{
assem_debug("cmovs %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x48);
output_modrm(3,rs,rt);
}
static void emit_cmovnc_reg(int rs,int rt)
{
assem_debug("cmovae %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x43);
output_modrm(3,rs,rt);
}
static void emit_cmova_reg(int rs,int rt)
{
assem_debug("cmova %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x47);
output_modrm(3,rs,rt);
}
static void emit_cmovp_reg(int rs,int rt)
{
assem_debug("cmovp %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x4A);
output_modrm(3,rs,rt);
}
static void emit_cmovnp_reg(int rs,int rt)
{
assem_debug("cmovnp %%%s,%%%s",regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0x4B);
output_modrm(3,rs,rt);
}
static void emit_setl(int rt)
{
assem_debug("setl %%%s",regname[rt]);
output_byte(0x0F);
output_byte(0x9C);
output_modrm(3,rt,2);
}
static void emit_movzbl_reg(int rs, int rt)
{
assem_debug("movzbl %%%s,%%%s",regname[rs]+1,regname[rt]);
output_byte(0x0F);
output_byte(0xB6);
output_modrm(3,rs,rt);
}
static void emit_slti32(int rs,int imm,int rt)
{
if(rs!=rt) emit_zeroreg(rt);
emit_cmpimm(rs,imm);
if(rt<4) {
emit_setl(rt);
if(rs==rt) emit_movzbl_reg(rt,rt);
}
else
{
if(rs==rt) emit_movimm(0,rt);
emit_cmovl(&const_one,rt);
}
}
static void emit_sltiu32(int rs,int imm,int rt)
{
if(rs!=rt) emit_zeroreg(rt);
emit_cmpimm(rs,imm);
if(rs==rt) emit_movimm(0,rt);
emit_adcimm(0,rt);
}
static void emit_slti64_32(int rsh,int rsl,int imm,int rt)
{
assert(rsh!=rt);
emit_slti32(rsl,imm,rt);
if(imm>=0)
{
emit_test(rsh,rsh);
emit_cmovne(&const_zero,rt);
emit_cmovs(&const_one,rt);
}
else
{
emit_cmpimm(rsh,-1);
emit_cmovne(&const_zero,rt);
emit_cmovl(&const_one,rt);
}
}
static void emit_sltiu64_32(int rsh,int rsl,int imm,int rt)
{
assert(rsh!=rt);
emit_sltiu32(rsl,imm,rt);
if(imm>=0)
{
emit_test(rsh,rsh);
emit_cmovne(&const_zero,rt);
}
else
{
emit_cmpimm(rsh,-1);
emit_cmovne(&const_one,rt);
}
}
static void emit_cmp(int rs,int rt)
{
assem_debug("cmp %%%s,%%%s",regname[rt],regname[rs]);
output_byte(0x39);
output_modrm(3,rs,rt);
}
static void emit_set_gz32(int rs, int rt)
{
emit_cmpimm(rs,1);
emit_movimm(1,rt);
emit_cmovl(&const_zero,rt);
}
static void emit_set_nz32(int rs, int rt)
{
emit_cmpimm(rs,1);
emit_movimm(1,rt);
emit_sbbimm(0,rt);
}
static void emit_set_gz64_32(int rsh, int rsl, int rt)
{
emit_set_gz32(rsl,rt);
emit_test(rsh,rsh);
emit_cmovne(&const_one,rt);
emit_cmovs(&const_zero,rt);
}
static void emit_set_nz64_32(int rsh, int rsl, int rt)
{
emit_or_and_set_flags(rsh,rsl,rt);
emit_cmovne(&const_one,rt);
}
static void emit_set_if_less32(int rs1, int rs2, int rt)
{
if(rs1!=rt&&rs2!=rt) emit_zeroreg(rt);
emit_cmp(rs1,rs2);
if(rs1==rt||rs2==rt) emit_movimm(0,rt);
emit_cmovl(&const_one,rt);
}
static void emit_set_if_carry32(int rs1, int rs2, int rt)
{
if(rs1!=rt&&rs2!=rt) emit_zeroreg(rt);
emit_cmp(rs1,rs2);
if(rs1==rt||rs2==rt) emit_movimm(0,rt);
emit_adcimm(0,rt);
}
static void emit_set_if_less64_32(int u1, int l1, int u2, int l2, int rt)
{
assert(u1!=rt);
assert(u2!=rt);
emit_cmp(l1,l2);
emit_mov(u1,rt);
emit_sbb(u2,rt);
emit_movimm(0,rt);
emit_cmovl(&const_one,rt);
}
static void emit_set_if_carry64_32(int u1, int l1, int u2, int l2, int rt)
{
assert(u1!=rt);
assert(u2!=rt);
emit_cmp(l1,l2);
emit_mov(u1,rt);
emit_sbb(u2,rt);
emit_movimm(0,rt);
emit_adcimm(0,rt);
}
static void emit_call(int a)
{
assem_debug("call %x (%x+%x)",a,(int)out+5,a-(int)out-5);
output_byte(0xe8);
output_w32(a-(int)out-4);
}
static void emit_jmp(int a)
{
assem_debug("jmp %x (%x+%x)",a,(int)out+5,a-(int)out-5);
output_byte(0xe9);
output_w32(a-(int)out-4);
}
static void emit_jne(int a)
{
assem_debug("jne %x",a);
output_byte(0x0f);
output_byte(0x85);
output_w32(a-(int)out-4);
}
static void emit_jeq(int a)
{
assem_debug("jeq %x",a);
output_byte(0x0f);
output_byte(0x84);
output_w32(a-(int)out-4);
}
static void emit_js(int a)
{
assem_debug("js %x",a);
output_byte(0x0f);
output_byte(0x88);
output_w32(a-(int)out-4);
}
static void emit_jns(int a)
{
assem_debug("jns %x",a);
output_byte(0x0f);
output_byte(0x89);
output_w32(a-(int)out-4);
}
static void emit_jl(int a)
{
assem_debug("jl %x",a);
output_byte(0x0f);
output_byte(0x8c);
output_w32(a-(int)out-4);
}
static void emit_jge(int a)
{
assem_debug("jge %x",a);
output_byte(0x0f);
output_byte(0x8d);
output_w32(a-(int)out-4);
}
static void emit_jno(int a)
{
assem_debug("jno %x",a);
output_byte(0x0f);
output_byte(0x81);
output_w32(a-(int)out-4);
}
static void emit_jc(int a)
{
assem_debug("jc %x",a);
output_byte(0x0f);
output_byte(0x82);
output_w32(a-(int)out-4);
}
static void emit_jae(int a)
{
assem_debug("jae %x",a);
output_byte(0x0f);
output_byte(0x83);
output_w32(a-(int)out-4);
}
static void emit_jb(int a)
{
assem_debug("jb %x",a);
output_byte(0x0f);
output_byte(0x82);
output_w32(a-(int)out-4);
}
static void emit_pushimm(int imm)
{
assem_debug("push $%x",imm);
output_byte(0x68);
output_w32(imm);
}
static void emit_pushmem(int addr)
{
assem_debug("push *%x",addr);
output_byte(0xFF);
output_modrm(0,5,6);
output_w32(addr);
}
static void emit_pusha()
{
assem_debug("pusha");
output_byte(0x60);
}
static void emit_popa()
{
assem_debug("popa");
output_byte(0x61);
}
static void emit_pushreg(u_int r)
{
assem_debug("push %%%s",regname[r]);
assert(r<8);
output_byte(0x50+r);
}
static void emit_popreg(u_int r)
{
assem_debug("pop %%%s",regname[r]);
assert(r<8);
output_byte(0x58+r);
}
static void emit_callreg(u_int r)
{
assem_debug("call *%%%s",regname[r]);
assert(r<8);
output_byte(0xFF);
output_modrm(3,r,2);
}
static void emit_jmpmem_indexed(u_int addr,u_int r)
{
assem_debug("jmp *%x(%%%s)",addr,regname[r]);
assert(r<8);
output_byte(0xFF);
output_modrm(2,r,4);
output_w32(addr);
}
static void emit_readword(int addr, int rt)
{
assem_debug("mov %x,%%%s",addr,regname[rt]);
output_byte(0x8B);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_readword_indexed(int addr, int rs, int rt)
{
assem_debug("mov %x+%%%s,%%%s",addr,regname[rs],regname[rt]);
output_byte(0x8B);
if(addr<128&&addr>=-128) {
output_modrm(1,rs,rt);
if(rs==ESP) output_sib(0,4,4);
output_byte(addr);
}
else
{
output_modrm(2,rs,rt);
if(rs==ESP) output_sib(0,4,4);
output_w32(addr);
}
}
static void emit_readword_tlb(int addr, int map, int rt)
{
if(map<0) emit_readword(addr+(int)g_rdram-0x80000000, rt);
else
{
assem_debug("mov (%x,%%%s,4),%%%s",addr,regname[map],regname[rt]);
output_byte(0x8B);
output_modrm(0,4,rt);
output_sib(2,map,5);
output_w32(addr);
}
}
static void emit_readword_indexed_tlb(int addr, int rs, int map, int rt)
{
if(map<0) emit_readword_indexed(addr+(int)g_rdram-0x80000000, rs, rt);
else {
assem_debug("mov %x(%%%s,%%%s,4),%%%s",addr,regname[rs],regname[map],regname[rt]);
assert(rs!=ESP);
output_byte(0x8B);
if(addr==0&&rs!=EBP) {
output_modrm(0,4,rt);
output_sib(2,map,rs);
}
else if(addr<128&&addr>=-128) {
output_modrm(1,4,rt);
output_sib(2,map,rs);
output_byte(addr);
}
else
{
output_modrm(2,4,rt);
output_sib(2,map,rs);
output_w32(addr);
}
}
}
static void emit_movmem_indexedx4(int addr, int rs, int rt)
{
assem_debug("mov (%x,%%%s,4),%%%s",addr,regname[rs],regname[rt]);
output_byte(0x8B);
output_modrm(0,4,rt);
output_sib(2,rs,5);
output_w32(addr);
}
static void emit_readdword_tlb(int addr, int map, int rh, int rl)
{
if(map<0) {
if(rh>=0) emit_readword(addr+(int)g_rdram-0x80000000, rh);
emit_readword(addr+(int)g_rdram-0x7FFFFFFC, rl);
}
else {
if(rh>=0) emit_movmem_indexedx4(addr, map, rh);
emit_movmem_indexedx4(addr+4, map, rl);
}
}
static void emit_readdword_indexed_tlb(int addr, int rs, int map, int rh, int rl)
{
assert(rh!=rs);
if(rh>=0) emit_readword_indexed_tlb(addr, rs, map, rh);
emit_readword_indexed_tlb(addr+4, rs, map, rl);
}
static void emit_movsbl(int addr, int rt)
{
assem_debug("movsbl %x,%%%s",addr,regname[rt]);
output_byte(0x0F);
output_byte(0xBE);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_movsbl_indexed(int addr, int rs, int rt)
{
assem_debug("movsbl %x+%%%s,%%%s",addr,regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0xBE);
output_modrm(2,rs,rt);
output_w32(addr);
}
static void emit_movsbl_tlb(int addr, int map, int rt)
{
if(map<0) emit_movsbl(addr+(int)g_rdram-0x80000000, rt);
else
{
assem_debug("movsbl (%x,%%%s,4),%%%s",addr,regname[map],regname[rt]);
output_byte(0x0F);
output_byte(0xBE);
output_modrm(0,4,rt);
output_sib(2,map,5);
output_w32(addr);
}
}
static void emit_movsbl_indexed_tlb(int addr, int rs, int map, int rt)
{
if(map<0) emit_movsbl_indexed(addr+(int)g_rdram-0x80000000, rs, rt);
else {
assem_debug("movsbl %x(%%%s,%%%s,4),%%%s",addr,regname[rs],regname[map],regname[rt]);
assert(rs!=ESP);
output_byte(0x0F);
output_byte(0xBE);
if(addr==0&&rs!=EBP) {
output_modrm(0,4,rt);
output_sib(2,map,rs);
}
else if(addr<128&&addr>=-128) {
output_modrm(1,4,rt);
output_sib(2,map,rs);
output_byte(addr);
}
else
{
output_modrm(2,4,rt);
output_sib(2,map,rs);
output_w32(addr);
}
}
}
static void emit_movswl(int addr, int rt)
{
assem_debug("movswl %x,%%%s",addr,regname[rt]);
output_byte(0x0F);
output_byte(0xBF);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_movswl_indexed(int addr, int rs, int rt)
{
assem_debug("movswl %x+%%%s,%%%s",addr,regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0xBF);
output_modrm(2,rs,rt);
output_w32(addr);
}
static void emit_movswl_tlb(int addr, int map, int rt)
{
if(map<0) emit_movswl(addr+(int)g_rdram-0x80000000, rt);
else
{
assem_debug("movswl (%x,%%%s,4),%%%s",addr,regname[map],regname[rt]);
output_byte(0x0F);
output_byte(0xBF);
output_modrm(0,4,rt);
output_sib(2,map,5);
output_w32(addr);
}
}
static void emit_movzbl(int addr, int rt)
{
assem_debug("movzbl %x,%%%s",addr,regname[rt]);
output_byte(0x0F);
output_byte(0xB6);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_movzbl_indexed(int addr, int rs, int rt)
{
assem_debug("movzbl %x+%%%s,%%%s",addr,regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0xB6);
output_modrm(2,rs,rt);
output_w32(addr);
}
static void emit_movzbl_tlb(int addr, int map, int rt)
{
if(map<0) emit_movzbl(addr+(int)g_rdram-0x80000000, rt);
else
{
assem_debug("movzbl (%x,%%%s,4),%%%s",addr,regname[map],regname[rt]);
output_byte(0x0F);
output_byte(0xB6);
output_modrm(0,4,rt);
output_sib(2,map,5);
output_w32(addr);
}
}
static void emit_movzbl_indexed_tlb(int addr, int rs, int map, int rt)
{
if(map<0) emit_movzbl_indexed(addr+(int)g_rdram-0x80000000, rs, rt);
else {
assem_debug("movzbl %x(%%%s,%%%s,4),%%%s",addr,regname[rs],regname[map],regname[rt]);
assert(rs!=ESP);
output_byte(0x0F);
output_byte(0xB6);
if(addr==0&&rs!=EBP) {
output_modrm(0,4,rt);
output_sib(2,map,rs);
}
else if(addr<128&&addr>=-128) {
output_modrm(1,4,rt);
output_sib(2,map,rs);
output_byte(addr);
}
else
{
output_modrm(2,4,rt);
output_sib(2,map,rs);
output_w32(addr);
}
}
}
static void emit_movzwl(int addr, int rt)
{
assem_debug("movzwl %x,%%%s",addr,regname[rt]);
output_byte(0x0F);
output_byte(0xB7);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_movzwl_indexed(int addr, int rs, int rt)
{
assem_debug("movzwl %x+%%%s,%%%s",addr,regname[rs],regname[rt]);
output_byte(0x0F);
output_byte(0xB7);
output_modrm(2,rs,rt);
output_w32(addr);
}
static void emit_movzwl_tlb(int addr, int map, int rt)
{
if(map<0) emit_movzwl(addr+(int)g_rdram-0x80000000, rt);
else
{
assem_debug("movzwl (%x,%%%s,4),%%%s",addr,regname[map],regname[rt]);
output_byte(0x0F);
output_byte(0xB7);
output_modrm(0,4,rt);
output_sib(2,map,5);
output_w32(addr);
}
}
static void emit_xchg(int rs, int rt)
{
assem_debug("xchg %%%s,%%%s",regname[rs],regname[rt]);
if(rs==EAX) {
output_byte(0x90+rt);
}
else
{
output_byte(0x87);
output_modrm(3,rs,rt);
}
}
static void emit_writeword(int rt, int addr)
{
assem_debug("movl %%%s,%x",regname[rt],addr);
output_byte(0x89);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_writeword_indexed(int rt, int addr, int rs)
{
assem_debug("mov %%%s,%x+%%%s",regname[rt],addr,regname[rs]);
output_byte(0x89);
if(addr<128&&addr>=-128) {
output_modrm(1,rs,rt);
if(rs==ESP) output_sib(0,4,4);
output_byte(addr);
}
else
{
output_modrm(2,rs,rt);
if(rs==ESP) output_sib(0,4,4);
output_w32(addr);
}
}
static void emit_writeword_indexed_tlb(int rt, int addr, int rs, int map, int temp)
{
if(map<0) emit_writeword_indexed(rt, addr+(int)g_rdram-0x80000000, rs);
else {
assem_debug("mov %%%s,%x(%%%s,%%%s,1)",regname[rt],addr,regname[rs],regname[map]);
assert(rs!=ESP);
output_byte(0x89);
if(addr==0&&rs!=EBP) {
output_modrm(0,4,rt);
output_sib(0,map,rs);
}
else if(addr<128&&addr>=-128) {
output_modrm(1,4,rt);
output_sib(0,map,rs);
output_byte(addr);
}
else
{
output_modrm(2,4,rt);
output_sib(0,map,rs);
output_w32(addr);
}
}
}
static void emit_writedword_indexed_tlb(int rh, int rl, int addr, int rs, int map, int temp)
{
assert(rh>=0);
emit_writeword_indexed_tlb(rh, addr, rs, map, temp);
emit_writeword_indexed_tlb(rl, addr+4, rs, map, temp);
}
static void emit_writehword(int rt, int addr)
{
assem_debug("movw %%%s,%x",regname[rt]+1,addr);
output_byte(0x66);
output_byte(0x89);
output_modrm(0,5,rt);
output_w32(addr);
}
static void emit_writehword_indexed(int rt, int addr, int rs)
{
assem_debug("movw %%%s,%x+%%%s",regname[rt]+1,addr,regname[rs]);
output_byte(0x66);
output_byte(0x89);
if(addr<128&&addr>=-128) {
output_modrm(1,rs,rt);
output_byte(addr);
}
else
{
output_modrm(2,rs,rt);
output_w32(addr);
}
}
static void emit_writebyte(int rt, int addr)
{
if(rt<4) {
assem_debug("movb %%%cl,%x",regname[rt][1],addr);
output_byte(0x88);
output_modrm(0,5,rt);
output_w32(addr);
}
else
{
emit_xchg(EAX,rt);
emit_writebyte(EAX,addr);
emit_xchg(EAX,rt);
}
}
static void emit_writebyte_indexed(int rt, int addr, int rs)
{
if(rt<4) {
assem_debug("movb %%%cl,%x+%%%s",regname[rt][1],addr,regname[rs]);
output_byte(0x88);
if(addr<128&&addr>=-128) {
output_modrm(1,rs,rt);
output_byte(addr);
}
else
{
output_modrm(2,rs,rt);
output_w32(addr);
}
}
else
{
emit_xchg(EAX,rt);
emit_writebyte_indexed(EAX,addr,rs==EAX?rt:rs);
emit_xchg(EAX,rt);
}
}
static void emit_writebyte_indexed_tlb(int rt, int addr, int rs, int map, int temp)
{
if(map<0) emit_writebyte_indexed(rt, addr+(int)g_rdram-0x80000000, rs);
else
if(rt<4) {
assem_debug("movb %%%cl,%x(%%%s,%%%s,1)",regname[rt][1],addr,regname[rs],regname[map]);
assert(rs!=ESP);
output_byte(0x88);
if(addr==0&&rs!=EBP) {
output_modrm(0,4,rt);
output_sib(0,map,rs);
}
else if(addr<128&&addr>=-128) {
output_modrm(1,4,rt);
output_sib(0,map,rs);
output_byte(addr);
}
else
{
output_modrm(2,4,rt);
output_sib(0,map,rs);
output_w32(addr);
}
}
else
{
emit_xchg(EAX,rt);
emit_writebyte_indexed_tlb(EAX,addr,rs==EAX?rt:rs,map==EAX?rt:map,temp);
emit_xchg(EAX,rt);
}
}
static void emit_writeword_imm(int imm, int addr)
{
assem_debug("movl $%x,%x",imm,addr);
output_byte(0xC7);
output_modrm(0,5,0);
output_w32(addr);
output_w32(imm);
}
static void emit_writeword_imm_esp(int imm, int addr)
{
assem_debug("mov $%x,%x(%%esp)",imm,addr);
assert(addr>=-128&&addr<128);
output_byte(0xC7);
output_modrm(1,4,0);
output_sib(0,4,4);
output_byte(addr);
output_w32(imm);
}
static void emit_writebyte_imm(int imm, int addr)
{
assem_debug("movb $%x,%x",imm,addr);
assert(imm>=-128&&imm<128);
output_byte(0xC6);
output_modrm(0,5,0);
output_w32(addr);
output_byte(imm);
}
static void emit_mul(int rs)
{
assem_debug("mul %%%s",regname[rs]);
output_byte(0xF7);
output_modrm(3,rs,4);
}
static void emit_imul(int rs)
{
assem_debug("imul %%%s",regname[rs]);
output_byte(0xF7);
output_modrm(3,rs,5);
}
static void emit_div(int rs)
{
assem_debug("div %%%s",regname[rs]);
output_byte(0xF7);
output_modrm(3,rs,6);
}
static void emit_idiv(int rs)
{
assem_debug("idiv %%%s",regname[rs]);
output_byte(0xF7);
output_modrm(3,rs,7);
}
static void emit_cdq()
{
assem_debug("cdq");
output_byte(0x99);
}
static void emit_mov2imm_compact(int imm1,u_int rt1,int imm2,u_int rt2)
{
emit_movimm(imm1,rt1);
if(imm2-imm1<128&&imm2-imm1>=-128) emit_addimm(rt1,imm2-imm1,rt2);
else emit_movimm(imm2,rt2);
}
static void emit_cmpmem_imm_byte(int addr,int imm)
{
assert(imm<128&&imm>=-127);
assem_debug("cmpb $%d,%x",imm,addr);
output_byte(0x80);
output_modrm(0,5,7);
output_w32(addr);
output_byte(imm);
}
static void emit_cmpmem_indexedsr12_imm(int addr,int r,int imm)
{
assert(imm<128&&imm>=-127);
assert(r>=0&&r<8);
emit_shrimm(r,12,r);
assem_debug("cmp $%d,%x+%%%s",imm,addr,regname[r]);
output_byte(0x80);
output_modrm(2,r,7);
output_w32(addr);
output_byte(imm);
}
static void emit_cmpmem_indexed(int addr,int rs,int rt)
{
assert(rs>=0&&rs<8);
assert(rt>=0&&rt<8);
assem_debug("cmp %x+%%%s,%%%s",addr,regname[rs],regname[rt]);
output_byte(0x39);
output_modrm(2,rs,rt);
output_w32(addr);
}
#ifdef IMM_PREFETCH
static void emit_prefetch(void *addr)
{
assem_debug("prefetch %x",(int)addr);
output_byte(0x0F);
output_byte(0x18);
output_modrm(0,5,1);
output_w32((int)addr);
}
#endif
static void emit_flds(int r)
{
assem_debug("flds (%%%s)",regname[r]);
output_byte(0xd9);
if(r!=EBP) output_modrm(0,r,0);
else {output_modrm(1,EBP,0);output_byte(0);}
}
static void emit_fldl(int r)
{
assem_debug("fldl (%%%s)",regname[r]);
output_byte(0xdd);
if(r!=EBP) output_modrm(0,r,0);
else {output_modrm(1,EBP,0);output_byte(0);}
}
static void emit_fucomip(u_int r)
{
assem_debug("fucomip %d",r);
assert(r<8);
output_byte(0xdf);
output_byte(0xe8+r);
}
static void emit_fchs()
{
assem_debug("fchs");
output_byte(0xd9);
output_byte(0xe0);
}
static void emit_fabs()
{
assem_debug("fabs");
output_byte(0xd9);
output_byte(0xe1);
}
static void emit_fsqrt()
{
assem_debug("fsqrt");
output_byte(0xd9);
output_byte(0xfa);
}
static void emit_fadds(int r)
{
assem_debug("fadds (%%%s)",regname[r]);
output_byte(0xd8);
if(r!=EBP) output_modrm(0,r,0);
else {output_modrm(1,EBP,0);output_byte(0);}
}
static void emit_faddl(int r)
{
assem_debug("faddl (%%%s)",regname[r]);
output_byte(0xdc);
if(r!=EBP) output_modrm(0,r,0);
else {output_modrm(1,EBP,0);output_byte(0);}
}
static void emit_fadd(int r)
{
assem_debug("fadd st%d",r);
output_byte(0xd8);
output_byte(0xc0+r);
}
static void emit_fsubs(int r)
{
assem_debug("fsubs (%%%s)",regname[r]);
output_byte(0xd8);
if(r!=EBP) output_modrm(0,r,4);
else {output_modrm(1,EBP,4);output_byte(0);}
}
static void emit_fsubl(int r)
{
assem_debug("fsubl (%%%s)",regname[r]);
output_byte(0xdc);
if(r!=EBP) output_modrm(0,r,4);
else {output_modrm(1,EBP,4);output_byte(0);}
}
static void emit_fsub(int r)
{
assem_debug("fsub st%d",r);
output_byte(0xd8);
output_byte(0xe0+r);
}
static void emit_fmuls(int r)
{
assem_debug("fmuls (%%%s)",regname[r]);
output_byte(0xd8);
if(r!=EBP) output_modrm(0,r,1);
else {output_modrm(1,EBP,1);output_byte(0);}
}
static void emit_fmull(int r)
{
assem_debug("fmull (%%%s)",regname[r]);
output_byte(0xdc);
if(r!=EBP) output_modrm(0,r,1);
else {output_modrm(1,EBP,1);output_byte(0);}
}
static void emit_fmul(int r)
{
assem_debug("fmul st%d",r);
output_byte(0xd8);
output_byte(0xc8+r);
}
static void emit_fdivs(int r)
{
assem_debug("fdivs (%%%s)",regname[r]);
output_byte(0xd8);
if(r!=EBP) output_modrm(0,r,6);
else {output_modrm(1,EBP,6);output_byte(0);}
}
static void emit_fdivl(int r)
{
assem_debug("fdivl (%%%s)",regname[r]);
output_byte(0xdc);
if(r!=EBP) output_modrm(0,r,6);
else {output_modrm(1,EBP,6);output_byte(0);}
}
static void emit_fdiv(int r)
{
assem_debug("fdiv st%d",r);
output_byte(0xd8);
output_byte(0xf0+r);
}
static void emit_fpop()
{
assem_debug("fpop");
output_byte(0xdd);
output_byte(0xd8);
}
static void emit_fildl(int r)
{
assem_debug("fildl (%%%s)",regname[r]);
output_byte(0xdb);
if(r!=EBP) output_modrm(0,r,0);
else {output_modrm(1,EBP,0);output_byte(0);}
}
static void emit_fildll(int r)
{
assem_debug("fildll (%%%s)",regname[r]);
output_byte(0xdf);
if(r!=EBP) output_modrm(0,r,5);
else {output_modrm(1,EBP,5);output_byte(0);}
}
static void emit_fistpl(int r)
{
assem_debug("fistpl (%%%s)",regname[r]);
output_byte(0xdb);
if(r!=EBP) output_modrm(0,r,3);
else {output_modrm(1,EBP,3);output_byte(0);}
}
static void emit_fistpll(int r)
{
assem_debug("fistpll (%%%s)",regname[r]);
output_byte(0xdf);
if(r!=EBP) output_modrm(0,r,7);
else {output_modrm(1,EBP,7);output_byte(0);}
}
static void emit_fstps(int r)
{
assem_debug("fstps (%%%s)",regname[r]);
output_byte(0xd9);
if(r!=EBP) output_modrm(0,r,3);
else {output_modrm(1,EBP,3);output_byte(0);}
}
static void emit_fstpl(int r)
{
assem_debug("fstpl (%%%s)",regname[r]);
output_byte(0xdd);
if(r!=EBP) output_modrm(0,r,3);
else {output_modrm(1,EBP,3);output_byte(0);}
}
static void emit_fnstcw_stack()
{
assem_debug("fnstcw (%%esp)");
output_byte(0xd9);
output_modrm(0,4,7);
output_sib(0,4,4);
}
static void emit_fldcw_stack()
{
assem_debug("fldcw (%%esp)");
output_byte(0xd9);
output_modrm(0,4,5);
output_sib(0,4,4);
}
static void emit_fldcw_indexed(int addr,int r)
{
assem_debug("fldcw %x(%%%s)",addr,regname[r]);
output_byte(0xd9);
output_modrm(0,4,5);
output_sib(1,r,5);
output_w32(addr);
}
static void emit_fldcw(int addr)
{
assem_debug("fldcw %x",addr);
output_byte(0xd9);
output_modrm(0,5,5);
output_w32(addr);
}
#ifdef __SSE__
static void emit_movss_load(u_int addr,u_int ssereg)
{
assem_debug("movss (%%%s),xmm%d",regname[addr],ssereg);
assert(ssereg<8);
output_byte(0xf3);
output_byte(0x0f);
output_byte(0x10);
if(addr!=EBP) output_modrm(0,addr,ssereg);
else {output_modrm(1,EBP,ssereg);output_byte(0);}
}
static void emit_movsd_load(u_int addr,u_int ssereg)
{
assem_debug("movsd (%%%s),xmm%d",regname[addr],ssereg);
assert(ssereg<8);
output_byte(0xf2);
output_byte(0x0f);
output_byte(0x10);
if(addr!=EBP) output_modrm(0,addr,ssereg);
else {output_modrm(1,EBP,ssereg);output_byte(0);}
}
static void emit_movd_store(u_int ssereg,u_int addr)
{
assem_debug("movd xmm%d,(%%%s)",ssereg,regname[addr]);
assert(ssereg<8);
output_byte(0x66);
output_byte(0x0f);
output_byte(0x7e);
if(addr!=EBP) output_modrm(0,addr,ssereg);
else {output_modrm(1,EBP,ssereg);output_byte(0);}
}
static void emit_cvttps2dq(u_int ssereg1,u_int ssereg2)
{
assem_debug("cvttps2dq xmm%d,xmm%d",ssereg1,ssereg2);
assert(ssereg1<8);
assert(ssereg2<8);
output_byte(0xf3);
output_byte(0x0f);
output_byte(0x5b);
output_modrm(3,ssereg1,ssereg2);
}
static void emit_cvttpd2dq(u_int ssereg1,u_int ssereg2)
{
assem_debug("cvttpd2dq xmm%d,xmm%d",ssereg1,ssereg2);
assert(ssereg1<8);
assert(ssereg2<8);
output_byte(0x66);
output_byte(0x0f);
output_byte(0xe6);
output_modrm(3,ssereg1,ssereg2);
}
#endif
static void emit_extjump2(int addr, int target, int linker)
{
u_char *ptr=(u_char *)addr;
if(*ptr==0x0f)
{
assert(ptr[1]>=0x80&&ptr[1]<=0x8f);
addr+=2;
}
else
{
assert(*ptr==0xe8||*ptr==0xe9);
addr++;
}
emit_movimm(target,EAX);
emit_movimm(addr,EBX);
#ifdef DEBUG_CYCLE_COUNT
emit_readword((int)&last_count,ECX);
emit_add(HOST_CCREG,ECX,HOST_CCREG);
emit_readword((int)&next_interupt,ECX);
emit_writeword(HOST_CCREG,(int)&g_cp0_regs[CP0_COUNT_REG]);
emit_sub(HOST_CCREG,ECX,HOST_CCREG);
emit_writeword(ECX,(int)&last_count);
#endif
emit_jmp(linker);
}
static void emit_extjump(int addr, int target)
{
emit_extjump2(addr, target, (int)dyna_linker);
}
static void emit_extjump_ds(int addr, int target)
{
emit_extjump2(addr, target, (int)dyna_linker_ds);
}
static void do_readstub(int n)
{
assem_debug("do_readstub %x",start+stubs[n][3]*4);
set_jump_target(stubs[n][1],(int)out);
int type=stubs[n][0];
int i=stubs[n][3];
int rs=stubs[n][4];
struct regstat *i_regs=(struct regstat *)stubs[n][5];
signed char *i_regmap=i_regs->regmap;
int addr=get_reg(i_regmap,AGEN1+(i&1));
int rth,rt;
int ds;
if(itype[i]==C1LS||itype[i]==LOADLR) {
rth=get_reg(i_regmap,FTEMP|64);
rt=get_reg(i_regmap,FTEMP);
}else{
rth=get_reg(i_regmap,rt1[i]|64);
rt=get_reg(i_regmap,rt1[i]);
}
assert(rs>=0);
if(addr<0) addr=rt;
if(addr<0&&itype[i]!=C1LS&&itype[i]!=LOADLR) addr=get_reg(i_regmap,-1);
assert(addr>=0);
int ftable=0;
if(type==LOADB_STUB||type==LOADBU_STUB)
ftable=(int)readmemb;
if(type==LOADH_STUB||type==LOADHU_STUB)
ftable=(int)readmemh;
if(type==LOADW_STUB)
ftable=(int)readmem;
if(type==LOADD_STUB)
ftable=(int)readmemd;
emit_writeword(rs,(int)&address);
emit_shrimm(rs,16,addr);
emit_movmem_indexedx4(ftable,addr,addr);
emit_pusha();
ds=i_regs!=®s[i];
int real_rs=(itype[i]==LOADLR)?-1:get_reg(i_regmap,rs1[i]);
if(!ds) load_all_consts(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty&~(1<<addr)&(real_rs<0?-1:~(1<<real_rs)),i);
wb_dirtys(i_regs->regmap_entry,i_regs->was32,i_regs->wasdirty&~(1<<addr)&(real_rs<0?-1:~(1<<real_rs)));
int temp;
int cc=get_reg(i_regmap,CCREG);
if(cc<0) {
if(addr==HOST_CCREG)
{
cc=0;temp=1;
assert(cc!=HOST_CCREG);
assert(temp!=HOST_CCREG);
emit_loadreg(CCREG,cc);
}
else
{
cc=HOST_CCREG;
emit_loadreg(CCREG,cc);
temp=!addr;
}
}
else
{
temp=!addr;
}
emit_readword((int)&last_count,temp);
emit_addimm(cc,CLOCK_DIVIDER*(stubs[n][6]+1),cc);
emit_writeword_imm_esp(start+i*4+(((regs[i].was32>>rs1[i])&1)<<1)+ds,32);
emit_add(cc,temp,cc);
emit_writeword(cc,(int)&g_cp0_regs[CP0_COUNT_REG]);
emit_callreg(addr);
emit_readword((int)&g_cp0_regs[CP0_COUNT_REG],HOST_CCREG);
emit_readword((int)&next_interupt,ECX);
emit_addimm(HOST_CCREG,-(int)CLOCK_DIVIDER*(stubs[n][6]+1),HOST_CCREG);
emit_sub(HOST_CCREG,ECX,HOST_CCREG);
emit_writeword(ECX,(int)&last_count);
emit_storereg(CCREG,HOST_CCREG);
emit_popa();
if((cc=get_reg(i_regmap,CCREG))>=0) {
emit_loadreg(CCREG,cc);
}
if(rt>=0) {
if(type==LOADB_STUB)
emit_movsbl((int)&readmem_dword,rt);
if(type==LOADBU_STUB)
emit_movzbl((int)&readmem_dword,rt);
if(type==LOADH_STUB)
emit_movswl((int)&readmem_dword,rt);
if(type==LOADHU_STUB)
emit_movzwl((int)&readmem_dword,rt);
if(type==LOADW_STUB)
emit_readword((int)&readmem_dword,rt);
if(type==LOADD_STUB) {
emit_readword((int)&readmem_dword,rt);
if(rth>=0) emit_readword(((int)&readmem_dword)+4,rth);
}
}
emit_jmp(stubs[n][2]); }
static void inline_readstub(int type, int i, u_int addr, signed char regmap[], int target, int adj, u_int reglist)
{
assem_debug("inline_readstub");
int rs=get_reg(regmap,target);
int rth=get_reg(regmap,target|64);
int rt=get_reg(regmap,target);
if(rs<0) rs=get_reg(regmap,-1);
assert(rs>=0);
int ftable=0;
if(type==LOADB_STUB||type==LOADBU_STUB)
ftable=(int)readmemb;
if(type==LOADH_STUB||type==LOADHU_STUB)
ftable=(int)readmemh;
if(type==LOADW_STUB)
ftable=(int)readmem;
if(type==LOADD_STUB)
ftable=(int)readmemd;
#ifdef HOST_IMM_ADDR32
emit_writeword_imm(addr,(int)&address);
#else
emit_writeword(rs,(int)&address);
#endif
emit_pusha();
if((signed int)addr>=(signed int)0xC0000000) {
int ds=regmap!=regs[i].regmap;
if(!ds) load_all_consts(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty,i);
if(!ds) wb_dirtys(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty);
else wb_dirtys(branch_regs[i-1].regmap_entry,branch_regs[i-1].was32,branch_regs[i-1].wasdirty);
}
int cc=get_reg(regmap,CCREG);
int temp;
if(cc<0) {
if(rs==HOST_CCREG)
{
cc=0;temp=1;
assert(cc!=HOST_CCREG);
assert(temp!=HOST_CCREG);
emit_loadreg(CCREG,cc);
}
else
{
cc=HOST_CCREG;
emit_loadreg(CCREG,cc);
temp=!rs;
}
}
else
{
temp=!rs;
}
emit_readword((int)&last_count,temp);
emit_addimm(cc,CLOCK_DIVIDER*(adj+1),cc);
emit_add(cc,temp,cc);
emit_writeword(cc,(int)&g_cp0_regs[CP0_COUNT_REG]);
if((signed int)addr>=(signed int)0xC0000000) {
int ds=regmap!=regs[i].regmap;
emit_writeword_imm_esp(start+i*4+(((regs[i].was32>>rs1[i])&1)<<1)+ds,32);
}
emit_call(((u_int *)ftable)[addr>>16]);
emit_readword((int)&g_cp0_regs[CP0_COUNT_REG],HOST_CCREG);
emit_readword((int)&next_interupt,ECX);
emit_addimm(HOST_CCREG,-(int)CLOCK_DIVIDER*(adj+1),HOST_CCREG);
emit_sub(HOST_CCREG,ECX,HOST_CCREG);
emit_writeword(ECX,(int)&last_count);
emit_storereg(CCREG,HOST_CCREG);
emit_popa();
if((cc=get_reg(regmap,CCREG))>=0) {
emit_loadreg(CCREG,cc);
}
if(rt>=0) {
if(type==LOADB_STUB)
emit_movsbl((int)&readmem_dword,rt);
if(type==LOADBU_STUB)
emit_movzbl((int)&readmem_dword,rt);
if(type==LOADH_STUB)
emit_movswl((int)&readmem_dword,rt);
if(type==LOADHU_STUB)
emit_movzwl((int)&readmem_dword,rt);
if(type==LOADW_STUB)
emit_readword((int)&readmem_dword,rt);
if(type==LOADD_STUB) {
emit_readword((int)&readmem_dword,rt);
if(rth>=0) emit_readword(((int)&readmem_dword)+4,rth);
}
}
}
static void do_writestub(int n)
{
assem_debug("do_writestub %x",start+stubs[n][3]*4);
set_jump_target(stubs[n][1],(int)out);
int type=stubs[n][0];
int i=stubs[n][3];
int rs=stubs[n][4];
struct regstat *i_regs=(struct regstat *)stubs[n][5];
signed char *i_regmap=i_regs->regmap;
int addr=get_reg(i_regmap,AGEN1+(i&1));
int rth,rt,r;
int ds;
if(itype[i]==C1LS) {
rth=get_reg(i_regmap,FTEMP|64);
rt=get_reg(i_regmap,r=FTEMP);
}else{
rth=get_reg(i_regmap,rs2[i]|64);
rt=get_reg(i_regmap,r=rs2[i]);
}
assert(rs>=0);
assert(rt>=0);
if(addr<0) addr=get_reg(i_regmap,-1);
assert(addr>=0);
int ftable=0;
if(type==STOREB_STUB)
ftable=(int)writememb;
if(type==STOREH_STUB)
ftable=(int)writememh;
if(type==STOREW_STUB)
ftable=(int)writemem;
if(type==STORED_STUB)
ftable=(int)writememd;
emit_writeword(rs,(int)&address);
emit_shrimm(rs,16,addr);
emit_movmem_indexedx4(ftable,addr,addr);
if(type==STOREB_STUB)
emit_writebyte(rt,(int)&cpu_byte);
if(type==STOREH_STUB)
emit_writehword(rt,(int)&cpu_hword);
if(type==STOREW_STUB)
emit_writeword(rt,(int)&cpu_word);
if(type==STORED_STUB) {
emit_writeword(rt,(int)&cpu_dword);
emit_writeword(r?rth:rt,(int)&cpu_dword+4);
}
emit_pusha();
ds=i_regs!=®s[i];
int real_rs=get_reg(i_regmap,rs1[i]);
if(!ds) load_all_consts(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty&~(1<<addr)&(real_rs<0?-1:~(1<<real_rs)),i);
wb_dirtys(i_regs->regmap_entry,i_regs->was32,i_regs->wasdirty&~(1<<addr)&(real_rs<0?-1:~(1<<real_rs)));
int temp;
int cc=get_reg(i_regmap,CCREG);
if(cc<0) {
if(addr==HOST_CCREG)
{
cc=0;temp=1;
assert(cc!=HOST_CCREG);
assert(temp!=HOST_CCREG);
emit_loadreg(CCREG,cc);
}
else
{
cc=HOST_CCREG;
emit_loadreg(CCREG,cc);
temp=!addr;
}
}
else
{
temp=!addr;
}
emit_readword((int)&last_count,temp);
emit_addimm(cc,CLOCK_DIVIDER*(stubs[n][6]+1),cc);
emit_writeword_imm_esp(start+i*4+(((regs[i].was32>>rs1[i])&1)<<1)+ds,32);
emit_add(cc,temp,cc);
emit_writeword(cc,(int)&g_cp0_regs[CP0_COUNT_REG]);
emit_callreg(addr);
emit_readword((int)&g_cp0_regs[CP0_COUNT_REG],HOST_CCREG);
emit_readword((int)&next_interupt,ECX);
emit_addimm(HOST_CCREG,-(int)CLOCK_DIVIDER*(stubs[n][6]+1),HOST_CCREG);
emit_sub(HOST_CCREG,ECX,HOST_CCREG);
emit_writeword(ECX,(int)&last_count);
emit_storereg(CCREG,HOST_CCREG);
emit_popa();
if((cc=get_reg(i_regmap,CCREG))>=0) {
emit_loadreg(CCREG,cc);
}
emit_jmp(stubs[n][2]); }
static void inline_writestub(int type, int i, u_int addr, signed char regmap[], int target, int adj, u_int reglist)
{
assem_debug("inline_writestub");
int rs=get_reg(regmap,-1);
int rth=get_reg(regmap,target|64);
int rt=get_reg(regmap,target);
assert(rs>=0);
assert(rt>=0);
int ftable=0;
if(type==STOREB_STUB)
ftable=(int)writememb;
if(type==STOREH_STUB)
ftable=(int)writememh;
if(type==STOREW_STUB)
ftable=(int)writemem;
if(type==STORED_STUB)
ftable=(int)writememd;
emit_writeword(rs,(int)&address);
if(type==STOREB_STUB)
emit_writebyte(rt,(int)&cpu_byte);
if(type==STOREH_STUB)
emit_writehword(rt,(int)&cpu_hword);
if(type==STOREW_STUB)
emit_writeword(rt,(int)&cpu_word);
if(type==STORED_STUB) {
emit_writeword(rt,(int)&cpu_dword);
emit_writeword(target?rth:rt,(int)&cpu_dword+4);
}
emit_pusha();
if((signed int)addr>=(signed int)0xC0000000) {
int ds=regmap!=regs[i].regmap;
if(!ds) load_all_consts(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty,i);
if(!ds) wb_dirtys(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty);
else wb_dirtys(branch_regs[i-1].regmap_entry,branch_regs[i-1].was32,branch_regs[i-1].wasdirty);
}
int cc=get_reg(regmap,CCREG);
int temp;
if(cc<0) {
if(rs==HOST_CCREG)
{
cc=0;temp=1;
assert(cc!=HOST_CCREG);
assert(temp!=HOST_CCREG);
emit_loadreg(CCREG,cc);
}
else
{
cc=HOST_CCREG;
emit_loadreg(CCREG,cc);
temp=!rs;
}
}
else
{
temp=!rs;
}
emit_readword((int)&last_count,temp);
emit_addimm(cc,CLOCK_DIVIDER*(adj+1),cc);
emit_add(cc,temp,cc);
emit_writeword(cc,(int)&g_cp0_regs[CP0_COUNT_REG]);
if((signed int)addr>=(signed int)0xC0000000) {
int ds=regmap!=regs[i].regmap;
emit_writeword_imm_esp(start+i*4+(((regs[i].was32>>rs1[i])&1)<<1)+ds,32);
}
emit_call(((u_int *)ftable)[addr>>16]);
emit_readword((int)&g_cp0_regs[CP0_COUNT_REG],HOST_CCREG);
emit_readword((int)&next_interupt,ECX);
emit_addimm(HOST_CCREG,-(int)CLOCK_DIVIDER*(adj+1),HOST_CCREG);
emit_sub(HOST_CCREG,ECX,HOST_CCREG);
emit_writeword(ECX,(int)&last_count);
emit_storereg(CCREG,HOST_CCREG);
emit_popa();
if((cc=get_reg(regmap,CCREG))>=0) {
emit_loadreg(CCREG,cc);
}
}
static void do_unalignedwritestub(int n)
{
set_jump_target(stubs[n][1],(int)out);
output_byte(0xCC);
emit_jmp(stubs[n][2]); }
static void do_invstub(int n)
{
set_jump_target(stubs[n][1],(int)out);
emit_call(invalidate_block_reg[stubs[n][4]]);
emit_jmp(stubs[n][2]); }
static int do_dirty_stub(int i)
{
assem_debug("do_dirty_stub %x",start+i*4);
emit_pushimm(start+i*4);
emit_movimm((int)start<(int)0xC0000000?(int)source:(int)start,EAX);
emit_movimm((int)copy,EBX);
emit_movimm(slen*4,ECX);
emit_call((int)start<(int)0xC0000000?(int)&verify_code:(int)&verify_code_vm);
emit_addimm(ESP,4,ESP);
int entry=(int)out;
load_regs_entry(i);
if(entry==(int)out) entry=instr_addr[i];
emit_jmp(instr_addr[i]);
return entry;
}
static void do_dirty_stub_ds()
{
emit_pushimm(start+1);
emit_movimm((int)start<(int)0xC0000000?(int)source:(int)start,EAX);
emit_movimm((int)copy,EBX);
emit_movimm(slen*4,ECX);
emit_call((int)&verify_code_ds);
emit_addimm(ESP,4,ESP);
}
static void do_cop1stub(int n)
{
assem_debug("do_cop1stub %x",start+stubs[n][3]*4);
set_jump_target(stubs[n][1],(int)out);
int i=stubs[n][3];
struct regstat *i_regs=(struct regstat *)stubs[n][5];
int ds=stubs[n][6];
if(!ds) {
load_all_consts(regs[i].regmap_entry,regs[i].was32,regs[i].wasdirty,i);
}
wb_dirtys(i_regs->regmap_entry,i_regs->was32,i_regs->wasdirty);
if(regs[i].regmap_entry[HOST_CCREG]!=CCREG) emit_loadreg(CCREG,HOST_CCREG);
emit_movimm(start+(i-ds)*4,EAX); emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG); emit_jmp(ds?(int)fp_exception_ds:(int)fp_exception);
}
static int do_tlb_r(int s,int ar,int map,int cache,int x,int a,int shift,int c,u_int addr)
{
if(c) {
if((signed int)addr>=(signed int)0xC0000000) {
emit_readword((int)(memory_map+(addr>>12)),map);
}
else
return -1; }
else {
if(s!=map) emit_mov(s,map);
emit_shrimm(map,12,map);
if(shift>=0) emit_lea8(s,shift);
if(~a) emit_andimm(s,a,ar);
emit_movmem_indexedx4((int)memory_map,map,map);
}
return map;
}
static int do_tlb_r_branch(int map, int c, u_int addr, int *jaddr)
{
if(!c||(signed int)addr>=(signed int)0xC0000000) {
emit_test(map,map);
*jaddr=(int)out;
emit_js(0);
}
return map;
}
static void gen_tlb_addr_r(int ar, int map) {
if(map>=0) {
emit_leairrx4(0,ar,map,ar);
}
}
static int do_tlb_w(int s,int ar,int map,int cache,int x,int c,u_int addr)
{
if(c) {
if(addr<0x80800000||addr>=0xC0000000) {
emit_readword((int)(memory_map+(addr>>12)),map);
}
else
return -1; }
else {
if(s!=map) emit_mov(s,map);
emit_shrimm(map,12,map);
emit_movmem_indexedx4((int)memory_map,map,map);
}
emit_shlimm(map,2,map);
return map;
}
static void do_tlb_w_branch(int map, int c, u_int addr, int *jaddr)
{
if(!c||addr<0x80800000||addr>=0xC0000000) {
*jaddr=(int)out;
emit_jc(0);
}
}
static void gen_tlb_addr_w(int ar, int map) {
if(map>=0) {
emit_leairrx1(0,ar,map,ar);
}
}
static void generate_map_const(u_int addr,int reg) {
}
static void shift_assemble_x86(int i,struct regstat *i_regs)
{
if(rt1[i]) {
if(opcode2[i]<=0x07) {
char s,t,shift;
t=get_reg(i_regs->regmap,rt1[i]);
s=get_reg(i_regs->regmap,rs1[i]);
shift=get_reg(i_regs->regmap,rs2[i]);
if(t>=0){
if(rs1[i]==0)
{
emit_zeroreg(t);
}
else if(rs2[i]==0)
{
assert(s>=0);
if(s!=t) emit_mov(s,t);
}
else
{
char temp=get_reg(i_regs->regmap,-1);
assert(s>=0);
if(t==ECX&&s!=ECX) {
if(shift!=ECX) emit_mov(shift,ECX);
if(rt1[i]==rs2[i]) {shift=temp;}
if(s!=shift) emit_mov(s,shift);
}
else
{
if(rt1[i]==rs2[i]) {emit_mov(shift,temp);shift=temp;}
if(s!=t) emit_mov(s,t);
if(shift!=ECX) {
if(i_regs->regmap[ECX]<0)
emit_mov(shift,ECX);
else
emit_xchg(shift,ECX);
}
}
if(opcode2[i]==4) {
emit_shlcl(t==ECX?shift:t);
}
if(opcode2[i]==6) {
emit_shrcl(t==ECX?shift:t);
}
if(opcode2[i]==7) {
emit_sarcl(t==ECX?shift:t);
}
if(shift!=ECX&&i_regs->regmap[ECX]>=0) emit_xchg(shift,ECX);
}
}
} else { char sh,sl,th,tl,shift;
th=get_reg(i_regs->regmap,rt1[i]|64);
tl=get_reg(i_regs->regmap,rt1[i]);
sh=get_reg(i_regs->regmap,rs1[i]|64);
sl=get_reg(i_regs->regmap,rs1[i]);
shift=get_reg(i_regs->regmap,rs2[i]);
if(tl>=0){
if(rs1[i]==0)
{
emit_zeroreg(tl);
if(th>=0) emit_zeroreg(th);
}
else if(rs2[i]==0)
{
assert(sl>=0);
if(sl!=tl) emit_mov(sl,tl);
if(th>=0&&sh!=th) emit_mov(sh,th);
}
else
{
assert(shift!=tl);
int temp=get_reg(i_regs->regmap,-1);
int real_th=th;
if(th<0&&opcode2[i]!=0x14) {th=temp;} assert(sl>=0);
assert(sh>=0);
if(tl==ECX&&sl!=ECX) {
if(shift!=ECX) emit_mov(shift,ECX);
if(sl!=shift) emit_mov(sl,shift);
if(th>=0 && sh!=th) emit_mov(sh,th);
}
else if(th==ECX&&sh!=ECX) {
if(shift!=ECX) emit_mov(shift,ECX);
if(sh!=shift) emit_mov(sh,shift);
if(sl!=tl) emit_mov(sl,tl);
}
else
{
if(sl!=tl) emit_mov(sl,tl);
if(th>=0 && sh!=th) emit_mov(sh,th);
if(shift!=ECX) {
if(i_regs->regmap[ECX]<0)
emit_mov(shift,ECX);
else
emit_xchg(shift,ECX);
}
}
if(opcode2[i]==0x14) {
if(th>=0) emit_shldcl(th==ECX?shift:th,tl==ECX?shift:tl);
emit_shlcl(tl==ECX?shift:tl);
emit_testimm(ECX,32);
if(th>=0) emit_cmovne_reg(tl==ECX?shift:tl,th==ECX?shift:th);
emit_cmovne(&const_zero,tl==ECX?shift:tl);
}
if(opcode2[i]==0x16) {
assert(th>=0);
emit_shrdcl(tl==ECX?shift:tl,th==ECX?shift:th);
emit_shrcl(th==ECX?shift:th);
emit_testimm(ECX,32);
emit_cmovne_reg(th==ECX?shift:th,tl==ECX?shift:tl);
if(real_th>=0) emit_cmovne(&const_zero,th==ECX?shift:th);
}
if(opcode2[i]==0x17) {
assert(th>=0);
emit_shrdcl(tl==ECX?shift:tl,th==ECX?shift:th);
if(real_th>=0) {
assert(temp>=0);
emit_mov(th==ECX?shift:th,temp==ECX?shift:temp);
}
emit_sarcl(th==ECX?shift:th);
if(real_th>=0) emit_sarimm(temp==ECX?shift:temp,31,temp==ECX?shift:temp);
emit_testimm(ECX,32);
emit_cmovne_reg(th==ECX?shift:th,tl==ECX?shift:tl);
if(real_th>=0) emit_cmovne_reg(temp==ECX?shift:temp,th==ECX?shift:th);
}
if(shift!=ECX&&(i_regs->regmap[ECX]>=0||temp==ECX)) emit_xchg(shift,ECX);
}
}
}
}
}
#define shift_assemble shift_assemble_x86
static void loadlr_assemble_x86(int i,struct regstat *i_regs)
{
int s,th,tl,temp,temp2,addr,map=-1;
int offset;
int jaddr=0;
int memtarget,c=0;
u_int hr,reglist=0;
th=get_reg(i_regs->regmap,rt1[i]|64);
tl=get_reg(i_regs->regmap,rt1[i]);
s=get_reg(i_regs->regmap,rs1[i]);
temp=get_reg(i_regs->regmap,-1);
temp2=get_reg(i_regs->regmap,FTEMP);
addr=get_reg(i_regs->regmap,AGEN1+(i&1));
assert(addr<0);
offset=imm[i];
for(hr=0;hr<HOST_REGS;hr++) {
if(i_regs->regmap[hr]>=0) reglist|=1<<hr;
}
reglist|=1<<temp;
if(offset||s<0||c) addr=temp2;
else addr=s;
if(s>=0) {
c=(i_regs->wasconst>>s)&1;
memtarget=((signed int)(constmap[i][s]+offset))<(signed int)0x80800000;
if(using_tlb&&((signed int)(constmap[i][s]+offset))>=(signed int)0xC0000000) memtarget=1;
}
if(!using_tlb) {
if(!c) {
emit_lea8(addr,temp);
if (opcode[i]==0x22||opcode[i]==0x26) {
emit_andimm(addr,0xFFFFFFFC,temp2); }else{
emit_andimm(addr,0xFFFFFFF8,temp2); }
emit_cmpimm(addr,0x800000);
jaddr=(int)out;
emit_jno(0);
}
else {
if (opcode[i]==0x22||opcode[i]==0x26) {
emit_movimm(((constmap[i][s]+offset)<<3)&24,temp); }else{
emit_movimm(((constmap[i][s]+offset)<<3)&56,temp); }
}
}else{ int a;
if(c) {
a=-1;
}else if (opcode[i]==0x22||opcode[i]==0x26) {
a=0xFFFFFFFC; }else{
a=0xFFFFFFF8; }
map=get_reg(i_regs->regmap,TLREG);
assert(map>=0);
reglist&=~(1<<map);
map=do_tlb_r(addr,temp2,map,-1,0,a,c?-1:temp,c,constmap[i][s]+offset);
if(c) {
if (opcode[i]==0x22||opcode[i]==0x26) {
emit_movimm(((constmap[i][s]+offset)<<3)&24,temp); }else{
emit_movimm(((constmap[i][s]+offset)<<3)&56,temp); }
}
do_tlb_r_branch(map,c,constmap[i][s]+offset,&jaddr);
}
if (opcode[i]==0x22||opcode[i]==0x26) { if(!c||memtarget) {
emit_readword_indexed_tlb(0,temp2,map,temp2);
if(jaddr) add_stub(LOADW_STUB,jaddr,(int)out,i,temp2,(int)i_regs,ccadj[i],reglist);
}
else
inline_readstub(LOADW_STUB,i,(constmap[i][s]+offset)&0xFFFFFFFC,i_regs->regmap,FTEMP,ccadj[i],reglist);
if(rt1[i]) {
assert(tl>=0);
emit_andimm(temp,24,temp);
if (opcode[i]==0x26) emit_xorimm(temp,24,temp); if(temp==ECX)
{
int temp3=EDX;
if(temp3==temp2) temp3++;
emit_pushreg(temp3);
emit_movimm(-1,temp3);
if (opcode[i]==0x26) {
emit_shrcl(temp3);
emit_shrcl(temp2);
}else{
emit_shlcl(temp3);
emit_shlcl(temp2);
}
emit_mov(temp3,ECX);
emit_not(ECX,ECX);
emit_popreg(temp3);
}
else
{
int temp3=EBP;
if(temp3==temp) temp3++;
if(temp3==temp2) temp3++;
if(temp3==temp) temp3++;
emit_xchg(ECX,temp);
emit_pushreg(temp3);
emit_movimm(-1,temp3);
if (opcode[i]==0x26) {
emit_shrcl(temp3);
emit_shrcl(temp2==ECX?temp:temp2);
}else{
emit_shlcl(temp3);
emit_shlcl(temp2==ECX?temp:temp2);
}
emit_not(temp3,temp3);
emit_mov(temp,ECX);
emit_mov(temp3,temp);
emit_popreg(temp3);
}
emit_and(temp,tl,tl);
emit_or(temp2,tl,tl);
}
}
if (opcode[i]==0x1A||opcode[i]==0x1B) { if(s>=0)
if((i_regs->wasdirty>>s)&1)
emit_storereg(rs1[i],s);
if(get_reg(i_regs->regmap,rs1[i]|64)>=0)
if((i_regs->wasdirty>>get_reg(i_regs->regmap,rs1[i]|64))&1)
emit_storereg(rs1[i]|64,get_reg(i_regs->regmap,rs1[i]|64));
int temp2h=get_reg(i_regs->regmap,FTEMP|64);
if(!c||memtarget) {
emit_readdword_indexed_tlb(0,temp2,map,temp2h,temp2);
if(jaddr) add_stub(LOADD_STUB,jaddr,(int)out,i,temp2,(int)i_regs,ccadj[i],reglist);
}
else
inline_readstub(LOADD_STUB,i,(constmap[i][s]+offset)&0xFFFFFFF8,i_regs->regmap,FTEMP,ccadj[i],reglist);
if(rt1[i]) {
assert(th>=0);
assert(tl>=0);
emit_andimm(temp,56,temp);
emit_pushreg(temp);
emit_pushreg(temp2h);
emit_pushreg(temp2);
emit_pushreg(th);
emit_pushreg(tl);
if(opcode[i]==0x1A) emit_call((int)ldl_merge);
if(opcode[i]==0x1B) emit_call((int)ldr_merge);
emit_addimm(ESP,20,ESP);
if(tl!=EDX) {
if(tl!=EAX) emit_mov(EAX,tl);
if(th!=EDX) emit_mov(EDX,th);
} else
if(th!=EAX) {
if(th!=EDX) emit_mov(EDX,th);
if(tl!=EAX) emit_mov(EAX,tl);
} else {
emit_xchg(EAX,EDX);
}
if(s>=0) emit_loadreg(rs1[i],s);
if(get_reg(i_regs->regmap,rs1[i]|64)>=0)
emit_loadreg(rs1[i]|64,get_reg(i_regs->regmap,rs1[i]|64));
}
}
}
#define loadlr_assemble loadlr_assemble_x86
static void cop0_assemble(int i,struct regstat *i_regs)
{
if(opcode2[i]==0) {
if(rt1[i]) {
signed char t=get_reg(i_regs->regmap,rt1[i]);
char copr=(source[i]>>11)&0x1f;
if(t>=0) {
emit_writeword_imm((int)&fake_pc,(int)&PC);
emit_writebyte_imm((source[i]>>11)&0x1f,(int)&(fake_pc.f.r.nrd));
if(copr==9) {
emit_readword((int)&last_count,ECX);
emit_loadreg(CCREG,HOST_CCREG); emit_add(HOST_CCREG,ECX,HOST_CCREG);
emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
emit_writeword(HOST_CCREG,(int)&g_cp0_regs[CP0_COUNT_REG]);
}
emit_call((int)cached_interpreter_table.MFC0);
emit_readword((int)&readmem_dword,t);
}
}
}
else if(opcode2[i]==4) {
signed char s=get_reg(i_regs->regmap,rs1[i]);
char copr=(source[i]>>11)&0x1f;
assert(s>=0);
emit_writeword(s,(int)&readmem_dword);
emit_pusha();
emit_writeword_imm((int)&fake_pc,(int)&PC);
emit_writebyte_imm((source[i]>>11)&0x1f,(int)&(fake_pc.f.r.nrd));
if(copr==9||copr==11||copr==12) {
if(copr==12&&!is_delayslot) {
wb_register(rs1[i],i_regs->regmap,i_regs->dirty,i_regs->is32);
}
emit_readword((int)&last_count,ECX);
emit_loadreg(CCREG,HOST_CCREG); emit_add(HOST_CCREG,ECX,HOST_CCREG);
emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
emit_writeword(HOST_CCREG,(int)&g_cp0_regs[CP0_COUNT_REG]);
}
if(copr==12&&!is_delayslot) {
emit_writeword_imm(start+i*4+4,(int)&pcaddr);
emit_writebyte_imm(0,(int)&pending_exception);
}
emit_call((int)cached_interpreter_table.MTC0);
if(copr==9||copr==11||copr==12) {
emit_readword((int)&g_cp0_regs[CP0_COUNT_REG],HOST_CCREG);
emit_readword((int)&next_interupt,ECX);
emit_addimm(HOST_CCREG,-(int)CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
emit_sub(HOST_CCREG,ECX,HOST_CCREG);
emit_writeword(ECX,(int)&last_count);
emit_storereg(CCREG,HOST_CCREG);
}
emit_popa();
if(copr==12) {
assert(!is_delayslot);
emit_cmpmem_imm_byte((int)&pending_exception,0);
emit_jne((int)&do_interrupt);
}
cop1_usable=0;
}
else
{
assert(opcode2[i]==0x10);
if((source[i]&0x3f)==0x01) emit_call((int)cached_interpreter_table.TLBR);
if((source[i]&0x3f)==0x02) emit_call((int)TLBWI_new);
if((source[i]&0x3f)==0x06) { emit_readword((int)&last_count,ECX);
if(i_regs->regmap[HOST_CCREG]!=CCREG) emit_loadreg(CCREG,HOST_CCREG);
emit_add(HOST_CCREG,ECX,HOST_CCREG);
emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
emit_writeword(HOST_CCREG,(int)&g_cp0_regs[CP0_COUNT_REG]);
emit_call((int)TLBWR_new);
}
if((source[i]&0x3f)==0x08) emit_call((int)cached_interpreter_table.TLBP);
if((source[i]&0x3f)==0x18) {
int count=ccadj[i];
if(i_regs->regmap[HOST_CCREG]!=CCREG) emit_loadreg(CCREG,HOST_CCREG);
emit_addimm_and_set_flags(CLOCK_DIVIDER*count,HOST_CCREG); emit_jmp((int)jump_eret);
}
}
}
static void cop1_assemble(int i,struct regstat *i_regs)
{
if(!cop1_usable) {
signed char rs=get_reg(i_regs->regmap,CSREG);
assert(rs>=0);
emit_testimm(rs,0x20000000);
int jaddr=(int)out;
emit_jeq(0);
add_stub(FP_STUB,jaddr,(int)out,i,rs,(int)i_regs,is_delayslot,0);
cop1_usable=1;
}
if (opcode2[i]==0) { signed char tl=get_reg(i_regs->regmap,rt1[i]);
if(tl>=0) {
emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],tl);
emit_readword_indexed(0,tl,tl);
}
}
else if (opcode2[i]==1) { signed char tl=get_reg(i_regs->regmap,rt1[i]);
signed char th=get_reg(i_regs->regmap,rt1[i]|64);
if(tl>=0) {
emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],tl);
if(th>=0) emit_readword_indexed(4,tl,th);
emit_readword_indexed(0,tl,tl);
}
}
else if (opcode2[i]==4) { signed char sl=get_reg(i_regs->regmap,rs1[i]);
signed char temp=get_reg(i_regs->regmap,-1);
emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_writeword_indexed(sl,0,temp);
}
else if (opcode2[i]==5) { signed char sl=get_reg(i_regs->regmap,rs1[i]);
signed char sh=rs1[i]>0?get_reg(i_regs->regmap,rs1[i]|64):sl;
signed char temp=get_reg(i_regs->regmap,-1);
emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_writeword_indexed(sh,4,temp);
emit_writeword_indexed(sl,0,temp);
}
else if (opcode2[i]==2) {
signed char tl=get_reg(i_regs->regmap,rt1[i]);
if(tl>=0) {
u_int copr=(source[i]>>11)&0x1f;
if(copr==0) emit_readword((int)&FCR0,tl);
if(copr==31) emit_readword((int)&FCR31,tl);
}
}
else if (opcode2[i]==6) {
signed char sl=get_reg(i_regs->regmap,rs1[i]);
u_int copr=(source[i]>>11)&0x1f;
assert(sl>=0);
if(copr==31)
{
emit_writeword(sl,(int)&FCR31);
char temp=get_reg(i_regs->regmap,-1);
emit_movimm(3,temp);
emit_and(sl,temp,temp);
emit_fldcw_indexed((int)&rounding_modes,temp);
}
}
}
static void fconv_assemble_x86(int i,struct regstat *i_regs)
{
signed char temp=get_reg(i_regs->regmap,-1);
assert(temp>=0);
if(!cop1_usable) {
signed char rs=get_reg(i_regs->regmap,CSREG);
assert(rs>=0);
emit_testimm(rs,0x20000000);
int jaddr=(int)out;
emit_jeq(0);
add_stub(FP_STUB,jaddr,(int)out,i,rs,(int)i_regs,is_delayslot,0);
cop1_usable=1;
}
#ifdef __SSE__
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0d) { emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_movss_load(temp,0);
emit_cvttps2dq(0,0); if(((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f))
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_movd_store(0,temp);
return;
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0d) { emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_movsd_load(temp,0);
emit_cvttpd2dq(0,0); emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_movd_store(0,temp);
return;
}
#endif
if(opcode2[i]==0x14&&(source[i]&0x3f)==0x20) { emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_fildl(temp);
if(((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f))
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_fstps(temp);
return;
}
if(opcode2[i]==0x14&&(source[i]&0x3f)==0x21) { emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_fildl(temp);
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
emit_fstpl(temp);
return;
}
if(opcode2[i]==0x15&&(source[i]&0x3f)==0x20) { emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fildll(temp);
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_fstps(temp);
return;
}
if(opcode2[i]==0x15&&(source[i]&0x3f)==0x21) { emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fildll(temp);
if(((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f))
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
emit_fstpl(temp);
return;
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x21) { emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_flds(temp);
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
emit_fstpl(temp);
return;
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x20) { emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fldl(temp);
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_fstps(temp);
return;
}
if(opcode2[i]==0x10) { emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_flds(temp);
}
if(opcode2[i]==0x11) { emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fldl(temp);
}
if((source[i]&0x3f)<0x10) {
emit_fnstcw_stack();
if((source[i]&3)==0) emit_fldcw((int)&round_mode); if((source[i]&3)==1) emit_fldcw((int)&trunc_mode); if((source[i]&3)==2) emit_fldcw((int)&ceil_mode); if((source[i]&3)==3) emit_fldcw((int)&floor_mode); }
if((source[i]&0x3f)==0x24||(source[i]&0x3c)==0x0c) { if(opcode2[i]!=0x10||((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f))
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_fistpl(temp);
}
if((source[i]&0x3f)==0x25||(source[i]&0x3c)==0x08) { if(opcode2[i]!=0x11||((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f))
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
emit_fistpll(temp);
}
if((source[i]&0x3f)<0x10) {
emit_fldcw_stack();
}
return;
emit_pusha();
if(opcode2[i]==0x14&&(source[i]&0x3f)==0x20) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)cvt_s_w);
}
if(opcode2[i]==0x14&&(source[i]&0x3f)==0x21) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)cvt_d_w);
}
if(opcode2[i]==0x15&&(source[i]&0x3f)==0x20) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)cvt_s_l);
}
if(opcode2[i]==0x15&&(source[i]&0x3f)==0x21) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)cvt_d_l);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x21) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)cvt_d_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x24) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)cvt_w_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x25) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)cvt_l_s);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x20) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)cvt_s_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x24) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)cvt_w_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x25) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)cvt_l_d);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x08) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)round_l_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x09) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)trunc_l_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0a) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)ceil_l_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0b) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)floor_l_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0c) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)round_w_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0d) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)trunc_w_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0e) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)ceil_w_s);
}
if(opcode2[i]==0x10&&(source[i]&0x3f)==0x0f) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
emit_call((int)floor_w_s);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x08) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)round_l_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x09) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)trunc_l_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0a) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)ceil_l_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0b) {
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)floor_l_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0c) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)round_w_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0d) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)trunc_w_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0e) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)ceil_w_d);
}
if(opcode2[i]==0x11&&(source[i]&0x3f)==0x0f) {
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
emit_call((int)floor_w_d);
}
emit_addimm(ESP,8,ESP);
emit_popa();
return;
}
#define fconv_assemble fconv_assemble_x86
static void fcomp_assemble(int i,struct regstat *i_regs)
{
signed char fs=get_reg(i_regs->regmap,FSREG);
signed char temp=get_reg(i_regs->regmap,-1);
assert(temp>=0);
if(!cop1_usable) {
signed char cs=get_reg(i_regs->regmap,CSREG);
assert(cs>=0);
emit_testimm(cs,0x20000000);
int jaddr=(int)out;
emit_jeq(0);
add_stub(FP_STUB,jaddr,(int)out,i,cs,(int)i_regs,is_delayslot,0);
cop1_usable=1;
}
if((source[i]&0x3f)==0x30) {
emit_andimm(fs,~0x800000,fs);
return;
}
if((source[i]&0x3e)==0x38) {
emit_andimm(fs,~0x800000,fs);
return;
}
if(opcode2[i]==0x10) {
emit_readword((int)®_cop1_simple[(source[i]>>16)&0x1f],temp);
emit_flds(temp);
emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_flds(temp);
emit_movimm(0x800000,temp);
emit_or(fs,temp,fs);
emit_xor(temp,fs,temp);
emit_fucomip(1);
emit_fpop();
if((source[i]&0x3f)==0x31) emit_cmovnp_reg(temp,fs); if((source[i]&0x3f)==0x32) {emit_cmovne_reg(temp,fs);emit_cmovp_reg(temp,fs);} if((source[i]&0x3f)==0x33) emit_cmovne_reg(temp,fs); if((source[i]&0x3f)==0x34) {emit_cmovnc_reg(temp,fs);emit_cmovp_reg(temp,fs);} if((source[i]&0x3f)==0x35) emit_cmovnc_reg(temp,fs); if((source[i]&0x3f)==0x36) {emit_cmova_reg(temp,fs);emit_cmovp_reg(temp,fs);} if((source[i]&0x3f)==0x37) emit_cmova_reg(temp,fs); if((source[i]&0x3f)==0x3a) emit_cmovne_reg(temp,fs); if((source[i]&0x3f)==0x3b) emit_cmovne_reg(temp,fs); if((source[i]&0x3f)==0x3c) emit_cmovnc_reg(temp,fs); if((source[i]&0x3f)==0x3d) emit_cmovnc_reg(temp,fs); if((source[i]&0x3f)==0x3e) emit_cmova_reg(temp,fs); if((source[i]&0x3f)==0x3f) emit_cmova_reg(temp,fs); return;
}
if(opcode2[i]==0x11) {
emit_readword((int)®_cop1_double[(source[i]>>16)&0x1f],temp);
emit_fldl(temp);
emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fldl(temp);
emit_movimm(0x800000,temp);
emit_or(fs,temp,fs);
emit_xor(temp,fs,temp);
emit_fucomip(1);
emit_fpop();
if((source[i]&0x3f)==0x31) emit_cmovnp_reg(temp,fs); if((source[i]&0x3f)==0x32) {emit_cmovne_reg(temp,fs);emit_cmovp_reg(temp,fs);} if((source[i]&0x3f)==0x33) emit_cmovne_reg(temp,fs); if((source[i]&0x3f)==0x34) {emit_cmovnc_reg(temp,fs);emit_cmovp_reg(temp,fs);} if((source[i]&0x3f)==0x35) emit_cmovnc_reg(temp,fs); if((source[i]&0x3f)==0x36) {emit_cmova_reg(temp,fs);emit_cmovp_reg(temp,fs);} if((source[i]&0x3f)==0x37) emit_cmova_reg(temp,fs); if((source[i]&0x3f)==0x3a) emit_cmovne_reg(temp,fs); if((source[i]&0x3f)==0x3b) emit_cmovne_reg(temp,fs); if((source[i]&0x3f)==0x3c) emit_cmovnc_reg(temp,fs); if((source[i]&0x3f)==0x3d) emit_cmovnc_reg(temp,fs); if((source[i]&0x3f)==0x3e) emit_cmova_reg(temp,fs); if((source[i]&0x3f)==0x3f) emit_cmova_reg(temp,fs); return;
}
emit_pusha();
if(opcode2[i]==0x10) {
emit_pushmem((int)®_cop1_simple[(source[i]>>16)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
if((source[i]&0x3f)==0x30) emit_call((int)c_f_s);
if((source[i]&0x3f)==0x31) emit_call((int)c_un_s);
if((source[i]&0x3f)==0x32) emit_call((int)c_eq_s);
if((source[i]&0x3f)==0x33) emit_call((int)c_ueq_s);
if((source[i]&0x3f)==0x34) emit_call((int)c_olt_s);
if((source[i]&0x3f)==0x35) emit_call((int)c_ult_s);
if((source[i]&0x3f)==0x36) emit_call((int)c_ole_s);
if((source[i]&0x3f)==0x37) emit_call((int)c_ule_s);
if((source[i]&0x3f)==0x38) emit_call((int)c_sf_s);
if((source[i]&0x3f)==0x39) emit_call((int)c_ngle_s);
if((source[i]&0x3f)==0x3a) emit_call((int)c_seq_s);
if((source[i]&0x3f)==0x3b) emit_call((int)c_ngl_s);
if((source[i]&0x3f)==0x3c) emit_call((int)c_lt_s);
if((source[i]&0x3f)==0x3d) emit_call((int)c_nge_s);
if((source[i]&0x3f)==0x3e) emit_call((int)c_le_s);
if((source[i]&0x3f)==0x3f) emit_call((int)c_ngt_s);
}
if(opcode2[i]==0x11) {
emit_pushmem((int)®_cop1_double[(source[i]>>16)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
if((source[i]&0x3f)==0x30) emit_call((int)c_f_d);
if((source[i]&0x3f)==0x31) emit_call((int)c_un_d);
if((source[i]&0x3f)==0x32) emit_call((int)c_eq_d);
if((source[i]&0x3f)==0x33) emit_call((int)c_ueq_d);
if((source[i]&0x3f)==0x34) emit_call((int)c_olt_d);
if((source[i]&0x3f)==0x35) emit_call((int)c_ult_d);
if((source[i]&0x3f)==0x36) emit_call((int)c_ole_d);
if((source[i]&0x3f)==0x37) emit_call((int)c_ule_d);
if((source[i]&0x3f)==0x38) emit_call((int)c_sf_d);
if((source[i]&0x3f)==0x39) emit_call((int)c_ngle_d);
if((source[i]&0x3f)==0x3a) emit_call((int)c_seq_d);
if((source[i]&0x3f)==0x3b) emit_call((int)c_ngl_d);
if((source[i]&0x3f)==0x3c) emit_call((int)c_lt_d);
if((source[i]&0x3f)==0x3d) emit_call((int)c_nge_d);
if((source[i]&0x3f)==0x3e) emit_call((int)c_le_d);
if((source[i]&0x3f)==0x3f) emit_call((int)c_ngt_d);
}
emit_addimm(ESP,8,ESP);
emit_popa();
emit_loadreg(FSREG,fs);
return;
}
static void float_assemble(int i,struct regstat *i_regs)
{
signed char temp=get_reg(i_regs->regmap,-1);
assert(temp>=0);
if(!cop1_usable) {
signed char cs=get_reg(i_regs->regmap,CSREG);
assert(cs>=0);
emit_testimm(cs,0x20000000);
int jaddr=(int)out;
emit_jeq(0);
add_stub(FP_STUB,jaddr,(int)out,i,cs,(int)i_regs,is_delayslot,0);
cop1_usable=1;
}
if((source[i]&0x3f)==6) {
if(((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f)) {
if(opcode2[i]==0x10) {
emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_flds(temp);
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
emit_fstps(temp);
}
if(opcode2[i]==0x11) {
emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fldl(temp);
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
emit_fstpl(temp);
}
}
return;
}
if((source[i]&0x3f)>3)
{
if(opcode2[i]==0x10) {
emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_flds(temp);
if(((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f)) {
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
}
}
if(opcode2[i]==0x11) {
emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fldl(temp);
if(((source[i]>>11)&0x1f)!=((source[i]>>6)&0x1f)) {
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
}
}
if((source[i]&0x3f)==4) emit_fsqrt();
if((source[i]&0x3f)==5) emit_fabs();
if((source[i]&0x3f)==7) emit_fchs();
if(opcode2[i]==0x10) {
emit_fstps(temp);
}
if(opcode2[i]==0x11) {
emit_fstpl(temp);
}
return;
}
if((source[i]&0x3f)<4)
{
if(opcode2[i]==0x10) {
emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
emit_flds(temp);
}
if(opcode2[i]==0x11) {
emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
emit_fldl(temp);
}
if(((source[i]>>11)&0x1f)!=((source[i]>>16)&0x1f)) {
if(opcode2[i]==0x10) {
emit_readword((int)®_cop1_simple[(source[i]>>16)&0x1f],temp);
if((source[i]&0x3f)==0) emit_fadds(temp);
if((source[i]&0x3f)==1) emit_fsubs(temp);
if((source[i]&0x3f)==2) emit_fmuls(temp);
if((source[i]&0x3f)==3) emit_fdivs(temp);
}
else if(opcode2[i]==0x11) {
emit_readword((int)®_cop1_double[(source[i]>>16)&0x1f],temp);
if((source[i]&0x3f)==0) emit_faddl(temp);
if((source[i]&0x3f)==1) emit_fsubl(temp);
if((source[i]&0x3f)==2) emit_fmull(temp);
if((source[i]&0x3f)==3) emit_fdivl(temp);
}
}
else {
if((source[i]&0x3f)==0) emit_fadd(0);
if((source[i]&0x3f)==1) emit_fsub(0);
if((source[i]&0x3f)==2) emit_fmul(0);
if((source[i]&0x3f)==3) emit_fdiv(0);
}
if(opcode2[i]==0x10) {
if(((source[i]>>16)&0x1f)!=((source[i]>>6)&0x1f)) {
emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
}
emit_fstps(temp);
}
if(opcode2[i]==0x11) {
if(((source[i]>>16)&0x1f)!=((source[i]>>6)&0x1f)) {
emit_readword((int)®_cop1_double[(source[i]>>6)&0x1f],temp);
}
emit_fstpl(temp);
}
return;
}
if(opcode2[i]==0x10) { emit_pusha();
emit_pushmem((int)®_cop1_simple[(source[i]>> 6)&0x1f]);
if((source[i]&0x3f)<4)
emit_pushmem((int)®_cop1_simple[(source[i]>>16)&0x1f]);
emit_pushmem((int)®_cop1_simple[(source[i]>>11)&0x1f]);
switch(source[i]&0x3f)
{
case 0x00: emit_call((int)add_s);break;
case 0x01: emit_call((int)sub_s);break;
case 0x02: emit_call((int)mul_s);break;
case 0x03: emit_call((int)div_s);break;
case 0x04: emit_call((int)sqrt_s);break;
case 0x05: emit_call((int)abs_s);break;
case 0x06: emit_call((int)mov_s);break;
case 0x07: emit_call((int)neg_s);break;
}
emit_addimm(ESP,(source[i]&0x3f)<4?12:8,ESP);
emit_popa();
}
if(opcode2[i]==0x11) { emit_pusha();
emit_pushmem((int)®_cop1_double[(source[i]>> 6)&0x1f]);
if((source[i]&0x3f)<4)
emit_pushmem((int)®_cop1_double[(source[i]>>16)&0x1f]);
emit_pushmem((int)®_cop1_double[(source[i]>>11)&0x1f]);
switch(source[i]&0x3f)
{
case 0x00: emit_call((int)add_d);break;
case 0x01: emit_call((int)sub_d);break;
case 0x02: emit_call((int)mul_d);break;
case 0x03: emit_call((int)div_d);break;
case 0x04: emit_call((int)sqrt_d);break;
case 0x05: emit_call((int)abs_d);break;
case 0x06: emit_call((int)mov_d);break;
case 0x07: emit_call((int)neg_d);break;
}
emit_addimm(ESP,(source[i]&0x3f)<4?12:8,ESP);
emit_popa();
}
}
static void multdiv_assemble_x86(int i,struct regstat *i_regs)
{
if(rs1[i]&&rs2[i])
{
if((opcode2[i]&4)==0) {
if(opcode2[i]==0x18) {
char m1=get_reg(i_regs->regmap,rs1[i]);
char m2=get_reg(i_regs->regmap,rs2[i]);
assert(m1>=0);
assert(m2>=0);
emit_mov(m1,EAX);
emit_imul(m2);
}
if(opcode2[i]==0x19) {
char m1=get_reg(i_regs->regmap,rs1[i]);
char m2=get_reg(i_regs->regmap,rs2[i]);
assert(m1>=0);
assert(m2>=0);
emit_mov(m1,EAX);
emit_mul(m2);
}
if(opcode2[i]==0x1A) {
char d1=get_reg(i_regs->regmap,rs1[i]);
char d2=get_reg(i_regs->regmap,rs2[i]);
assert(d1>=0);
assert(d2>=0);
emit_mov(d1,EAX);
emit_cdq();
emit_test(d2,d2);
emit_jeq((int)out+8);
emit_idiv(d2);
}
if(opcode2[i]==0x1B) {
char d1=get_reg(i_regs->regmap,rs1[i]);
char d2=get_reg(i_regs->regmap,rs2[i]);
assert(d1>=0);
assert(d2>=0);
emit_mov(d1,EAX);
emit_zeroreg(EDX);
emit_test(d2,d2);
emit_jeq((int)out+8);
emit_div(d2);
}
}
else {
if(opcode2[i]==0x1C) {
char m1h=get_reg(i_regs->regmap,rs1[i]|64);
char m1l=get_reg(i_regs->regmap,rs1[i]);
char m2h=get_reg(i_regs->regmap,rs2[i]|64);
char m2l=get_reg(i_regs->regmap,rs2[i]);
assert(m1h>=0);
assert(m2h>=0);
assert(m1l>=0);
assert(m2l>=0);
emit_pushreg(m2h);
emit_pushreg(m2l);
emit_pushreg(m1h);
emit_pushreg(m1l);
emit_call((int)&mult64);
emit_popreg(m1l);
emit_popreg(m1h);
emit_popreg(m2l);
emit_popreg(m2h);
char hih=get_reg(i_regs->regmap,HIREG|64);
char hil=get_reg(i_regs->regmap,HIREG);
if(hih>=0) emit_loadreg(HIREG|64,hih);
if(hil>=0) emit_loadreg(HIREG,hil);
char loh=get_reg(i_regs->regmap,LOREG|64);
char lol=get_reg(i_regs->regmap,LOREG);
if(loh>=0) emit_loadreg(LOREG|64,loh);
if(lol>=0) emit_loadreg(LOREG,lol);
}
if(opcode2[i]==0x1D) {
char m1h=get_reg(i_regs->regmap,rs1[i]|64);
char m1l=get_reg(i_regs->regmap,rs1[i]);
char m2h=get_reg(i_regs->regmap,rs2[i]|64);
char m2l=get_reg(i_regs->regmap,rs2[i]);
char temp=get_reg(i_regs->regmap,-1);
assert(m1h>=0);
assert(m2h>=0);
assert(m1l>=0);
assert(m2l>=0);
assert(temp>=0);
emit_mov(m1l,EAX);
emit_mul(m2l);
emit_storereg(LOREG,EAX);
emit_mov(EDX,temp);
emit_mov(m1h,EAX);
emit_mul(m2l);
emit_add(EAX,temp,temp);
emit_adcimm(0,EDX);
emit_storereg(HIREG,EDX);
emit_mov(m2h,EAX);
emit_mul(m1l);
emit_add(EAX,temp,temp);
emit_adcimm(0,EDX);
emit_storereg(LOREG|64,temp);
emit_mov(EDX,temp);
emit_mov(m2h,EAX);
emit_mul(m1h);
emit_add(EAX,temp,EAX);
emit_loadreg(HIREG,temp);
emit_adcimm(0,EDX);
emit_add(EAX,temp,EAX);
emit_adcimm(0,EDX);
}
if(opcode2[i]==0x1E) {
char d1h=get_reg(i_regs->regmap,rs1[i]|64);
char d1l=get_reg(i_regs->regmap,rs1[i]);
char d2h=get_reg(i_regs->regmap,rs2[i]|64);
char d2l=get_reg(i_regs->regmap,rs2[i]);
assert(d1h>=0);
assert(d2h>=0);
assert(d1l>=0);
assert(d2l>=0);
emit_addimm(ESP,-16,ESP);
emit_writeword_indexed(d2h,12,ESP);
emit_writeword_indexed(d2l,8,ESP);
emit_writeword_indexed(d1h,4,ESP);
emit_writeword_indexed(d1l,0,ESP);
emit_call((int)&div64);
emit_readword_indexed(0,ESP,d1l);
emit_readword_indexed(4,ESP,d1h);
emit_readword_indexed(8,ESP,d2l);
emit_readword_indexed(12,ESP,d2h);
emit_addimm(ESP,16,ESP);
char hih=get_reg(i_regs->regmap,HIREG|64);
char hil=get_reg(i_regs->regmap,HIREG);
char loh=get_reg(i_regs->regmap,LOREG|64);
char lol=get_reg(i_regs->regmap,LOREG);
if(hih>=0) emit_loadreg(HIREG|64,hih);
if(hil>=0) emit_loadreg(HIREG,hil);
if(loh>=0) emit_loadreg(LOREG|64,loh);
if(lol>=0) emit_loadreg(LOREG,lol);
}
if(opcode2[i]==0x1F) {
char d1h=get_reg(i_regs->regmap,rs1[i]|64);
char d1l=get_reg(i_regs->regmap,rs1[i]);
char d2h=get_reg(i_regs->regmap,rs2[i]|64);
char d2l=get_reg(i_regs->regmap,rs2[i]);
assert(d1h>=0);
assert(d2h>=0);
assert(d1l>=0);
assert(d2l>=0);
emit_addimm(ESP,-16,ESP);
emit_writeword_indexed(d2h,12,ESP);
emit_writeword_indexed(d2l,8,ESP);
emit_writeword_indexed(d1h,4,ESP);
emit_writeword_indexed(d1l,0,ESP);
emit_call((int)&divu64);
emit_readword_indexed(0,ESP,d1l);
emit_readword_indexed(4,ESP,d1h);
emit_readword_indexed(8,ESP,d2l);
emit_readword_indexed(12,ESP,d2h);
emit_addimm(ESP,16,ESP);
char hih=get_reg(i_regs->regmap,HIREG|64);
char hil=get_reg(i_regs->regmap,HIREG);
char loh=get_reg(i_regs->regmap,LOREG|64);
char lol=get_reg(i_regs->regmap,LOREG);
if(hih>=0) emit_loadreg(HIREG|64,hih);
if(hil>=0) emit_loadreg(HIREG,hil);
if(loh>=0) emit_loadreg(LOREG|64,loh);
if(lol>=0) emit_loadreg(LOREG,lol);
}
}
}
else
{
char hr=get_reg(i_regs->regmap,HIREG);
char lr=get_reg(i_regs->regmap,LOREG);
if(hr>=0) emit_zeroreg(hr);
if(lr>=0) emit_zeroreg(lr);
}
}
#define multdiv_assemble multdiv_assemble_x86
static void do_preload_rhash(int r) {
emit_movimm(0xf8,r);
}
static void do_preload_rhtbl(int r) {
}
static void do_rhash(int rs,int rh) {
emit_and(rs,rh,rh);
}
static void do_miniht_load(int ht,int rh) {
}
static void do_miniht_jump(int rs,int rh,int ht) {
emit_cmpmem_indexed((int)mini_ht,rh,rs);
emit_jne(jump_vaddr_reg[rs]);
emit_jmpmem_indexed((int)mini_ht+4,rh);
}
static void do_miniht_insert(int return_address,int rt,int temp) {
emit_movimm(return_address,rt); emit_writeword(rt,(int)&mini_ht[(return_address&0xFF)>>3][0]);
add_to_linker((int)out,return_address,1);
emit_writeword_imm(0,(int)&mini_ht[(return_address&0xFF)>>3][1]);
}
static void literal_pool(int n) {}
static void literal_pool_jumpover(int n) {}
static void arch_init() {}