Use Ari64's releases if you need x86 stuff.
+++ /dev/null
-/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
- * Mupen64plus - assem_x64.c *
- * Copyright (C) 2009-2010 Ari64 *
- * *
- * This program is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 2 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with this program; if not, write to the *
- * Free Software Foundation, Inc., *
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. *
- * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
-
-int cycle_count;
-int last_count;
-int pcaddr;
-int pending_exception;
-int branch_target;
-uint64_t readmem_dword;
-precomp_instr fake_pc;
-u_int memory_map[1048576];
-u_int mini_ht[32][2] __attribute__((aligned(8)));
-u_char restore_candidate[512] __attribute__((aligned(4)));
-
-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();
-
-const void * jump_vaddr_reg[8] = {
- jump_vaddr_eax,
- jump_vaddr_ecx,
- jump_vaddr_edx,
- jump_vaddr_ebx,
- 0,
- jump_vaddr_ebp,
- 0,
- jump_vaddr_edi };
-
-const u_short rounding_modes[4] = {
- 0x33F, // round
- 0xF3F, // trunc
- 0xB3F, // ceil
- 0x73F};// floor
-
-#include "fpu.h"
-
-// We need these for cmovcc instructions on x86
-u_int const_zero=0;
-u_int const_one=1;
-
-/* Linker */
-
-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); /* mov immediate (store address) */
- u_int *ptr2=(u_int *)(ptr+6);
- *ptr2=target;
- }
-}
-
-void kill_pointer(void *stub)
-{
- int i_ptr=*((int *)(stub+6));
- *((int *)i_ptr)=(int)stub-(int)i_ptr-4;
-}
-int get_pointer(void *stub)
-{
- int i_ptr=*((int *)(stub+6));
- return *((int *)i_ptr)+(int)i_ptr+4;
-}
-
-// Find the "clean" entry point from a "dirty" entry point
-// by skipping past the call to verify_code
-u_int get_clean_addr(int addr)
-{
- u_char *ptr=(u_char *)addr;
- assert(ptr[21]==0xE8); // call instruction
- if(ptr[26]==0xE9) return *(u_int *)(ptr+27)+addr+31; // follow jmp
- else return(addr+26);
-}
-
-int verify_dirty(int addr)
-{
- u_char *ptr=(u_char *)addr;
- assert(ptr[0]==0xB8);
- u_int source=*(u_int *)(ptr+1);
- u_int copy=*(u_int *)(ptr+6);
- u_int len=*(u_int *)(ptr+11);
- //printf("source=%x source-rdram=%x\n",source,source-(int)rdram);
- assert(ptr[21]==0xE8); // call instruction
- u_int verifier=*(u_int *)(ptr+22)+(u_int)ptr+26;
- 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);
- }
- //printf("verify_dirty: %x %x %x\n",source,copy,len);
- return !memcmp((void *)source,(void *)copy,len);
-}
-
-// This doesn't necessarily find all clean entry points, just
-// guarantees that it's not dirty
-int isclean(int addr)
-{
- u_char *ptr=(u_char *)addr;
- if(ptr[0]!=0xB8) return 1; // mov imm,%eax
- if(ptr[5]!=0xBB) return 1; // mov imm,%ebx
- if(ptr[10]!=0xB9) return 1; // mov imm,%ecx
- if(ptr[15]!=0x41) return 1; // rex prefix
- if(ptr[16]!=0xBC) return 1; // mov imm,%r12d
- if(ptr[21]!=0xE8) return 1; // call instruction
- return 0;
-}
-
-void get_bounds(int addr,u_int *start,u_int *end)
-{
- u_char *ptr=(u_char *)addr;
- assert(ptr[0]==0xB8);
- u_int source=*(u_int *)(ptr+1);
- //u_int copy=*(u_int *)(ptr+6);
- u_int len=*(u_int *)(ptr+11);
- assert(ptr[21]==0xE8); // call instruction
- u_int verifier=*(u_int *)(ptr+22)+(u_int)ptr+26;
- 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);
- }
- *start=source;
- *end=source+len;
-}
-
-/* Register allocation */
-
-// Note: registers are allocated clean (unmodified state)
-// if you intend to modify the register, you must call dirty_reg().
-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);
-
- // Don't allocate unused registers
- if((cur->u>>reg)&1) return;
-
- // see if it's already allocated
- for(hr=0;hr<HOST_REGS;hr++)
- {
- if(cur->regmap[hr]==reg) return;
- }
-
- // Keep the same mapping if the register was already allocated in a loop
- preferred_reg = loop_reg(i,reg,preferred_reg);
-
- // Try to allocate the preferred register
- 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;
- }
-
- // Try to allocate EAX, EBX, ECX, or EDX
- // We prefer these because they can do byte and halfword loads
- for(hr=0;hr<4;hr++) {
- if(cur->regmap[hr]==-1) {
- cur->regmap[hr]=reg;
- cur->dirty&=~(1<<hr);
- cur->isconst&=~(1<<hr);
- return;
- }
- }
-
- // Clear any unneeded registers
- // We try to keep the mapping consistent, if possible, because it
- // makes branches easier (especially loops). So we try to allocate
- // first (see above) before removing old mappings. If this is not
- // possible then go ahead and clear out the registers that are no
- // longer needed.
- 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;}
- }
- }
- }
- // Try to allocate any available register, but prefer
- // registers that have not been used recently.
- 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;
- }
- }
- }
- }
- // Try to allocate any available register
- 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;
- }
- }
-
- // Ok, now we have to evict someone
- // Pick a register we hopefully won't need soon
- u_char hsn[MAXREG+1];
- memset(hsn,10,sizeof(hsn));
- int j;
- lsn(hsn,i,&preferred_reg);
- //printf("hsn(%x): %d %d %d %d %d %d %d\n",start+i*4,hsn[cur->regmap[0]&63],hsn[cur->regmap[1]&63],hsn[cur->regmap[2]&63],hsn[cur->regmap[3]&63],hsn[cur->regmap[5]&63],hsn[cur->regmap[6]&63],hsn[cur->regmap[7]&63]);
- if(i>0) {
- // Don't evict the cycle count at entry points, otherwise the entry
- // stub will have to write it.
- 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--)
- {
- // Alloc preferred register if available
- if(hsn[r=cur->regmap[preferred_reg]&63]==j) {
- for(hr=0;hr<HOST_REGS;hr++) {
- // Evict both parts of a 64-bit register
- 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;
- }
- }
- }
- }
- }
- printf("This shouldn't happen (alloc_reg)");exit(1);
-}
-
-void alloc_reg64(struct regstat *cur,int i,signed char reg)
-{
- int preferred_reg = 5+reg%3;
- int r,hr;
-
- // allocate the lower 32 bits
- alloc_reg(cur,i,reg);
-
- // Don't allocate unused registers
- if((cur->uu>>reg)&1) return;
-
- // see if the upper half is already allocated
- for(hr=0;hr<HOST_REGS;hr++)
- {
- if(cur->regmap[hr]==reg+64) return;
- }
-
- // Keep the same mapping if the register was already allocated in a loop
- preferred_reg = loop_reg(i,reg,preferred_reg);
-
- // Try to allocate the preferred register
- 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;
- }
-
- // Try to allocate EBP, ESI or EDI
- 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;
- }
- }
-
- // Clear any unneeded registers
- // We try to keep the mapping consistent, if possible, because it
- // makes branches easier (especially loops). So we try to allocate
- // first (see above) before removing old mappings. If this is not
- // possible then go ahead and clear out the registers that are no
- // longer needed.
- 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;}
- }
- }
- }
- // Try to allocate any available register, but prefer
- // registers that have not been used recently.
- 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;
- }
- }
- }
- }
- // Try to allocate any available register
- 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;
- }
- }
-
- // Ok, now we have to evict someone
- // Pick a register we hopefully won't need soon
- u_char hsn[MAXREG+1];
- memset(hsn,10,sizeof(hsn));
- int j;
- lsn(hsn,i,&preferred_reg);
- //printf("eax=%d ecx=%d edx=%d ebx=%d ebp=%d esi=%d edi=%d\n",cur->regmap[0],cur->regmap[1],cur->regmap[2],cur->regmap[3],cur->regmap[5],cur->regmap[6],cur->regmap[7]);
- //printf("hsn(%x): %d %d %d %d %d %d %d\n",start+i*4,hsn[cur->regmap[0]&63],hsn[cur->regmap[1]&63],hsn[cur->regmap[2]&63],hsn[cur->regmap[3]&63],hsn[cur->regmap[5]&63],hsn[cur->regmap[6]&63],hsn[cur->regmap[7]&63]);
- if(i>0) {
- // Don't evict the cycle count at entry points, otherwise the entry
- // stub will have to write it.
- 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--)
- {
- // Alloc preferred register if available
- if(hsn[r=cur->regmap[preferred_reg]&63]==j) {
- for(hr=0;hr<HOST_REGS;hr++) {
- // Evict both parts of a 64-bit register
- 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;
- }
- }
- }
- }
- }
- printf("This shouldn't happen");exit(1);
-}
-
-// Allocate a temporary register. This is done without regard to
-// dirty status or whether the register we request is on the unneeded list
-// Note: This will only allocate one register, even if called multiple times
-void alloc_reg_temp(struct regstat *cur,int i,signed char reg)
-{
- int r,hr;
- int preferred_reg = -1;
-
- // see if it's already allocated
- for(hr=0;hr<HOST_REGS;hr++)
- {
- if(hr!=EXCLUDE_REG&&cur->regmap[hr]==reg) return;
- }
-
- // Try to allocate any available register, starting with EDI, ESI, EBP...
- // We prefer EDI, ESI, EBP since the others are used for byte/halfword stores
- 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;
- }
- }
-
- // Find an unneeded register
- 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;
- }
- }
- }
- }
- }
-
- // Ok, now we have to evict someone
- // Pick a register we hopefully won't need soon
- // TODO: we might want to follow unconditional jumps here
- // TODO: get rid of dupe code and make this into a function
- u_char hsn[MAXREG+1];
- memset(hsn,10,sizeof(hsn));
- int j;
- lsn(hsn,i,&preferred_reg);
- //printf("hsn: %d %d %d %d %d %d %d\n",hsn[cur->regmap[0]&63],hsn[cur->regmap[1]&63],hsn[cur->regmap[2]&63],hsn[cur->regmap[3]&63],hsn[cur->regmap[5]&63],hsn[cur->regmap[6]&63],hsn[cur->regmap[7]&63]);
- if(i>0) {
- // Don't evict the cycle count at entry points, otherwise the entry
- // stub will have to write it.
- 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;
- }
- }
- }
- }
- }
- printf("This shouldn't happen");exit(1);
-}
-// Allocate a specific x86 register.
-void alloc_x86_reg(struct regstat *cur,int i,signed char reg,char hr)
-{
- int n;
-
- // see if it's already allocated (and dealloc it)
- for(n=0;n<HOST_REGS;n++)
- {
- if(n!=ESP&&cur->regmap[n]==reg) {cur->regmap[n]=-1;}
- }
-
- cur->regmap[hr]=reg;
- cur->dirty&=~(1<<hr);
- cur->isconst&=~(1<<hr);
-}
-
-// Alloc cycle count into dedicated register
-alloc_cc(struct regstat *cur,int i)
-{
- alloc_x86_reg(cur,i,CCREG,ESI);
-}
-
-/* Special alloc */
-
-void multdiv_alloc_x86(struct regstat *current,int i)
-{
- // case 0x18: MULT
- // case 0x19: MULTU
- // case 0x1A: DIV
- // case 0x1B: DIVU
- // case 0x1C: DMULT
- // case 0x1D: DMULTU
- // case 0x1E: DDIV
- // case 0x1F: DDIVU
- clear_const(current,rs1[i]);
- clear_const(current,rs2[i]);
- if(rs1[i]&&rs2[i])
- {
- if((opcode2[i]&4)==0) // 32-bit
- {
- 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 // 64-bit
- {
- 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
- {
- // Multiply by zero is zero.
- // MIPS does not have a divide by zero exception.
- // The result is undefined, we return zero.
- 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
-
-/* Assembler */
-
-char regname[16][4] = {
- "eax",
- "ecx",
- "edx",
- "ebx",
- "esp",
- "ebp",
- "esi",
- "edi",
- "r8",
- "r9",
- "r10",
- "r11",
- "r12",
- "r13",
- "r14",
- "r15"};
-
-void output_byte(u_char byte)
-{
- *(out++)=byte;
-}
-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;
-}
-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;
-}
-void output_rex(u_char w,u_char r,u_char x,u_char b)
-{
- assert(w<2);
- assert(r<2);
- assert(x<2);
- assert(b<2);
- u_char byte=0x40|(w<<3)|(r<<2)|(x<<1)|b;
- *(out++)=byte;
-}
-void output_w32(u_int word)
-{
- *((u_int *)out)=word;
- out+=4;
-}
-
-void emit_mov(int rs,int rt)
-{
- assem_debug("mov %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x89);
- output_modrm(3,rt,rs);
-}
-
-void emit_mov64(int rs,int rt)
-{
- assem_debug("mov %%%s,%%%s\n",regname[rs],regname[rt]);
- output_rex(1,0,0,rt>>3);
- output_byte(0x89);
- output_modrm(3,rt,rs);
-}
-
-void emit_add(int rs1,int rs2,int rt)
-{
- if(rs1==rt) {
- assem_debug("add %%%s,%%%s\n",regname[rs2],regname[rs1]);
- output_byte(0x01);
- output_modrm(3,rs1,rs2);
- }else if(rs2==rt) {
- assem_debug("add %%%s,%%%s\n",regname[rs1],regname[rs2]);
- output_byte(0x01);
- output_modrm(3,rs2,rs1);
- }else {
- assem_debug("lea (%%%s,%%%s),%%%s\n",regname[rs1],regname[rs2],regname[rt]);
- output_byte(0x8D);
- if(rs1!=EBP) {
- output_modrm(0,4,rt);
- output_sib(0,rs2,rs1);
- }else if(rs2!=EBP) {
- output_modrm(0,4,rt);
- output_sib(0,rs1,rs2);
- }else /* lea 0(,%ebp,2) */{
- output_modrm(0,4,rt);
- output_sib(1,EBP,5);
- output_w32(0);
- }
- }
-}
-
-void emit_adds(int rs1,int rs2,int rt)
-{
- emit_add(rs1,rs2,rt);
-}
-
-void emit_lea8(int rs1,int rt)
-{
- assem_debug("lea 0(%%%s,8),%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x8D);
- output_modrm(0,4,rt);
- output_sib(3,rs1,5);
- output_w32(0);
-}
-void emit_leairrx1(int imm,int rs1,int rs2,int rt)
-{
- assem_debug("lea %x(%%%s,%%%s,1),%%%s\n",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);
- }
-}
-void emit_leairrx4(int imm,int rs1,int rs2,int rt)
-{
- assem_debug("lea %x(%%%s,%%%s,4),%%%s\n",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);
- }
-}
-
-void emit_neg(int rs, int rt)
-{
- if(rs!=rt) emit_mov(rs,rt);
- assem_debug("neg %%%s\n",regname[rt]);
- output_byte(0xF7);
- output_modrm(3,rt,3);
-}
-
-void emit_negs(int rs, int rt)
-{
- emit_neg(rs,rt);
-}
-
-void emit_sub(int rs1,int rs2,int rt)
-{
- if(rs1==rt) {
- assem_debug("sub %%%s,%%%s\n",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);
- }
-}
-
-void emit_subs(int rs1,int rs2,int rt)
-{
- emit_sub(rs1,rs2,rt);
-}
-
-void emit_zeroreg(int rt)
-{
- output_byte(0x31);
- output_modrm(3,rt,rt);
- assem_debug("xor %%%s,%%%s\n",regname[rt],regname[rt]);
-}
-
-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)&Status;
- if(r==FSREG) addr=(int)&FCR31;
- assem_debug("mov %x+%d,%%%s\n",addr,r,regname[hr]);
- output_byte(0x8B);
- output_modrm(0,5,hr);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
- }
-}
-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\n",regname[hr],addr,r);
- output_byte(0x89);
- output_modrm(0,5,hr);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-
-void emit_test(int rs, int rt)
-{
- assem_debug("test %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x85);
- output_modrm(3,rs,rt);
-}
-
-void emit_testimm(int rs,int imm)
-{
- assem_debug("test $0x%x,%%%s\n",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);
- }
-}
-
-void emit_not(int rs,int rt)
-{
- if(rs!=rt) emit_mov(rs,rt);
- assem_debug("not %%%s\n",regname[rt]);
- output_byte(0xF7);
- output_modrm(3,rt,2);
-}
-
-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\n",regname[rs2],regname[rt]);
- output_byte(0x21);
- output_modrm(3,rs1,rs2);
- }
- else
- if(rs2==rt) {
- assem_debug("and %%%s,%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x21);
- output_modrm(3,rs2,rs1);
- }
- else {
- emit_mov(rs1,rt);
- emit_and(rt,rs2,rt);
- }
-}
-
-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\n",regname[rs2],regname[rt]);
- output_byte(0x09);
- output_modrm(3,rs1,rs2);
- }
- else
- if(rs2==rt) {
- assem_debug("or %%%s,%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x09);
- output_modrm(3,rs2,rs1);
- }
- else {
- emit_mov(rs1,rt);
- emit_or(rt,rs2,rt);
- }
-}
-void emit_or_and_set_flags(int rs1,int rs2,int rt)
-{
- emit_or(rs1,rs2,rt);
-}
-
-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\n",regname[rs2],regname[rt]);
- output_byte(0x31);
- output_modrm(3,rs1,rs2);
- }
- else
- if(rs2==rt) {
- assem_debug("xor %%%s,%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x31);
- output_modrm(3,rs2,rs1);
- }
- else {
- emit_mov(rs1,rt);
- emit_xor(rt,rs2,rt);
- }
-}
-
-void emit_movimm(int imm,u_int rt)
-{
- assem_debug("mov $%d,%%%s\n",imm,regname[rt]);
- assert(rt<16);
- if(rt>=8) output_rex(0,0,0,1);
- output_byte(0xB8+(rt&7));
- output_w32(imm);
-}
-
-void emit_addimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- if(imm!=0) {
- assem_debug("add $%d,%%%s\n",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\n",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);
- }
- }
-}
-
-void emit_addimm64(int rs,int imm,int rt)
-{
- if(rs==rt) {
- if(imm!=0) {
- assem_debug("add $%d,%%%s\n",imm,regname[rt]);
- if(imm<128&&imm>=-128) {
- output_rex(1,0,0,rt>>3);
- output_byte(0x83);
- output_modrm(3,rt&7,0);
- output_byte(imm);
- }
- else
- {
- output_rex(1,0,0,rt>>3);
- output_byte(0x81);
- output_modrm(3,rt&7,0);
- output_w32(imm);
- }
- }
- }
- else {
- if(imm!=0) {
- assem_debug("lea %d(%%%s),%%%s\n",imm,regname[rs],regname[rt]);
- output_rex(1,rt>>3,0,rs>>3);
- output_byte(0x8D);
- if(imm<128&&imm>=-128) {
- output_modrm(1,rs&7,rt&7);
- output_byte(imm);
- }else{
- output_modrm(2,rs&7,rt&7);
- output_w32(imm);
- }
- }else{
- emit_mov(rs,rt);
- }
- }
-}
-
-void emit_addimm_and_set_flags(int imm,int rt)
-{
- assem_debug("add $%d,%%%s\n",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);
- }
-}
-void emit_addimm_no_flags(int imm,int rt)
-{
- if(imm!=0) {
- assem_debug("lea %d(%%%s),%%%s\n",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);
- }
- }
-}
-
-void emit_adcimm(int imm,u_int rt)
-{
- assem_debug("adc $%d,%%%s\n",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);
- }
-}
-void emit_sbbimm(int imm,u_int rt)
-{
- assem_debug("sbb $%d,%%%s\n",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);
- }
-}
-
-void emit_addimm64_32(int rsh,int rsl,int imm,int rth,int rtl)
-{
- if(rsh==rth&&rsl==rtl) {
- assem_debug("add $%d,%%%s\n",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\n",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);
- }
-}
-
-void emit_sbb(int rs1,int rs2)
-{
- assem_debug("sbb %%%s,%%%s\n",regname[rs2],regname[rs1]);
- output_byte(0x19);
- output_modrm(3,rs1,rs2);
-}
-
-void emit_andimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("and $%d,%%%s\n",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);
- }
-}
-
-void emit_orimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("or $%d,%%%s\n",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);
- }
-}
-
-void emit_xorimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("xor $%d,%%%s\n",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);
- }
-}
-
-void emit_shlimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shl %%%s,%d\n",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);
- }
-}
-
-void emit_shrimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shr %%%s,%d\n",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);
- }
-}
-
-void emit_shrimm64(int rs,u_int imm,int rt)
-{
- assert(rs==rt);
- if(rs==rt) {
- assem_debug("shr %%%s,%d\n",regname[rt],imm);
- assert(imm>0);
- output_rex(1,0,0,rt>>3);
- 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);
- }
-}
-
-void emit_sarimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("sar %%%s,%d\n",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);
- }
-}
-
-void emit_rorimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("ror %%%s,%d\n",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_sarimm(rt,imm,rt);
- }
-}
-
-void emit_shldimm(int rs,int rs2,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shld %%%s,%%%s,%d\n",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);
- }
-}
-
-void emit_shrdimm(int rs,int rs2,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shrd %%%s,%%%s,%d\n",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);
- }
-}
-
-void emit_shlcl(int r)
-{
- assem_debug("shl %%%s,%%cl\n",regname[r]);
- output_byte(0xD3);
- output_modrm(3,r,4);
-}
-void emit_shrcl(int r)
-{
- assem_debug("shr %%%s,%%cl\n",regname[r]);
- output_byte(0xD3);
- output_modrm(3,r,5);
-}
-void emit_sarcl(int r)
-{
- assem_debug("sar %%%s,%%cl\n",regname[r]);
- output_byte(0xD3);
- output_modrm(3,r,7);
-}
-
-void emit_shldcl(int r1,int r2)
-{
- assem_debug("shld %%%s,%%%s,%%cl\n",regname[r1],regname[r2]);
- output_byte(0x0F);
- output_byte(0xA5);
- output_modrm(3,r1,r2);
-}
-void emit_shrdcl(int r1,int r2)
-{
- assem_debug("shrd %%%s,%%%s,%%cl\n",regname[r1],regname[r2]);
- output_byte(0x0F);
- output_byte(0xAD);
- output_modrm(3,r1,r2);
-}
-
-void emit_cmpimm(int rs,int imm)
-{
- assem_debug("cmp $%d,%%%s\n",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);
- }
-}
-
-void emit_cmovne(u_int *addr,int rt)
-{
- assem_debug("cmovne %x,%%%s",(int)addr,regname[rt]);
- if(addr==&const_zero) assem_debug(" [zero]\n");
- else if(addr==&const_one) assem_debug(" [one]\n");
- else assem_debug("\n");
- output_byte(0x0F);
- output_byte(0x45);
- output_modrm(0,5,rt);
- output_w32((int)addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_cmovl(u_int *addr,int rt)
-{
- assem_debug("cmovl %x,%%%s",(int)addr,regname[rt]);
- if(addr==&const_zero) assem_debug(" [zero]\n");
- else if(addr==&const_one) assem_debug(" [one]\n");
- else assem_debug("\n");
- output_byte(0x0F);
- output_byte(0x4C);
- output_modrm(0,5,rt);
- output_w32((int)addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_cmovs(u_int *addr,int rt)
-{
- assem_debug("cmovs %x,%%%s",(int)addr,regname[rt]);
- if(addr==&const_zero) assem_debug(" [zero]\n");
- else if(addr==&const_one) assem_debug(" [one]\n");
- else assem_debug("\n");
- output_byte(0x0F);
- output_byte(0x48);
- output_modrm(0,5,rt);
- output_w32((int)addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_cmovne_reg(int rs,int rt)
-{
- assem_debug("cmovne %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x45);
- output_modrm(3,rs,rt);
-}
-void emit_cmovl_reg(int rs,int rt)
-{
- assem_debug("cmovl %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x4C);
- output_modrm(3,rs,rt);
-}
-void emit_cmovs_reg(int rs,int rt)
-{
- assem_debug("cmovs %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x48);
- output_modrm(3,rs,rt);
-}
-void emit_cmovnc_reg(int rs,int rt)
-{
- assem_debug("cmovae %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x43);
- output_modrm(3,rs,rt);
-}
-void emit_cmova_reg(int rs,int rt)
-{
- assem_debug("cmova %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x47);
- output_modrm(3,rs,rt);
-}
-void emit_cmovp_reg(int rs,int rt)
-{
- assem_debug("cmovp %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x4A);
- output_modrm(3,rs,rt);
-}
-void emit_cmovnp_reg(int rs,int rt)
-{
- assem_debug("cmovnp %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x4B);
- output_modrm(3,rs,rt);
-}
-void emit_setl(int rt)
-{
- assem_debug("setl %%%s\n",regname[rt]);
- output_byte(0x0F);
- output_byte(0x9C);
- output_modrm(3,rt,2);
-}
-void emit_movzbl_reg(int rs, int rt)
-{
- assem_debug("movzbl %%%s,%%%s\n",regname[rs]+1,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(3,rs,rt);
-}
-
-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);
- }
-}
-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);
-}
-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);
- }
-}
-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);
- }
-}
-
-void emit_cmp(int rs,int rt)
-{
- assem_debug("cmp %%%s,%%%s\n",regname[rt],regname[rs]);
- output_byte(0x39);
- output_modrm(3,rs,rt);
-}
-void emit_set_gz32(int rs, int rt)
-{
- //assem_debug("set_gz32\n");
- emit_cmpimm(rs,1);
- emit_movimm(1,rt);
- emit_cmovl(&const_zero,rt);
-}
-void emit_set_nz32(int rs, int rt)
-{
- //assem_debug("set_nz32\n");
- emit_cmpimm(rs,1);
- emit_movimm(1,rt);
- emit_sbbimm(0,rt);
-}
-void emit_set_gz64_32(int rsh, int rsl, int rt)
-{
- //assem_debug("set_gz64\n");
- emit_set_gz32(rsl,rt);
- emit_test(rsh,rsh);
- emit_cmovne(&const_one,rt);
- emit_cmovs(&const_zero,rt);
-}
-void emit_set_nz64_32(int rsh, int rsl, int rt)
-{
- //assem_debug("set_nz64\n");
- emit_or_and_set_flags(rsh,rsl,rt);
- emit_cmovne(&const_one,rt);
-}
-void emit_set_if_less32(int rs1, int rs2, int rt)
-{
- //assem_debug("set if less (%%%s,%%%s),%%%s\n",regname[rs1],regname[rs2],regname[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);
-}
-void emit_set_if_carry32(int rs1, int rs2, int rt)
-{
- //assem_debug("set if carry (%%%s,%%%s),%%%s\n",regname[rs1],regname[rs2],regname[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);
-}
-void emit_set_if_less64_32(int u1, int l1, int u2, int l2, int rt)
-{
- //assem_debug("set if less64 (%%%s,%%%s,%%%s,%%%s),%%%s\n",regname[u1],regname[l1],regname[u2],regname[l2],regname[rt]);
- assert(u1!=rt);
- assert(u2!=rt);
- emit_cmp(l1,l2);
- emit_mov(u1,rt);
- emit_sbb(rt,u2);
- emit_movimm(0,rt);
- emit_cmovl(&const_one,rt);
-}
-void emit_set_if_carry64_32(int u1, int l1, int u2, int l2, int rt)
-{
- //assem_debug("set if carry64 (%%%s,%%%s,%%%s,%%%s),%%%s\n",regname[u1],regname[l1],regname[u2],regname[l2],regname[rt]);
- assert(u1!=rt);
- assert(u2!=rt);
- emit_cmp(l1,l2);
- emit_mov(u1,rt);
- emit_sbb(rt,u2);
- emit_movimm(0,rt);
- emit_adcimm(0,rt);
-}
-
-void emit_call(int a)
-{
- assem_debug("call %x (%x+%x)\n",a,(int)out+5,a-(int)out-5);
- output_byte(0xe8);
- output_w32(a-(int)out-4);
-}
-void emit_jmp(int a)
-{
- assem_debug("jmp %x (%x+%x)\n",a,(int)out+5,a-(int)out-5);
- output_byte(0xe9);
- output_w32(a-(int)out-4);
-}
-void emit_jne(int a)
-{
- assem_debug("jne %x\n",a);
- output_byte(0x0f);
- output_byte(0x85);
- output_w32(a-(int)out-4);
-}
-void emit_jeq(int a)
-{
- assem_debug("jeq %x\n",a);
- output_byte(0x0f);
- output_byte(0x84);
- output_w32(a-(int)out-4);
-}
-void emit_js(int a)
-{
- assem_debug("js %x\n",a);
- output_byte(0x0f);
- output_byte(0x88);
- output_w32(a-(int)out-4);
-}
-void emit_jns(int a)
-{
- assem_debug("jns %x\n",a);
- output_byte(0x0f);
- output_byte(0x89);
- output_w32(a-(int)out-4);
-}
-void emit_jl(int a)
-{
- assem_debug("jl %x\n",a);
- output_byte(0x0f);
- output_byte(0x8c);
- output_w32(a-(int)out-4);
-}
-void emit_jge(int a)
-{
- assem_debug("jge %x\n",a);
- output_byte(0x0f);
- output_byte(0x8d);
- output_w32(a-(int)out-4);
-}
-void emit_jno(int a)
-{
- assem_debug("jno %x\n",a);
- output_byte(0x0f);
- output_byte(0x81);
- output_w32(a-(int)out-4);
-}
-void emit_jc(int a)
-{
- assem_debug("jc %x\n",a);
- output_byte(0x0f);
- output_byte(0x82);
- output_w32(a-(int)out-4);
-}
-
-void emit_pushimm(int imm)
-{
- assem_debug("push $%x\n",imm);
- output_byte(0x68);
- output_w32(imm);
-}
-//void emit_pusha()
-//{
-// assem_debug("pusha\n");
-// output_byte(0x60);
-//}
-//void emit_popa()
-//{
-// assem_debug("popa\n");
-// output_byte(0x61);
-//}
-void emit_pushreg(u_int r)
-{
- assem_debug("push %%%s\n",regname[r]);
- assert(r<8);
- output_byte(0x50+r);
-}
-void emit_popreg(u_int r)
-{
- assem_debug("pop %%%s\n",regname[r]);
- assert(r<8);
- output_byte(0x58+r);
-}
-void emit_callreg(u_int r)
-{
- assem_debug("call *%%%s\n",regname[r]);
- assert(r<8);
- output_byte(0xFF);
- output_modrm(3,r,2);
-}
-void emit_jmpreg(u_int r)
-{
- assem_debug("jmp *%%%s\n",regname[r]);
- assert(r<8);
- output_byte(0xFF);
- output_modrm(3,r,4);
-}
-void emit_jmpmem_indexed(u_int addr,u_int r)
-{
- assem_debug("jmp *%x(%%%s)\n",addr,regname[r]);
- assert(r<8);
- output_byte(0xFF);
- output_modrm(2,r,4);
- output_w32(addr);
-}
-
-void emit_readword(int addr, int rt)
-{
- assem_debug("mov %x,%%%s\n",addr,regname[rt]);
- output_byte(0x8B);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_readword_indexed(int addr, int rs, int rt)
-{
- assem_debug("mov %x+%%%s,%%%s\n",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);
- }
-}
-void emit_readword_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_readword(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("addr32 mov %x(,%%%s,4),%%%s\n",addr,regname[map],regname[rt]);
- output_byte(0x67);
- output_byte(0x8B);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr);
- }
-}
-void emit_readword_indexed_tlb(int addr, int rs, int map, int rt)
-{
- if(map<0) emit_readword_indexed(addr+(int)rdram-0x80000000, rs, rt);
- else {
- assem_debug("addr32 mov %x(%%%s,%%%s,4),%%%s\n",addr,regname[rs],regname[map],regname[rt]);
- assert(rs!=ESP);
- output_byte(0x67);
- 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);
- }
- }
-}
-void emit_movmem_indexedx4(int addr, int rs, int rt)
-{
- assem_debug("mov (%x,%%%s,4),%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x8B);
- output_modrm(0,4,rt);
- output_sib(2,rs,5);
- output_w32(addr);
-}
-void emit_movmem_indexedx4_addr32(int addr, int rs, int rt)
-{
- assem_debug("addr32 mov (%x,%%%s,4),%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x67);
- output_byte(0x8B);
- output_modrm(0,4,rt);
- output_sib(2,rs,5);
- output_w32(addr);
-}
-void emit_movmem_indexedx8(int addr, int rs, int rt)
-{
- assem_debug("mov (%x,%%%s,8),%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x8B);
- output_modrm(0,4,rt);
- output_sib(3,rs,5);
- output_w32(addr);
-}
-void emit_readdword_tlb(int addr, int map, int rh, int rl)
-{
- if(map<0) {
- if(rh>=0) emit_readword(addr+(int)rdram-0x80000000, rh);
- emit_readword(addr+(int)rdram-0x7FFFFFFC, rl);
- }
- else {
- if(rh>=0) emit_movmem_indexedx4_addr32(addr, map, rh);
- emit_movmem_indexedx4_addr32(addr+4, map, rl);
- }
-}
-void emit_readdword_indexed(int addr, int rs, int rt)
-{
- assem_debug("mov %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_rex(1,rt>>3,0,rs>>3);
- output_byte(0x8B);
- if(addr<128&&addr>=-128) {
- output_modrm(1,rs&7,rt&7);
- if(rs==ESP) output_sib(0,4,4);
- output_byte(addr);
- }
- else
- {
- output_modrm(2,rs&7,rt&7);
- if(rs==ESP) output_sib(0,4,4);
- output_w32(addr);
- }
-}
-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);
-}
-void emit_movsbl(int addr, int rt)
-{
- assem_debug("movsbl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xBE);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_movsbl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movsbl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xBE);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movsbl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movsbl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("addr32 movsbl %x(,%%%s,4),%%%s\n",addr,regname[map],regname[rt]);
- output_byte(0x67);
- output_byte(0x0F);
- output_byte(0xBE);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr);
- }
-}
-void emit_movsbl_indexed_tlb(int addr, int rs, int map, int rt)
-{
- if(map<0) emit_movsbl_indexed(addr+(int)rdram-0x80000000, rs, rt);
- else {
- assem_debug("addr32 movsbl %x(%%%s,%%%s,4),%%%s\n",addr,regname[rs],regname[map],regname[rt]);
- assert(rs!=ESP);
- output_byte(0x67);
- 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);
- }
- }
-}
-void emit_movswl(int addr, int rt)
-{
- assem_debug("movswl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xBF);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_movswl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movswl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xBF);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movswl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movswl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("addr32 movswl %x(,%%%s,4),%%%s\n",addr,regname[map],regname[rt]);
- output_byte(0x67);
- output_byte(0x0F);
- output_byte(0xBF);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr);
- }
-}
-void emit_movzbl(int addr, int rt)
-{
- assem_debug("movzbl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_movzbl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movzbl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movzbl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movzbl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("addr32 movzbl %x(,%%%s,4),%%%s\n",addr,regname[map],regname[rt]);
- output_byte(0x67);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr);
- }
-}
-void emit_movzbl_indexed_tlb(int addr, int rs, int map, int rt)
-{
- if(map<0) emit_movzbl_indexed(addr+(int)rdram-0x80000000, rs, rt);
- else {
- assem_debug("addr32 movzbl %x(%%%s,%%%s,4),%%%s\n",addr,regname[rs],regname[map],regname[rt]);
- assert(rs!=ESP);
- output_byte(0x67);
- 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);
- }
- }
-}
-void emit_movzwl(int addr, int rt)
-{
- assem_debug("movzwl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_movzwl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movzwl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movzwl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movzwl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("addr32 movzwl %x(,%%%s,4),%%%s\n",addr,regname[map],regname[rt]);
- output_byte(0x67);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr);
- }
-}
-void emit_movzwl_reg(int rs, int rt)
-{
- assem_debug("movzwl %%%s,%%%s\n",regname[rs]+1,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(3,rs,rt);
-}
-
-void emit_xchg(int rs, int rt)
-{
- assem_debug("xchg %%%s,%%%s\n",regname[rs],regname[rt]);
- if(rs==EAX) {
- output_byte(0x90+rt);
- }
- else
- {
- output_byte(0x87);
- output_modrm(3,rs,rt);
- }
-}
-void emit_writeword(int rt, int addr)
-{
- assem_debug("movl %%%s,%x\n",regname[rt],addr);
- output_byte(0x89);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_writeword_indexed(int rt, int addr, int rs)
-{
- assem_debug("mov %%%s,%x+%%%s\n",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);
- }
-}
-void emit_writeword_tlb(int rt, int addr, int map)
-{
- if(map<0) {
- emit_writeword(rt, addr+(int)rdram-0x80000000);
- } else {
- emit_writeword_indexed(rt, addr, map);
- }
-}
-void emit_writeword_indexed_tlb(int rt, int addr, int rs, int map, int temp)
-{
- if(map<0) emit_writeword_indexed(rt, addr+(int)rdram-0x80000000, rs);
- else {
- assem_debug("addr32 mov %%%s,%x(%%%s,%%%s,1)\n",regname[rt],addr,regname[rs],regname[map]);
- assert(rs!=ESP);
- output_byte(0x67);
- 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);
- }
- }
-}
-void emit_writedword_tlb(int rh, int rl, int addr, int map)
-{
- assert(rh>=0);
- if(map<0) {
- emit_writeword(rh, addr+(int)rdram-0x80000000);
- emit_writeword(rl, addr+(int)rdram-0x7FFFFFFC);
- }
- else {
- emit_writeword_indexed(rh, addr, map);
- emit_writeword_indexed(rl, addr+4, map);
- }
-}
-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);
-}
-void emit_writehword(int rt, int addr)
-{
- assem_debug("movw %%%s,%x\n",regname[rt]+1,addr);
- output_byte(0x66);
- output_byte(0x89);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_writehword_indexed(int rt, int addr, int rs)
-{
- assem_debug("movw %%%s,%x+%%%s\n",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);
- }
-}
-void emit_writehword_tlb(int rt, int addr, int map)
-{
- if(map<0) {
- emit_writehword(rt, addr+(int)rdram-0x80000000);
- } else {
- emit_writehword_indexed(rt, addr, map);
- }
-}
-void emit_writebyte(int rt, int addr)
-{
- if(rt<4) {
- assem_debug("movb %%%cl,%x\n",regname[rt][1],addr);
- output_byte(0x88);
- output_modrm(0,5,rt);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
- }
- else
- {
- emit_xchg(EAX,rt);
- emit_writebyte(EAX,addr);
- emit_xchg(EAX,rt);
- }
-}
-void emit_writebyte_indexed(int rt, int addr, int rs)
-{
- if(rt<4) {
- assem_debug("movb %%%cl,%x+%%%s\n",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);
- }
-}
-void emit_writebyte_tlb(int rt, int addr, int map)
-{
- if(map<0) {
- emit_writebyte(rt, addr+(int)rdram-0x80000000);
- } else {
- emit_writebyte_indexed(rt, addr, map);
- }
-}
-void emit_writebyte_indexed_tlb(int rt, int addr, int rs, int map, int temp)
-{
- if(map<0) emit_writebyte_indexed(rt, addr+(int)rdram-0x80000000, rs);
- else
- if(rt<4) {
- assem_debug("addr32 movb %%%cl,%x(%%%s,%%%s,1)\n",regname[rt][1],addr,regname[rs],regname[map]);
- assert(rs!=ESP);
- output_byte(0x67);
- 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);
- }
-}
-void emit_writeword_imm(int imm, int addr)
-{
- assem_debug("movl $%x,%x\n",imm,addr);
- output_byte(0xC7);
- output_modrm(0,5,0);
- output_w32(addr-(int)out-8); // Note: rip-relative in 64-bit mode
- output_w32(imm);
-}
-void emit_writeword_imm_esp(int imm, int addr)
-{
- assem_debug("mov $%x,%x(%%esp)\n",imm,addr);
- assert(addr>=-128&&addr<128);
- output_byte(0xC7);
- output_modrm(!!addr,4,0);
- output_sib(0,4,4);
- if(addr) output_byte(addr);
- output_w32(imm);
-}
-void emit_writedword_imm32(int imm, int addr)
-{
- assem_debug("movq $%x,%x\n",imm,addr);
- output_rex(1,0,0,0);
- output_byte(0xC7);
- output_modrm(0,5,0);
- output_w32(addr-(int)out-8); // Note: rip-relative in 64-bit mode
- output_w32(imm); // Note: This 32-bit value will be sign extended
-}
-void emit_writebyte_imm(int imm, int addr)
-{
- assem_debug("movb $%x,%x\n",imm,addr);
- assert(imm>=-128&&imm<128);
- output_byte(0xC6);
- output_modrm(0,5,0);
- output_w32(addr-(int)out-5); // Note: rip-relative in 64-bit mode
- output_byte(imm);
-}
-
-void emit_mul(int rs)
-{
- assem_debug("mul %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,4);
-}
-void emit_imul(int rs)
-{
- assem_debug("imul %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,5);
-}
-void emit_div(int rs)
-{
- assem_debug("div %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,6);
-}
-void emit_idiv(int rs)
-{
- assem_debug("idiv %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,7);
-}
-void emit_cdq()
-{
- assem_debug("cdq\n");
- output_byte(0x99);
-}
-
-// Load 2 immediates optimizing for small code size
-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);
-}
-
-// special case for checking pending_exception
-void emit_cmpmem_imm_byte(int addr,int imm)
-{
- assert(imm<128&&imm>=-127);
- assem_debug("cmpb $%d,%x\n",imm,addr);
- output_byte(0x80);
- output_modrm(0,5,7);
- output_w32(addr-(int)out-5); // Note: rip-relative in 64-bit mode
- output_byte(imm);
-}
-
-// special case for checking invalid_code
-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\n",imm,addr,regname[r]);
- output_byte(0x80);
- output_modrm(2,r,7);
- output_w32(addr);
- output_byte(imm);
-}
-
-// special case for checking hash_table
-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\n",addr,regname[rs],regname[rt]);
- output_byte(0x39);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-
-// special case for checking memory_map in verify_mapping
-void emit_cmpmem(int addr,int rt)
-{
- assert(rt>=0&&rt<8);
- assem_debug("cmp %x,%%%s\n",addr,regname[rt]);
- output_byte(0x39);
- output_modrm(0,5,rt);
- output_w32((int)addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-
-// Used to preload hash table entries
-void emit_prefetch(void *addr)
-{
- assem_debug("prefetch %x\n",(int)addr);
- output_byte(0x0F);
- output_byte(0x18);
- output_modrm(0,5,1);
- output_w32((int)addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-
-/*void emit_submem(int r,int addr)
-{
- assert(r>=0&&r<8);
- assem_debug("sub %x,%%%s\n",addr,regname[r]);
- output_byte(0x2B);
- output_modrm(0,5,r);
- output_w32((int)addr);
-}*/
-
-void emit_flds(int r)
-{
- assem_debug("flds (%%%s)\n",regname[r]);
- output_byte(0xd9);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fldl(int r)
-{
- assem_debug("fldl (%%%s)\n",regname[r]);
- output_byte(0xdd);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fucomip(u_int r)
-{
- assem_debug("fucomip %d\n",r);
- assert(r<8);
- output_byte(0xdf);
- output_byte(0xe8+r);
-}
-void emit_fchs()
-{
- assem_debug("fchs\n");
- output_byte(0xd9);
- output_byte(0xe0);
-}
-void emit_fabs()
-{
- assem_debug("fabs\n");
- output_byte(0xd9);
- output_byte(0xe1);
-}
-void emit_fsqrt()
-{
- assem_debug("fsqrt\n");
- output_byte(0xd9);
- output_byte(0xfa);
-}
-void emit_fadds(int r)
-{
- assem_debug("fadds (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_faddl(int r)
-{
- assem_debug("faddl (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fadd(int r)
-{
- assem_debug("fadd st%d\n",r);
- output_byte(0xd8);
- output_byte(0xc0+r);
-}
-void emit_fsubs(int r)
-{
- assem_debug("fsubs (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,4);
- else {output_modrm(1,EBP,4);output_byte(0);}
-}
-void emit_fsubl(int r)
-{
- assem_debug("fsubl (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,4);
- else {output_modrm(1,EBP,4);output_byte(0);}
-}
-void emit_fsub(int r)
-{
- assem_debug("fsub st%d\n",r);
- output_byte(0xd8);
- output_byte(0xe0+r);
-}
-void emit_fmuls(int r)
-{
- assem_debug("fmuls (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,1);
- else {output_modrm(1,EBP,1);output_byte(0);}
-}
-void emit_fmull(int r)
-{
- assem_debug("fmull (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,1);
- else {output_modrm(1,EBP,1);output_byte(0);}
-}
-void emit_fmul(int r)
-{
- assem_debug("fmul st%d\n",r);
- output_byte(0xd8);
- output_byte(0xc8+r);
-}
-void emit_fdivs(int r)
-{
- assem_debug("fdivs (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,6);
- else {output_modrm(1,EBP,6);output_byte(0);}
-}
-void emit_fdivl(int r)
-{
- assem_debug("fdivl (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,6);
- else {output_modrm(1,EBP,6);output_byte(0);}
-}
-void emit_fdiv(int r)
-{
- assem_debug("fdiv st%d\n",r);
- output_byte(0xd8);
- output_byte(0xf0+r);
-}
-void emit_fpop()
-{
- // fstp st(0)
- assem_debug("fpop\n");
- output_byte(0xdd);
- output_byte(0xd8);
-}
-void emit_fildl(int r)
-{
- assem_debug("fildl (%%%s)\n",regname[r]);
- output_byte(0xdb);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fildll(int r)
-{
- assem_debug("fildll (%%%s)\n",regname[r]);
- output_byte(0xdf);
- if(r!=EBP) output_modrm(0,r,5);
- else {output_modrm(1,EBP,5);output_byte(0);}
-}
-void emit_fistpl(int r)
-{
- assem_debug("fistpl (%%%s)\n",regname[r]);
- output_byte(0xdb);
- if(r!=EBP) output_modrm(0,r,3);
- else {output_modrm(1,EBP,3);output_byte(0);}
-}
-void emit_fistpll(int r)
-{
- assem_debug("fistpll (%%%s)\n",regname[r]);
- output_byte(0xdf);
- if(r!=EBP) output_modrm(0,r,7);
- else {output_modrm(1,EBP,7);output_byte(0);}
-}
-void emit_fstps(int r)
-{
- assem_debug("fstps (%%%s)\n",regname[r]);
- output_byte(0xd9);
- if(r!=EBP) output_modrm(0,r,3);
- else {output_modrm(1,EBP,3);output_byte(0);}
-}
-void emit_fstpl(int r)
-{
- assem_debug("fstpl (%%%s)\n",regname[r]);
- output_byte(0xdd);
- if(r!=EBP) output_modrm(0,r,3);
- else {output_modrm(1,EBP,3);output_byte(0);}
-}
-void emit_fnstcw_stack()
-{
- assem_debug("fnstcw (%%esp)\n");
- output_byte(0xd9);
- output_modrm(0,4,7);
- output_sib(0,4,4);
-}
-void emit_fldcw_stack()
-{
- assem_debug("fldcw (%%esp)\n");
- output_byte(0xd9);
- output_modrm(0,4,5);
- output_sib(0,4,4);
-}
-void emit_fldcw_indexed(int addr,int r)
-{
- assem_debug("fldcw %x(%%%s)\n",addr,regname[r]);
- output_byte(0xd9);
- output_modrm(0,4,5);
- output_sib(1,r,5);
- output_w32(addr);
-}
-void emit_fldcw(int addr)
-{
- assem_debug("fldcw %x\n",addr);
- output_byte(0xd9);
- output_modrm(0,5,5);
- output_w32(addr-(int)out-4); // Note: rip-relative in 64-bit mode
-}
-void emit_movss_load(u_int addr,u_int ssereg)
-{
- assem_debug("movss (%%%s),xmm%d\n",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);}
-}
-void emit_movsd_load(u_int addr,u_int ssereg)
-{
- assem_debug("movsd (%%%s),xmm%d\n",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);}
-}
-void emit_movd_store(u_int ssereg,u_int addr)
-{
- assem_debug("movd xmm%d,(%%%s)\n",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);}
-}
-void emit_cvttps2dq(u_int ssereg1,u_int ssereg2)
-{
- assem_debug("cvttps2dq xmm%d,xmm%d\n",ssereg1,ssereg2);
- assert(ssereg1<8);
- assert(ssereg2<8);
- output_byte(0xf3);
- output_byte(0x0f);
- output_byte(0x5b);
- output_modrm(3,ssereg1,ssereg2);
-}
-void emit_cvttpd2dq(u_int ssereg1,u_int ssereg2)
-{
- assem_debug("cvttpd2dq xmm%d,xmm%d\n",ssereg1,ssereg2);
- assert(ssereg1<8);
- assert(ssereg2<8);
- output_byte(0x66);
- output_byte(0x0f);
- output_byte(0xe6);
- output_modrm(3,ssereg1,ssereg2);
-}
-
-unsigned int count_bits(u_int reglist)
-{
- int count=0;
- while(reglist)
- {
- count+=reglist&1;
- reglist>>=1;
- }
- return count;
-}
-
-// Save registers before function call
-// This code is executed infrequently so we try to minimize code size
-// by pushing registers onto the stack instead of writing them to their
-// usual locations
-void save_regs(u_int reglist)
-{
- int hr;
- int count=count_bits(reglist);
- if(count) {
- for(hr=0;hr<HOST_REGS;hr++) {
- if(hr!=EXCLUDE_REG) {
- if((reglist>>hr)&1) {
- emit_pushreg(hr);
- }
- }
- }
- }
- emit_addimm(ESP,-(8-count)*8,ESP);
-}
-// Restore registers after function call
-void restore_regs(u_int reglist)
-{
- int hr;
- int count=count_bits(reglist);
- emit_addimm(ESP,(8-count)*8,ESP);
- if(count) {
- for(hr=HOST_REGS-1;hr>=0;hr--) {
- if(hr!=EXCLUDE_REG) {
- if((reglist>>hr)&1) {
- emit_popreg(hr);
- }
- }
- }
- }
-}
-
-/* Stubs/epilogue */
-
-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);
- //assert(addr>=0x7000000&&addr<0x7FFFFFF);
- //assert((target>=0x80000000&&target<0x80800000)||(target>0xA4000000&&target<0xA4001000));
-//DEBUG >
-#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)&Count);
- emit_sub(HOST_CCREG,ECX,HOST_CCREG);
- emit_writeword(ECX,(int)&last_count);
-#endif
-//DEBUG <
- emit_jmp(linker);
-}
-
-emit_extjump(int addr, int target)
-{
- emit_extjump2(addr, target, (int)dyna_linker);
-}
-emit_extjump_ds(int addr, int target)
-{
- emit_extjump2(addr, target, (int)dyna_linker_ds);
-}
-
-do_readstub(int n)
-{
- assem_debug("do_readstub %x\n",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];
- u_int reglist=stubs[n][7];
- 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);
- assert(rt>=0);
- if(addr<0) addr=rt;
- 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_indexedx8(ftable,addr,addr);
- save_regs(reglist);
- 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,0);
- emit_add(cc,temp,cc);
- emit_writeword(cc,(int)&Count);
- emit_callreg(addr);
- // We really shouldn't need to update the count here,
- // but not doing so causes random crashes...
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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);
- restore_regs(reglist);
- if((cc=get_reg(i_regmap,CCREG))>=0) {
- emit_loadreg(CCREG,cc);
- }
- 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]); // return address
-}
-
-inline_readstub(int type, int i, u_int addr, signed char regmap[], int target, int adj, u_int reglist)
-{
- assem_debug("inline_readstub\n");
- int rs=get_reg(regmap,target);
- int rth=get_reg(regmap,target|64);
- int rt=get_reg(regmap,target);
- assert(rs>=0);
- assert(rt>=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
- save_regs(reglist);
- 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)&Count);
- if((signed int)addr>=(signed int)0xC0000000) {
- // Pagefault address
- int ds=regmap!=regs[i].regmap;
- emit_writeword_imm_esp(start+i*4+(((regs[i].was32>>rs1[i])&1)<<1)+ds,0);
- }
- emit_call(((uint64_t *)ftable)[addr>>16]);
- // We really shouldn't need to update the count here,
- // but not doing so causes random crashes...
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-CLOCK_DIVIDER*(adj+1),HOST_CCREG);
- emit_sub(HOST_CCREG,ECX,HOST_CCREG);
- emit_writeword(ECX,(int)&last_count);
- emit_storereg(CCREG,HOST_CCREG);
- restore_regs(reglist);
- if((cc=get_reg(regmap,CCREG))>=0) {
- emit_loadreg(CCREG,cc);
- }
- 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);
- }
-}
-
-do_writestub(int n)
-{
- assem_debug("do_writestub %x\n",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];
- u_int reglist=stubs[n][7];
- 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_indexedx8(ftable,addr,addr);
- if(type==STOREB_STUB)
- emit_writebyte(rt,(int)&byte);
- if(type==STOREH_STUB)
- emit_writehword(rt,(int)&hword);
- if(type==STOREW_STUB)
- emit_writeword(rt,(int)&word);
- if(type==STORED_STUB) {
- emit_writeword(rt,(int)&dword);
- emit_writeword(r?rth:rt,(int)&dword+4);
- }
- save_regs(reglist);
- 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,0);
- emit_add(cc,temp,cc);
- emit_writeword(cc,(int)&Count);
- emit_callreg(addr);
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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);
- restore_regs(reglist);
- if((cc=get_reg(i_regmap,CCREG))>=0) {
- emit_loadreg(CCREG,cc);
- }
- emit_jmp(stubs[n][2]); // return address
-}
-
-inline_writestub(int type, int i, u_int addr, signed char regmap[], int target, int adj, u_int reglist)
-{
- assem_debug("inline_writestub\n");
- 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)&byte);
- if(type==STOREH_STUB)
- emit_writehword(rt,(int)&hword);
- if(type==STOREW_STUB)
- emit_writeword(rt,(int)&word);
- if(type==STORED_STUB) {
- emit_writeword(rt,(int)&dword);
- emit_writeword(target?rth:rt,(int)&dword+4);
- }
- save_regs(reglist);
- 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)&Count);
- if((signed int)addr>=(signed int)0xC0000000) {
- // Pagefault address
- int ds=regmap!=regs[i].regmap;
- emit_writeword_imm_esp(start+i*4+(((regs[i].was32>>rs1[i])&1)<<1)+ds,0);
- }
- emit_call(((uint64_t *)ftable)[addr>>16]);
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-CLOCK_DIVIDER*(adj+1),HOST_CCREG);
- emit_sub(HOST_CCREG,ECX,HOST_CCREG);
- emit_writeword(ECX,(int)&last_count);
- emit_storereg(CCREG,HOST_CCREG);
- restore_regs(reglist);
- if((cc=get_reg(regmap,CCREG))>=0) {
- emit_loadreg(CCREG,cc);
- }
-}
-
-do_unalignedwritestub(int n)
-{
- set_jump_target(stubs[n][1],(int)out);
- output_byte(0xCC);
- emit_jmp(stubs[n][2]); // return address
-}
-
-void printregs(int edi,int esi,int ebp,int esp,int b,int d,int c,int a)
-{
- printf("regs: %x %x %x %x %x %x %x (%x)\n",a,b,c,d,ebp,esi,edi,(&edi)[-1]);
-}
-
-do_invstub(int n)
-{
- u_int reglist=stubs[n][3];
- set_jump_target(stubs[n][1],(int)out);
- save_regs(reglist);
- if(stubs[n][4]!=EDI) emit_mov(stubs[n][4],EDI);
- emit_call((int)&invalidate_block);
- restore_regs(reglist);
- emit_jmp(stubs[n][2]); // return address
-}
-
-int do_dirty_stub(int i)
-{
- assem_debug("do_dirty_stub %x\n",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_movimm(start+i*4,12);
- emit_call((int)start<(int)0xC0000000?(int)&verify_code:(int)&verify_code_vm);
- int entry=(int)out;
- load_regs_entry(i);
- if(entry==(int)out) entry=instr_addr[i];
- emit_jmp(instr_addr[i]);
- return entry;
-}
-
-void do_dirty_stub_ds()
-{
- emit_movimm((int)start<(int)0xC0000000?(int)source:(int)start,EAX);
- emit_movimm((int)copy,EBX);
- emit_movimm(slen*4,ECX);
- emit_movimm(start+1,12);
- emit_call((int)&verify_code_ds);
-}
-
-do_cop1stub(int n)
-{
- assem_debug("do_cop1stub %x\n",start+stubs[n][3]*4);
- set_jump_target(stubs[n][1],(int)out);
- int i=stubs[n][3];
- int rs=stubs[n][4];
- 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);
- //if(i_regs!=®s[i]) printf("oops: regs[i]=%x i_regs=%x",(int)®s[i],(int)i_regs);
- }
- //else {printf("fp exception in delay slot\n");}
- 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); // Get PC
- emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG); // CHECK: is this right? There should probably be an extra cycle...
- emit_jmp(ds?(int)fp_exception_ds:(int)fp_exception);
-}
-
-/* TLB */
-
-int do_tlb_r(int s,int ar,int map,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; // No mapping
- }
- else {
- if(s!=map) emit_mov(s,map);
- emit_shrimm(map,12,map);
- // Schedule this while we wait on the load
- //if(x) emit_xorimm(addr,x,addr);
- if(shift>=0) emit_lea8(s,shift);
- if(~a) emit_andimm(s,a,ar);
- emit_movmem_indexedx4((int)memory_map,map,map);
- }
- return map;
-}
-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;
-}
-
-int gen_tlb_addr_r(int ar, int map) {
- if(map>=0) {
- emit_leairrx4(0,ar,map,ar);
- }
-}
-
-int do_tlb_w(int s,int ar,int map,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; // No mapping
- }
- else {
- if(s!=map) emit_mov(s,map);
- //if(s!=ar) emit_mov(s,ar);
- emit_shrimm(map,12,map);
- // Schedule this while we wait on the load
- //if(x) emit_xorimm(s,x,addr);
- emit_movmem_indexedx4((int)memory_map,map,map);
- }
- emit_shlimm(map,2,map);
- return map;
-}
-int 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);
- }
-}
-
-int gen_tlb_addr_w(int ar, int map) {
- if(map>=0) {
- emit_leairrx1(0,ar,map,ar);
- }
-}
-
-// We don't need this for x86
-generate_map_const(u_int addr,int reg) {
- // void *mapaddr=memory_map+(addr>>12);
-}
-
-/* Special assem */
-
-void shift_assemble_x86(int i,struct regstat *i_regs)
-{
- if(rt1[i]) {
- if(opcode2[i]<=0x07) // SLLV/SRLV/SRAV
- {
- 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) // SLLV
- {
- emit_shlcl(t==ECX?shift:t);
- }
- if(opcode2[i]==6) // SRLV
- {
- emit_shrcl(t==ECX?shift:t);
- }
- if(opcode2[i]==7) // SRAV
- {
- emit_sarcl(t==ECX?shift:t);
- }
- if(shift!=ECX&&i_regs->regmap[ECX]>=0) emit_xchg(shift,ECX);
- }
- }
- } else { // DSLLV/DSRLV/DSRAV
- 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
- {
- // FIXME: What if shift==tl ?
- assert(shift!=tl);
- int temp=get_reg(i_regs->regmap,-1);
- int real_th=th;
- if(th<0&&opcode2[i]!=0x14) {th=temp;} // DSLLV doesn't need a temporary register
- 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) // DSLLV
- {
- 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) // DSRLV
- {
- 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) // DSRAV
- {
- 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
-
-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(tl>=0) {
- //assert(tl>=0);
- //assert(rt1[i]);
- if(!using_tlb) {
- if(!c) {
- emit_lea8(addr,temp);
- if (opcode[i]==0x22||opcode[i]==0x26) {
- emit_andimm(addr,0xFFFFFFFC,temp2); // LWL/LWR
- }else{
- emit_andimm(addr,0xFFFFFFF8,temp2); // LDL/LDR
- }
- 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); // LWL/LWR
- }else{
- emit_movimm(((constmap[i][s]+offset)<<3)&56,temp); // LDL/LDR
- }
- }
- }else{ // using tlb
- int a;
- if(c) {
- a=-1;
- }else if (opcode[i]==0x22||opcode[i]==0x26) {
- a=0xFFFFFFFC; // LWL/LWR
- }else{
- a=0xFFFFFFF8; // LDL/LDR
- }
- map=get_reg(i_regs->regmap,TLREG);
- assert(map>=0);
- map=do_tlb_r(addr,temp2,map,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); // LWL/LWR
- }else{
- emit_movimm(((constmap[i][s]+offset)<<3)&56,temp); // LDL/LDR
- }
- }
- do_tlb_r_branch(map,c,constmap[i][s]+offset,&jaddr);
- }
- if (opcode[i]==0x22||opcode[i]==0x26) { // LWL/LWR
- if(!c||memtarget) {
- //emit_readword_indexed((int)rdram-0x80000000,temp2,temp2);
- 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);
- emit_andimm(temp,24,temp);
- if (opcode[i]==0x26) emit_xorimm(temp,24,temp); // LWR
- 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);
- //emit_storereg(rt1[i],tl); // DEBUG
- }
- if (opcode[i]==0x1A||opcode[i]==0x1B) { // LDL/LDR
- 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) {
- //if(th>=0) emit_readword_indexed((int)rdram-0x80000000,temp2,temp2h);
- //emit_readword_indexed((int)rdram-0x7FFFFFFC,temp2,temp2);
- 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);
- emit_andimm(temp,56,temp);
- //output_byte(0xCC);
- //emit_pushreg(temp);
- //emit_pushreg(temp2h);
- //emit_pushreg(temp2);
- //emit_pushreg(th);
- //emit_pushreg(tl);
- emit_addimm64(ESP,-20,ESP);
- emit_writeword_indexed(temp,16,ESP);
- emit_writeword_indexed(temp2h,12,ESP);
- emit_writeword_indexed(temp2,8,ESP);
- emit_writeword_indexed(th,4,ESP);
- emit_writeword_indexed(tl,0,ESP);
- emit_mov(temp,EDX);
- emit_readdword_indexed(0,ESP,ARG1_REG);
- emit_readdword_indexed(8,ESP,ARG2_REG);
- if(opcode[i]==0x1A) emit_call((int)ldl_merge);
- if(opcode[i]==0x1B) emit_call((int)ldr_merge);
- emit_addimm64(ESP,20,ESP);
- if(th!=EAX) {
- emit_mov64(EAX,th);
- }
- emit_mov(EAX,tl);
- emit_shrimm64(th,32,th);
- 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
-
-void cop0_assemble(int i,struct regstat *i_regs)
-{
- if(opcode2[i]==0) // MFC0
- {
- signed char t=get_reg(i_regs->regmap,rt1[i]);
- char copr=(source[i]>>11)&0x1f;
- //assert(t>=0); // Why does this happen? OOT is weird
- if(t>=0) {
- emit_writedword_imm32((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); // TODO: do proper reg alloc
- emit_add(HOST_CCREG,ECX,HOST_CCREG);
- emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
- emit_writeword(HOST_CCREG,(int)&Count);
- }
- emit_call((int)MFC0);
- emit_readword((int)&readmem_dword,t);
- }
- }
- else if(opcode2[i]==4) // MTC0
- {
- 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);
- wb_register(rs1[i],i_regs->regmap,i_regs->dirty,i_regs->was32); // FIXME
- emit_writedword_imm32((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) {
- emit_readword((int)&last_count,ECX);
- emit_loadreg(CCREG,HOST_CCREG); // TODO: do proper reg alloc
- emit_add(HOST_CCREG,ECX,HOST_CCREG);
- emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
- emit_writeword(HOST_CCREG,(int)&Count);
- }
- // What a mess. The status register (12) can enable interrupts,
- // so needs a special case to handle a pending interrupt.
- // The interrupt must be taken immediately, because a subsequent
- // instruction might disable interrupts again.
- if(copr==12&&!is_delayslot) {
- emit_writeword_imm(start+i*4+4,(int)&pcaddr);
- emit_writebyte_imm(0,(int)&pending_exception);
- }
- //else if(copr==12&&is_delayslot) emit_call((int)MTC0_R12);
- //else
- emit_call((int)MTC0);
- if(copr==9||copr==11||copr==12) {
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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_loadreg(rs1[i],s);
- if(copr==12) {
- assert(!is_delayslot);
- //if(is_delayslot) output_byte(0xcc);
- 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) // TLBR
- emit_call((int)TLBR);
- if((source[i]&0x3f)==0x02) // TLBWI
- emit_call((int)TLBWI_new);
- if((source[i]&0x3f)==0x06) { // TLBWR
- // The TLB entry written by TLBWR is dependent on the count,
- // so update the cycle count
- 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)&Count);
- emit_call((int)TLBWR_new);
- }
- if((source[i]&0x3f)==0x08) // TLBP
- emit_call((int)TLBP);
- if((source[i]&0x3f)==0x18) // ERET
- {
- 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); // TODO: Should there be an extra cycle here?
- emit_jmp((int)jump_eret);
- }
- }
-}
-
-void cop1_assemble(int i,struct regstat *i_regs)
-{
- // Check cop1 unusable
- 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) { // MFC1
- 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) { // DMFC1
- 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) { // MTC1
- 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) { // DMTC1
- 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) // CFC1
- {
- 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) // CTC1
- {
- 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);
- // Set the rounding mode
- char temp=get_reg(i_regs->regmap,-1);
- emit_movimm(3,temp);
- emit_and(sl,temp,temp);
- emit_fldcw_indexed((int)&rounding_modes,temp);
- }
- }
-}
-
-void fconv_assemble_x86(int i,struct regstat *i_regs)
-{
- signed char temp=get_reg(i_regs->regmap,-1);
- assert(temp>=0);
- // Check cop1 unusable
- 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]==0x10&&(source[i]&0x3f)==0x0d) { // trunc_w_s
- emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
- emit_movss_load(temp,0);
- emit_cvttps2dq(0,0); // float->int, truncate
- 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) { // trunc_w_d
- emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
- emit_movsd_load(temp,0);
- emit_cvttpd2dq(0,0); // double->int, truncate
- emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
- emit_movd_store(0,temp);
- return;
- }
-
- if(opcode2[i]==0x14&&(source[i]&0x3f)==0x20) { // cvt_s_w
- 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) { // cvt_d_w
- 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) { // cvt_s_l
- 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) { // cvt_d_l
- 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) { // cvt_d_s
- 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) { // cvt_s_d
- 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) { // cvt_*_s
- emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
- emit_flds(temp);
- }
- if(opcode2[i]==0x11) { // cvt_*_d
- 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); //printf("round\n");
- if((source[i]&3)==1) emit_fldcw((int)&trunc_mode); //printf("trunc\n");
- if((source[i]&3)==2) emit_fldcw((int)&ceil_mode); //printf("ceil\n");
- if((source[i]&3)==3) emit_fldcw((int)&floor_mode); //printf("floor\n");
- }
- if((source[i]&0x3f)==0x24||(source[i]&0x3c)==0x0c) { // cvt_w_*
- 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) { // cvt_l_*
- 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;
-}
-#define fconv_assemble fconv_assemble_x86
-
-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);
- // Check cop1 unusable
- 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) {
- // sf/ngle - these should throw exceptions for NaNs
- 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); // c_un_s
- if((source[i]&0x3f)==0x32) {emit_cmovne_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_eq_s
- if((source[i]&0x3f)==0x33) emit_cmovne_reg(temp,fs); // c_ueq_s
- if((source[i]&0x3f)==0x34) {emit_cmovnc_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_olt_s
- if((source[i]&0x3f)==0x35) emit_cmovnc_reg(temp,fs); // c_ult_s
- if((source[i]&0x3f)==0x36) {emit_cmova_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_ole_s
- if((source[i]&0x3f)==0x37) emit_cmova_reg(temp,fs); // c_ule_s
- if((source[i]&0x3f)==0x3a) emit_cmovne_reg(temp,fs); // c_seq_s
- if((source[i]&0x3f)==0x3b) emit_cmovne_reg(temp,fs); // c_ngl_s
- if((source[i]&0x3f)==0x3c) emit_cmovnc_reg(temp,fs); // c_lt_s
- if((source[i]&0x3f)==0x3d) emit_cmovnc_reg(temp,fs); // c_nge_s
- if((source[i]&0x3f)==0x3e) emit_cmova_reg(temp,fs); // c_le_s
- if((source[i]&0x3f)==0x3f) emit_cmova_reg(temp,fs); // c_ngt_s
- 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); // c_un_d
- if((source[i]&0x3f)==0x32) {emit_cmovne_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_eq_d
- if((source[i]&0x3f)==0x33) emit_cmovne_reg(temp,fs); // c_ueq_d
- if((source[i]&0x3f)==0x34) {emit_cmovnc_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_olt_d
- if((source[i]&0x3f)==0x35) emit_cmovnc_reg(temp,fs); // c_ult_d
- if((source[i]&0x3f)==0x36) {emit_cmova_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_ole_d
- if((source[i]&0x3f)==0x37) emit_cmova_reg(temp,fs); // c_ule_d
- if((source[i]&0x3f)==0x3a) emit_cmovne_reg(temp,fs); // c_seq_d
- if((source[i]&0x3f)==0x3b) emit_cmovne_reg(temp,fs); // c_ngl_d
- if((source[i]&0x3f)==0x3c) emit_cmovnc_reg(temp,fs); // c_lt_d
- if((source[i]&0x3f)==0x3d) emit_cmovnc_reg(temp,fs); // c_nge_d
- if((source[i]&0x3f)==0x3e) emit_cmova_reg(temp,fs); // c_le_d
- if((source[i]&0x3f)==0x3f) emit_cmova_reg(temp,fs); // c_ngt_d
- return;
- }
-}
-
-void float_assemble(int i,struct regstat *i_regs)
-{
- signed char temp=get_reg(i_regs->regmap,-1);
- assert(temp>=0);
- // Check cop1 unusable
- 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) // mov
- {
- 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) // sqrt
- emit_fsqrt();
- if((source[i]&0x3f)==5) // abs
- emit_fabs();
- if((source[i]&0x3f)==7) // neg
- 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;
- }
-}
-
-void multdiv_assemble_x86(int i,struct regstat *i_regs)
-{
- // case 0x18: MULT
- // case 0x19: MULTU
- // case 0x1A: DIV
- // case 0x1B: DIVU
- // case 0x1C: DMULT
- // case 0x1D: DMULTU
- // case 0x1E: DDIV
- // case 0x1F: DDIVU
- if(rs1[i]&&rs2[i])
- {
- if((opcode2[i]&4)==0) // 32-bit
- {
- if(opcode2[i]==0x18) // MULT
- {
- 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) // MULTU
- {
- 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) // DIV
- {
- 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) // DIVU
- {
- 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 // 64-bit
- {
- if(opcode2[i]==0x1C) // DMULT
- {
- 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);
- output_byte(0xCC);
- 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) // DMULTU
- {
- 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);
- // DEBUG
- /*
- emit_pushreg(m2h);
- emit_pushreg(m2l);
- emit_pushreg(m1h);
- emit_pushreg(m1l);
- emit_call((int)&multu64);
- 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); // DEBUG
- if(hil>=0) emit_loadreg(HIREG,hil); // DEBUG
- */
- // Shouldn't be necessary
- //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]==0x1E) // DDIV
- {
- 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_pushreg(d2h);
- //emit_pushreg(d2l);
- //emit_pushreg(d1h);
- //emit_pushreg(d1l);
- emit_addimm64(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_readdword_indexed(0,ESP,ARG1_REG);
- emit_readdword_indexed(8,ESP,ARG2_REG);
- emit_call((int)&div64);
- //emit_popreg(d1l);
- //emit_popreg(d1h);
- //emit_popreg(d2l);
- //emit_popreg(d2h);
- 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_addimm64(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) // DDIVU
- {
- 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_pushreg(d2h);
- //emit_pushreg(d2l);
- //emit_pushreg(d1h);
- //emit_pushreg(d1l);
- emit_addimm64(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_readdword_indexed(0,ESP,ARG1_REG);
- emit_readdword_indexed(8,ESP,ARG2_REG);
- emit_call((int)&divu64);
- //emit_popreg(d1l);
- //emit_popreg(d1h);
- //emit_popreg(d2l);
- //emit_popreg(d2h);
- 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_addimm64(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
- {
- // Multiply by zero is zero.
- // MIPS does not have a divide by zero exception.
- // The result is undefined, we return zero.
- 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
-
-void do_preload_rhash(int r) {
- emit_movimm(0xf8,r);
-}
-
-void do_preload_rhtbl(int r) {
- // Don't need this for x86
-}
-
-void do_rhash(int rs,int rh) {
- emit_and(rs,rh,rh);
-}
-
-void do_miniht_load(int ht,int rh) {
- // Don't need this for x86. The load and compare can be combined into
- // a single instruction (below)
-}
-
-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_readword_indexed((int)mini_ht+4,rh,rh);
- emit_jmpreg(rh);
-}
-
-void do_miniht_insert(int return_address,int rt,int temp) {
- emit_movimm(return_address,rt); // PC into link register
- //emit_writeword_imm(return_address,(int)&mini_ht[(return_address&0xFF)>>8][0]);
- 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]);
-}
-
-// We don't need this for x86
-void literal_pool(int n) {}
-void literal_pool_jumpover(int n) {}
-
-// CPU-architecture-specific initialization, not needed for x86
-void arch_init() {}
+++ /dev/null
-#define HOST_REGS 8
-#define HOST_CCREG 6
-#define HOST_BTREG 5
-#define EXCLUDE_REG 4
-
-//#define IMM_PREFETCH 1
-#define HOST_IMM_ADDR32 1
-#define INVERTED_CARRY 1
-#define DESTRUCTIVE_WRITEBACK 1
-#define DESTRUCTIVE_SHIFT 1
-
-#define USE_MINI_HT 1
-
-#define BASE_ADDR 0x70000000 // Code generator target address
-#define TARGET_SIZE_2 25 // 2^25 = 32 megabytes
-
-#define ROM_COPY ((void *)0x78000000) // For Goldeneye hack
-
-/* x86-64 calling convention:
- func(rdi, rsi, rdx, rcx, r8, r9) {return rax;}
- callee-save: %rbp %rbx %r12-%r15 */
-
-#define ARG1_REG 7 /* RDI */
-#define ARG2_REG 6 /* RSI */
+++ /dev/null
-/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
- * Mupen64plus - assem_x86.c *
- * Copyright (C) 2009-2010 Ari64 *
- * *
- * This program is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 2 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with this program; if not, write to the *
- * Free Software Foundation, Inc., *
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. *
- * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
-
-int cycle_count;
-int last_count;
-int pcaddr;
-int pending_exception;
-int branch_target;
-uint64_t readmem_dword;
-precomp_instr fake_pc;
-u_int memory_map[1048576];
-u_int mini_ht[32][2] __attribute__((aligned(8)));
-u_char restore_candidate[512] __attribute__((aligned(4)));
-
-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();
-
-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 };
-
-const u_short rounding_modes[4] = {
- 0x33F, // round
- 0xF3F, // trunc
- 0xB3F, // ceil
- 0x73F};// floor
-
-#include "fpu.h"
-
-// We need these for cmovcc instructions on x86
-u_int const_zero=0;
-u_int const_one=1;
-
-/* Linker */
-
-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); /* mov immediate (store address) */
- u_int *ptr2=(u_int *)(ptr+6);
- *ptr2=target;
- }
-}
-
-void kill_pointer(void *stub)
-{
- int *i_ptr=*((int **)(stub+6));
- *i_ptr=(int)stub-(int)i_ptr-4;
-}
-int get_pointer(void *stub)
-{
- int *i_ptr=*((int **)(stub+6));
- return *i_ptr+(int)i_ptr+4;
-}
-
-// Find the "clean" entry point from a "dirty" entry point
-// by skipping past the call to verify_code
-u_int get_clean_addr(int addr)
-{
- u_char *ptr=(u_char *)addr;
- assert(ptr[20]==0xE8); // call instruction
- assert(ptr[25]==0x83); // pop (add esp,4) instruction
- if(ptr[28]==0xE9) return *(u_int *)(ptr+29)+addr+33; // follow jmp
- else return(addr+28);
-}
-
-int verify_dirty(int 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); // call instruction
- 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);
- }
- //printf("verify_dirty: %x %x %x\n",source,copy,len);
- return !memcmp((void *)source,(void *)copy,len);
-}
-
-// This doesn't necessarily find all clean entry points, just
-// guarantees that it's not dirty
-int isclean(int addr)
-{
- u_char *ptr=(u_char *)addr;
- if(ptr[5]!=0xB8) return 1; // mov imm,%eax
- if(ptr[10]!=0xBB) return 1; // mov imm,%ebx
- if(ptr[15]!=0xB9) return 1; // mov imm,%ecx
- if(ptr[20]!=0xE8) return 1; // call instruction
- if(ptr[25]!=0x83) return 1; // pop (add esp,4) instruction
- return 0;
-}
-
-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 copy=*(u_int *)(ptr+11);
- u_int len=*(u_int *)(ptr+16);
- assert(ptr[20]==0xE8); // call instruction
- 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;
-}
-
-/* Register allocation */
-
-// Note: registers are allocated clean (unmodified state)
-// if you intend to modify the register, you must call dirty_reg().
-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);
-
- // Don't allocate unused registers
- if((cur->u>>reg)&1) return;
-
- // see if it's already allocated
- for(hr=0;hr<HOST_REGS;hr++)
- {
- if(cur->regmap[hr]==reg) return;
- }
-
- // Keep the same mapping if the register was already allocated in a loop
- preferred_reg = loop_reg(i,reg,preferred_reg);
-
- // Try to allocate the preferred register
- 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;
- }
-
- // Try to allocate EAX, EBX, ECX, or EDX
- // We prefer these because they can do byte and halfword loads
- for(hr=0;hr<4;hr++) {
- if(cur->regmap[hr]==-1) {
- cur->regmap[hr]=reg;
- cur->dirty&=~(1<<hr);
- cur->isconst&=~(1<<hr);
- return;
- }
- }
-
- // Clear any unneeded registers
- // We try to keep the mapping consistent, if possible, because it
- // makes branches easier (especially loops). So we try to allocate
- // first (see above) before removing old mappings. If this is not
- // possible then go ahead and clear out the registers that are no
- // longer needed.
- 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;}
- }
- }
- }
- // Try to allocate any available register, but prefer
- // registers that have not been used recently.
- 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;
- }
- }
- }
- }
- // Try to allocate any available register
- 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;
- }
- }
-
- // Ok, now we have to evict someone
- // Pick a register we hopefully won't need soon
- u_char hsn[MAXREG+1];
- memset(hsn,10,sizeof(hsn));
- int j;
- lsn(hsn,i,&preferred_reg);
- //printf("hsn(%x): %d %d %d %d %d %d %d\n",start+i*4,hsn[cur->regmap[0]&63],hsn[cur->regmap[1]&63],hsn[cur->regmap[2]&63],hsn[cur->regmap[3]&63],hsn[cur->regmap[5]&63],hsn[cur->regmap[6]&63],hsn[cur->regmap[7]&63]);
- if(i>0) {
- // Don't evict the cycle count at entry points, otherwise the entry
- // stub will have to write it.
- 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--)
- {
- // Alloc preferred register if available
- if(hsn[r=cur->regmap[preferred_reg]&63]==j) {
- for(hr=0;hr<HOST_REGS;hr++) {
- // Evict both parts of a 64-bit register
- 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;
- }
- }
- }
- }
- }
- printf("This shouldn't happen (alloc_reg)");exit(1);
-}
-
-void alloc_reg64(struct regstat *cur,int i,signed char reg)
-{
- int preferred_reg = 5+reg%3;
- int r,hr;
-
- // allocate the lower 32 bits
- alloc_reg(cur,i,reg);
-
- // Don't allocate unused registers
- if((cur->uu>>reg)&1) return;
-
- // see if the upper half is already allocated
- for(hr=0;hr<HOST_REGS;hr++)
- {
- if(cur->regmap[hr]==reg+64) return;
- }
-
- // Keep the same mapping if the register was already allocated in a loop
- preferred_reg = loop_reg(i,reg,preferred_reg);
-
- // Try to allocate the preferred register
- 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;
- }
-
- // Try to allocate EBP, ESI or EDI
- 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;
- }
- }
-
- // Clear any unneeded registers
- // We try to keep the mapping consistent, if possible, because it
- // makes branches easier (especially loops). So we try to allocate
- // first (see above) before removing old mappings. If this is not
- // possible then go ahead and clear out the registers that are no
- // longer needed.
- 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;}
- }
- }
- }
- // Try to allocate any available register, but prefer
- // registers that have not been used recently.
- 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;
- }
- }
- }
- }
- // Try to allocate any available register
- 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;
- }
- }
-
- // Ok, now we have to evict someone
- // Pick a register we hopefully won't need soon
- u_char hsn[MAXREG+1];
- memset(hsn,10,sizeof(hsn));
- int j;
- lsn(hsn,i,&preferred_reg);
- //printf("eax=%d ecx=%d edx=%d ebx=%d ebp=%d esi=%d edi=%d\n",cur->regmap[0],cur->regmap[1],cur->regmap[2],cur->regmap[3],cur->regmap[5],cur->regmap[6],cur->regmap[7]);
- //printf("hsn(%x): %d %d %d %d %d %d %d\n",start+i*4,hsn[cur->regmap[0]&63],hsn[cur->regmap[1]&63],hsn[cur->regmap[2]&63],hsn[cur->regmap[3]&63],hsn[cur->regmap[5]&63],hsn[cur->regmap[6]&63],hsn[cur->regmap[7]&63]);
- if(i>0) {
- // Don't evict the cycle count at entry points, otherwise the entry
- // stub will have to write it.
- 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--)
- {
- // Alloc preferred register if available
- if(hsn[r=cur->regmap[preferred_reg]&63]==j) {
- for(hr=0;hr<HOST_REGS;hr++) {
- // Evict both parts of a 64-bit register
- 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;
- }
- }
- }
- }
- }
- printf("This shouldn't happen");exit(1);
-}
-
-// Allocate a temporary register. This is done without regard to
-// dirty status or whether the register we request is on the unneeded list
-// Note: This will only allocate one register, even if called multiple times
-void alloc_reg_temp(struct regstat *cur,int i,signed char reg)
-{
- int r,hr;
- int preferred_reg = -1;
-
- // see if it's already allocated
- for(hr=0;hr<HOST_REGS;hr++)
- {
- if(hr!=EXCLUDE_REG&&cur->regmap[hr]==reg) return;
- }
-
- // Try to allocate any available register, starting with EDI, ESI, EBP...
- // We prefer EDI, ESI, EBP since the others are used for byte/halfword stores
- 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;
- }
- }
-
- // Find an unneeded register
- 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;
- }
- }
- }
- }
- }
-
- // Ok, now we have to evict someone
- // Pick a register we hopefully won't need soon
- // TODO: we might want to follow unconditional jumps here
- // TODO: get rid of dupe code and make this into a function
- u_char hsn[MAXREG+1];
- memset(hsn,10,sizeof(hsn));
- int j;
- lsn(hsn,i,&preferred_reg);
- //printf("hsn: %d %d %d %d %d %d %d\n",hsn[cur->regmap[0]&63],hsn[cur->regmap[1]&63],hsn[cur->regmap[2]&63],hsn[cur->regmap[3]&63],hsn[cur->regmap[5]&63],hsn[cur->regmap[6]&63],hsn[cur->regmap[7]&63]);
- if(i>0) {
- // Don't evict the cycle count at entry points, otherwise the entry
- // stub will have to write it.
- 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;
- }
- }
- }
- }
- }
- printf("This shouldn't happen");exit(1);
-}
-// Allocate a specific x86 register.
-void alloc_x86_reg(struct regstat *cur,int i,signed char reg,char hr)
-{
- int n;
-
- // see if it's already allocated (and dealloc it)
- for(n=0;n<HOST_REGS;n++)
- {
- if(n!=ESP&&cur->regmap[n]==reg) {cur->regmap[n]=-1;}
- }
-
- cur->regmap[hr]=reg;
- cur->dirty&=~(1<<hr);
- cur->isconst&=~(1<<hr);
-}
-
-// Alloc cycle count into dedicated register
-alloc_cc(struct regstat *cur,int i)
-{
- alloc_x86_reg(cur,i,CCREG,ESI);
-}
-
-/* Special alloc */
-
-void multdiv_alloc_x86(struct regstat *current,int i)
-{
- // case 0x18: MULT
- // case 0x19: MULTU
- // case 0x1A: DIV
- // case 0x1B: DIVU
- // case 0x1C: DMULT
- // case 0x1D: DMULTU
- // case 0x1E: DDIV
- // case 0x1F: DDIVU
- clear_const(current,rs1[i]);
- clear_const(current,rs2[i]);
- if(rs1[i]&&rs2[i])
- {
- if((opcode2[i]&4)==0) // 32-bit
- {
- 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 // 64-bit
- {
- 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
- {
- // Multiply by zero is zero.
- // MIPS does not have a divide by zero exception.
- // The result is undefined, we return zero.
- 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
-
-/* Assembler */
-
-char regname[8][4] = {
- "eax",
- "ecx",
- "edx",
- "ebx",
- "esp",
- "ebp",
- "esi",
- "edi"};
-
-void output_byte(u_char byte)
-{
- *(out++)=byte;
-}
-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;
-}
-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;
-}
-void output_w32(u_int word)
-{
- *((u_int *)out)=word;
- out+=4;
-}
-
-void emit_mov(int rs,int rt)
-{
- assem_debug("mov %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x89);
- output_modrm(3,rt,rs);
-}
-
-void emit_add(int rs1,int rs2,int rt)
-{
- if(rs1==rt) {
- assem_debug("add %%%s,%%%s\n",regname[rs2],regname[rs1]);
- output_byte(0x01);
- output_modrm(3,rs1,rs2);
- }else if(rs2==rt) {
- assem_debug("add %%%s,%%%s\n",regname[rs1],regname[rs2]);
- output_byte(0x01);
- output_modrm(3,rs2,rs1);
- }else {
- assem_debug("lea (%%%s,%%%s),%%%s\n",regname[rs1],regname[rs2],regname[rt]);
- output_byte(0x8D);
- if(rs1!=EBP) {
- output_modrm(0,4,rt);
- output_sib(0,rs2,rs1);
- }else if(rs2!=EBP) {
- output_modrm(0,4,rt);
- output_sib(0,rs1,rs2);
- }else /* lea 0(,%ebp,2) */{
- output_modrm(0,4,rt);
- output_sib(1,EBP,5);
- output_w32(0);
- }
- }
-}
-
-void emit_adds(int rs1,int rs2,int rt)
-{
- emit_add(rs1,rs2,rt);
-}
-
-void emit_lea8(int rs1,int rt)
-{
- assem_debug("lea 0(%%%s,8),%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x8D);
- output_modrm(0,4,rt);
- output_sib(3,rs1,5);
- output_w32(0);
-}
-void emit_leairrx1(int imm,int rs1,int rs2,int rt)
-{
- assem_debug("lea %x(%%%s,%%%s,1),%%%s\n",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);
- }
-}
-void emit_leairrx4(int imm,int rs1,int rs2,int rt)
-{
- assem_debug("lea %x(%%%s,%%%s,4),%%%s\n",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);
- }
-}
-
-void emit_neg(int rs, int rt)
-{
- if(rs!=rt) emit_mov(rs,rt);
- assem_debug("neg %%%s\n",regname[rt]);
- output_byte(0xF7);
- output_modrm(3,rt,3);
-}
-
-void emit_negs(int rs, int rt)
-{
- emit_neg(rs,rt);
-}
-
-void emit_sub(int rs1,int rs2,int rt)
-{
- if(rs1==rt) {
- assem_debug("sub %%%s,%%%s\n",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);
- }
-}
-
-void emit_subs(int rs1,int rs2,int rt)
-{
- emit_sub(rs1,rs2,rt);
-}
-
-void emit_zeroreg(int rt)
-{
- output_byte(0x31);
- output_modrm(3,rt,rt);
- assem_debug("xor %%%s,%%%s\n",regname[rt],regname[rt]);
-}
-
-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)&Status;
- if(r==FSREG) addr=(int)&FCR31;
- assem_debug("mov %x+%d,%%%s\n",addr,r,regname[hr]);
- output_byte(0x8B);
- output_modrm(0,5,hr);
- output_w32(addr);
- }
-}
-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\n",regname[hr],addr,r);
- output_byte(0x89);
- output_modrm(0,5,hr);
- output_w32(addr);
-}
-
-void emit_test(int rs, int rt)
-{
- assem_debug("test %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x85);
- output_modrm(3,rs,rt);
-}
-
-void emit_testimm(int rs,int imm)
-{
- assem_debug("test $0x%x,%%%s\n",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);
- }
-}
-
-void emit_not(int rs,int rt)
-{
- if(rs!=rt) emit_mov(rs,rt);
- assem_debug("not %%%s\n",regname[rt]);
- output_byte(0xF7);
- output_modrm(3,rt,2);
-}
-
-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\n",regname[rs2],regname[rt]);
- output_byte(0x21);
- output_modrm(3,rs1,rs2);
- }
- else
- if(rs2==rt) {
- assem_debug("and %%%s,%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x21);
- output_modrm(3,rs2,rs1);
- }
- else {
- emit_mov(rs1,rt);
- emit_and(rt,rs2,rt);
- }
-}
-
-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\n",regname[rs2],regname[rt]);
- output_byte(0x09);
- output_modrm(3,rs1,rs2);
- }
- else
- if(rs2==rt) {
- assem_debug("or %%%s,%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x09);
- output_modrm(3,rs2,rs1);
- }
- else {
- emit_mov(rs1,rt);
- emit_or(rt,rs2,rt);
- }
-}
-void emit_or_and_set_flags(int rs1,int rs2,int rt)
-{
- emit_or(rs1,rs2,rt);
-}
-
-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\n",regname[rs2],regname[rt]);
- output_byte(0x31);
- output_modrm(3,rs1,rs2);
- }
- else
- if(rs2==rt) {
- assem_debug("xor %%%s,%%%s\n",regname[rs1],regname[rt]);
- output_byte(0x31);
- output_modrm(3,rs2,rs1);
- }
- else {
- emit_mov(rs1,rt);
- emit_xor(rt,rs2,rt);
- }
-}
-
-void emit_movimm(int imm,u_int rt)
-{
- assem_debug("mov $%d,%%%s\n",imm,regname[rt]);
- assert(rt<8);
- output_byte(0xB8+rt);
- output_w32(imm);
-}
-
-void emit_addimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- if(imm!=0) {
- assem_debug("add $%d,%%%s\n",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\n",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);
- }
- }
-}
-
-void emit_addimm_and_set_flags(int imm,int rt)
-{
- assem_debug("add $%d,%%%s\n",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);
- }
-}
-void emit_addimm_no_flags(int imm,int rt)
-{
- if(imm!=0) {
- assem_debug("lea %d(%%%s),%%%s\n",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);
- }
- }
-}
-
-void emit_adcimm(int imm,u_int rt)
-{
- assem_debug("adc $%d,%%%s\n",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);
- }
-}
-void emit_sbbimm(int imm,u_int rt)
-{
- assem_debug("sbb $%d,%%%s\n",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);
- }
-}
-
-void emit_addimm64_32(int rsh,int rsl,int imm,int rth,int rtl)
-{
- if(rsh==rth&&rsl==rtl) {
- assem_debug("add $%d,%%%s\n",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\n",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);
- }
-}
-
-void emit_sbb(int rs1,int rs2)
-{
- assem_debug("sbb %%%s,%%%s\n",regname[rs2],regname[rs1]);
- output_byte(0x19);
- output_modrm(3,rs1,rs2);
-}
-
-void emit_andimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("and $%d,%%%s\n",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);
- }
-}
-
-void emit_orimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("or $%d,%%%s\n",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);
- }
-}
-
-void emit_xorimm(int rs,int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("xor $%d,%%%s\n",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);
- }
-}
-
-void emit_shlimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shl %%%s,%d\n",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);
- }
-}
-
-void emit_shrimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shr %%%s,%d\n",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);
- }
-}
-
-void emit_sarimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("sar %%%s,%d\n",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);
- }
-}
-
-void emit_rorimm(int rs,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("ror %%%s,%d\n",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_sarimm(rt,imm,rt);
- }
-}
-
-void emit_shldimm(int rs,int rs2,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shld %%%s,%%%s,%d\n",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);
- }
-}
-
-void emit_shrdimm(int rs,int rs2,u_int imm,int rt)
-{
- if(rs==rt) {
- assem_debug("shrd %%%s,%%%s,%d\n",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);
- }
-}
-
-void emit_shlcl(int r)
-{
- assem_debug("shl %%%s,%%cl\n",regname[r]);
- output_byte(0xD3);
- output_modrm(3,r,4);
-}
-void emit_shrcl(int r)
-{
- assem_debug("shr %%%s,%%cl\n",regname[r]);
- output_byte(0xD3);
- output_modrm(3,r,5);
-}
-void emit_sarcl(int r)
-{
- assem_debug("sar %%%s,%%cl\n",regname[r]);
- output_byte(0xD3);
- output_modrm(3,r,7);
-}
-
-void emit_shldcl(int r1,int r2)
-{
- assem_debug("shld %%%s,%%%s,%%cl\n",regname[r1],regname[r2]);
- output_byte(0x0F);
- output_byte(0xA5);
- output_modrm(3,r1,r2);
-}
-void emit_shrdcl(int r1,int r2)
-{
- assem_debug("shrd %%%s,%%%s,%%cl\n",regname[r1],regname[r2]);
- output_byte(0x0F);
- output_byte(0xAD);
- output_modrm(3,r1,r2);
-}
-
-void emit_cmpimm(int rs,int imm)
-{
- assem_debug("cmp $%d,%%%s\n",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);
- }
-}
-
-void emit_cmovne(u_int *addr,int rt)
-{
- assem_debug("cmovne %x,%%%s",(int)addr,regname[rt]);
- if(addr==&const_zero) assem_debug(" [zero]\n");
- else if(addr==&const_one) assem_debug(" [one]\n");
- else assem_debug("\n");
- output_byte(0x0F);
- output_byte(0x45);
- output_modrm(0,5,rt);
- output_w32((int)addr);
-}
-void emit_cmovl(u_int *addr,int rt)
-{
- assem_debug("cmovl %x,%%%s",(int)addr,regname[rt]);
- if(addr==&const_zero) assem_debug(" [zero]\n");
- else if(addr==&const_one) assem_debug(" [one]\n");
- else assem_debug("\n");
- output_byte(0x0F);
- output_byte(0x4C);
- output_modrm(0,5,rt);
- output_w32((int)addr);
-}
-void emit_cmovs(u_int *addr,int rt)
-{
- assem_debug("cmovs %x,%%%s",(int)addr,regname[rt]);
- if(addr==&const_zero) assem_debug(" [zero]\n");
- else if(addr==&const_one) assem_debug(" [one]\n");
- else assem_debug("\n");
- output_byte(0x0F);
- output_byte(0x48);
- output_modrm(0,5,rt);
- output_w32((int)addr);
-}
-void emit_cmovne_reg(int rs,int rt)
-{
- assem_debug("cmovne %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x45);
- output_modrm(3,rs,rt);
-}
-void emit_cmovl_reg(int rs,int rt)
-{
- assem_debug("cmovl %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x4C);
- output_modrm(3,rs,rt);
-}
-void emit_cmovs_reg(int rs,int rt)
-{
- assem_debug("cmovs %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x48);
- output_modrm(3,rs,rt);
-}
-void emit_cmovnc_reg(int rs,int rt)
-{
- assem_debug("cmovae %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x43);
- output_modrm(3,rs,rt);
-}
-void emit_cmova_reg(int rs,int rt)
-{
- assem_debug("cmova %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x47);
- output_modrm(3,rs,rt);
-}
-void emit_cmovp_reg(int rs,int rt)
-{
- assem_debug("cmovp %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x4A);
- output_modrm(3,rs,rt);
-}
-void emit_cmovnp_reg(int rs,int rt)
-{
- assem_debug("cmovnp %%%s,%%%s\n",regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0x4B);
- output_modrm(3,rs,rt);
-}
-void emit_setl(int rt)
-{
- assem_debug("setl %%%s\n",regname[rt]);
- output_byte(0x0F);
- output_byte(0x9C);
- output_modrm(3,rt,2);
-}
-void emit_movzbl_reg(int rs, int rt)
-{
- assem_debug("movzbl %%%s,%%%s\n",regname[rs]+1,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(3,rs,rt);
-}
-
-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);
- }
-}
-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);
-}
-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);
- }
-}
-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);
- }
-}
-
-void emit_cmp(int rs,int rt)
-{
- assem_debug("cmp %%%s,%%%s\n",regname[rt],regname[rs]);
- output_byte(0x39);
- output_modrm(3,rs,rt);
-}
-void emit_set_gz32(int rs, int rt)
-{
- //assem_debug("set_gz32\n");
- emit_cmpimm(rs,1);
- emit_movimm(1,rt);
- emit_cmovl(&const_zero,rt);
-}
-void emit_set_nz32(int rs, int rt)
-{
- //assem_debug("set_nz32\n");
- emit_cmpimm(rs,1);
- emit_movimm(1,rt);
- emit_sbbimm(0,rt);
-}
-void emit_set_gz64_32(int rsh, int rsl, int rt)
-{
- //assem_debug("set_gz64\n");
- emit_set_gz32(rsl,rt);
- emit_test(rsh,rsh);
- emit_cmovne(&const_one,rt);
- emit_cmovs(&const_zero,rt);
-}
-void emit_set_nz64_32(int rsh, int rsl, int rt)
-{
- //assem_debug("set_nz64\n");
- emit_or_and_set_flags(rsh,rsl,rt);
- emit_cmovne(&const_one,rt);
-}
-void emit_set_if_less32(int rs1, int rs2, int rt)
-{
- //assem_debug("set if less (%%%s,%%%s),%%%s\n",regname[rs1],regname[rs2],regname[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);
-}
-void emit_set_if_carry32(int rs1, int rs2, int rt)
-{
- //assem_debug("set if carry (%%%s,%%%s),%%%s\n",regname[rs1],regname[rs2],regname[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);
-}
-void emit_set_if_less64_32(int u1, int l1, int u2, int l2, int rt)
-{
- //assem_debug("set if less64 (%%%s,%%%s,%%%s,%%%s),%%%s\n",regname[u1],regname[l1],regname[u2],regname[l2],regname[rt]);
- assert(u1!=rt);
- assert(u2!=rt);
- emit_cmp(l1,l2);
- emit_mov(u1,rt);
- emit_sbb(rt,u2);
- emit_movimm(0,rt);
- emit_cmovl(&const_one,rt);
-}
-void emit_set_if_carry64_32(int u1, int l1, int u2, int l2, int rt)
-{
- //assem_debug("set if carry64 (%%%s,%%%s,%%%s,%%%s),%%%s\n",regname[u1],regname[l1],regname[u2],regname[l2],regname[rt]);
- assert(u1!=rt);
- assert(u2!=rt);
- emit_cmp(l1,l2);
- emit_mov(u1,rt);
- emit_sbb(rt,u2);
- emit_movimm(0,rt);
- emit_adcimm(0,rt);
-}
-
-void emit_call(int a)
-{
- assem_debug("call %x (%x+%x)\n",a,(int)out+5,a-(int)out-5);
- output_byte(0xe8);
- output_w32(a-(int)out-4);
-}
-void emit_jmp(int a)
-{
- assem_debug("jmp %x (%x+%x)\n",a,(int)out+5,a-(int)out-5);
- output_byte(0xe9);
- output_w32(a-(int)out-4);
-}
-void emit_jne(int a)
-{
- assem_debug("jne %x\n",a);
- output_byte(0x0f);
- output_byte(0x85);
- output_w32(a-(int)out-4);
-}
-void emit_jeq(int a)
-{
- assem_debug("jeq %x\n",a);
- output_byte(0x0f);
- output_byte(0x84);
- output_w32(a-(int)out-4);
-}
-void emit_js(int a)
-{
- assem_debug("js %x\n",a);
- output_byte(0x0f);
- output_byte(0x88);
- output_w32(a-(int)out-4);
-}
-void emit_jns(int a)
-{
- assem_debug("jns %x\n",a);
- output_byte(0x0f);
- output_byte(0x89);
- output_w32(a-(int)out-4);
-}
-void emit_jl(int a)
-{
- assem_debug("jl %x\n",a);
- output_byte(0x0f);
- output_byte(0x8c);
- output_w32(a-(int)out-4);
-}
-void emit_jge(int a)
-{
- assem_debug("jge %x\n",a);
- output_byte(0x0f);
- output_byte(0x8d);
- output_w32(a-(int)out-4);
-}
-void emit_jno(int a)
-{
- assem_debug("jno %x\n",a);
- output_byte(0x0f);
- output_byte(0x81);
- output_w32(a-(int)out-4);
-}
-void emit_jc(int a)
-{
- assem_debug("jc %x\n",a);
- output_byte(0x0f);
- output_byte(0x82);
- output_w32(a-(int)out-4);
-}
-
-void emit_pushimm(int imm)
-{
- assem_debug("push $%x\n",imm);
- output_byte(0x68);
- output_w32(imm);
-}
-void emit_pushmem(int addr)
-{
- assem_debug("push *%x\n",addr);
- output_byte(0xFF);
- output_modrm(0,5,6);
- output_w32(addr);
-}
-void emit_pusha()
-{
- assem_debug("pusha\n");
- output_byte(0x60);
-}
-void emit_popa()
-{
- assem_debug("popa\n");
- output_byte(0x61);
-}
-void emit_pushreg(u_int r)
-{
- assem_debug("push %%%s\n",regname[r]);
- assert(r<8);
- output_byte(0x50+r);
-}
-void emit_popreg(u_int r)
-{
- assem_debug("pop %%%s\n",regname[r]);
- assert(r<8);
- output_byte(0x58+r);
-}
-void emit_callreg(u_int r)
-{
- assem_debug("call *%%%s\n",regname[r]);
- assert(r<8);
- output_byte(0xFF);
- output_modrm(3,r,2);
-}
-void emit_jmpreg(u_int r)
-{
- assem_debug("jmp *%%%s\n",regname[r]);
- assert(r<8);
- output_byte(0xFF);
- output_modrm(3,r,4);
-}
-void emit_jmpmem_indexed(u_int addr,u_int r)
-{
- assem_debug("jmp *%x(%%%s)\n",addr,regname[r]);
- assert(r<8);
- output_byte(0xFF);
- output_modrm(2,r,4);
- output_w32(addr);
-}
-
-void emit_readword(int addr, int rt)
-{
- assem_debug("mov %x,%%%s\n",addr,regname[rt]);
- output_byte(0x8B);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_readword_indexed(int addr, int rs, int rt)
-{
- assem_debug("mov %x+%%%s,%%%s\n",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);
- }
-}
-void emit_readword_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_readword(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("mov (%x,%%%s,4),%%%s\n",addr+(int)rdram-0x80000000,regname[map],regname[rt]);
- output_byte(0x8B);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr+(int)rdram-0x80000000);
- }
-}
-void emit_readword_indexed_tlb(int addr, int rs, int map, int rt)
-{
- if(map<0) emit_readword_indexed(addr+(int)rdram-0x80000000, rs, rt);
- else {
- assem_debug("mov %x(%%%s,%%%s,4),%%%s\n",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);
- }
- }
-}
-void emit_movmem_indexedx4(int addr, int rs, int rt)
-{
- assem_debug("mov (%x,%%%s,4),%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x8B);
- output_modrm(0,4,rt);
- output_sib(2,rs,5);
- output_w32(addr);
-}
-void emit_readdword_tlb(int addr, int map, int rh, int rl)
-{
- if(map<0) {
- if(rh>=0) emit_readword(addr+(int)rdram-0x80000000, rh);
- emit_readword(addr+(int)rdram-0x7FFFFFFC, rl);
- }
- else {
- if(rh>=0) emit_movmem_indexedx4(addr+(int)rdram-0x80000000, map, rh);
- emit_movmem_indexedx4(addr+(int)rdram-0x7FFFFFFC, map, rl);
- }
-}
-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);
-}
-void emit_movsbl(int addr, int rt)
-{
- assem_debug("movsbl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xBE);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_movsbl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movsbl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xBE);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movsbl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movsbl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("movsbl (%x,%%%s,4),%%%s\n",addr+(int)rdram-0x80000000,regname[map],regname[rt]);
- output_byte(0x0F);
- output_byte(0xBE);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr+(int)rdram-0x80000000);
- }
-}
-void emit_movsbl_indexed_tlb(int addr, int rs, int map, int rt)
-{
- if(map<0) emit_movsbl_indexed(addr+(int)rdram-0x80000000, rs, rt);
- else {
- assem_debug("movsbl %x(%%%s,%%%s,4),%%%s\n",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);
- }
- }
-}
-void emit_movswl(int addr, int rt)
-{
- assem_debug("movswl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xBF);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_movswl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movswl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xBF);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movswl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movswl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("movswl (%x,%%%s,4),%%%s\n",addr+(int)rdram-0x80000000,regname[map],regname[rt]);
- output_byte(0x0F);
- output_byte(0xBF);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr+(int)rdram-0x80000000);
- }
-}
-void emit_movzbl(int addr, int rt)
-{
- assem_debug("movzbl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_movzbl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movzbl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movzbl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movzbl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("movzbl (%x,%%%s,4),%%%s\n",addr+(int)rdram-0x80000000,regname[map],regname[rt]);
- output_byte(0x0F);
- output_byte(0xB6);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr+(int)rdram-0x80000000);
- }
-}
-void emit_movzbl_indexed_tlb(int addr, int rs, int map, int rt)
-{
- if(map<0) emit_movzbl_indexed(addr+(int)rdram-0x80000000, rs, rt);
- else {
- assem_debug("movzbl %x(%%%s,%%%s,4),%%%s\n",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);
- }
- }
-}
-void emit_movzwl(int addr, int rt)
-{
- assem_debug("movzwl %x,%%%s\n",addr,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_movzwl_indexed(int addr, int rs, int rt)
-{
- assem_debug("movzwl %x+%%%s,%%%s\n",addr,regname[rs],regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-void emit_movzwl_tlb(int addr, int map, int rt)
-{
- if(map<0) emit_movzwl(addr+(int)rdram-0x80000000, rt);
- else
- {
- assem_debug("movzwl (%x,%%%s,4),%%%s\n",addr+(int)rdram-0x80000000,regname[map],regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(0,4,rt);
- output_sib(2,map,5);
- output_w32(addr+(int)rdram-0x80000000);
- }
-}
-void emit_movzwl_reg(int rs, int rt)
-{
- assem_debug("movzwl %%%s,%%%s\n",regname[rs]+1,regname[rt]);
- output_byte(0x0F);
- output_byte(0xB7);
- output_modrm(3,rs,rt);
-}
-
-void emit_xchg(int rs, int rt)
-{
- assem_debug("xchg %%%s,%%%s\n",regname[rs],regname[rt]);
- if(rs==EAX) {
- output_byte(0x90+rt);
- }
- else
- {
- output_byte(0x87);
- output_modrm(3,rs,rt);
- }
-}
-void emit_writeword(int rt, int addr)
-{
- assem_debug("movl %%%s,%x\n",regname[rt],addr);
- output_byte(0x89);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_writeword_indexed(int rt, int addr, int rs)
-{
- assem_debug("mov %%%s,%x+%%%s\n",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);
- }
-}
-void emit_writeword_tlb(int rt, int addr, int map)
-{
- if(map<0) {
- emit_writeword(rt, addr+(int)rdram-0x80000000);
- } else {
- emit_writeword_indexed(rt, addr+(int)rdram-0x80000000, map);
- }
-}
-void emit_writeword_indexed_tlb(int rt, int addr, int rs, int map, int temp)
-{
- if(map<0) emit_writeword_indexed(rt, addr+(int)rdram-0x80000000, rs);
- else {
- assem_debug("mov %%%s,%x(%%%s,%%%s,1)\n",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);
- }
- }
-}
-void emit_writedword_tlb(int rh, int rl, int addr, int map)
-{
- assert(rh>=0);
- if(map<0) {
- emit_writeword(rh, addr+(int)rdram-0x80000000);
- emit_writeword(rl, addr+(int)rdram-0x7FFFFFFC);
- }
- else {
- emit_writeword_indexed(rh, addr+(int)rdram-0x80000000, map);
- emit_writeword_indexed(rl, addr+(int)rdram-0x7FFFFFFC, map);
- }
-}
-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);
-}
-void emit_writehword(int rt, int addr)
-{
- assem_debug("movw %%%s,%x\n",regname[rt]+1,addr);
- output_byte(0x66);
- output_byte(0x89);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-void emit_writehword_indexed(int rt, int addr, int rs)
-{
- assem_debug("movw %%%s,%x+%%%s\n",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);
- }
-}
-void emit_writehword_tlb(int rt, int addr, int map)
-{
- if(map<0) {
- emit_writehword(rt, addr+(int)rdram-0x80000000);
- } else {
- emit_writehword_indexed(rt, addr+(int)rdram-0x80000000, map);
- }
-}
-void emit_writebyte(int rt, int addr)
-{
- if(rt<4) {
- assem_debug("movb %%%cl,%x\n",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);
- }
-}
-void emit_writebyte_indexed(int rt, int addr, int rs)
-{
- if(rt<4) {
- assem_debug("movb %%%cl,%x+%%%s\n",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);
- }
-}
-void emit_writebyte_tlb(int rt, int addr, int map)
-{
- if(map<0) {
- emit_writebyte(rt, addr+(int)rdram-0x80000000);
- } else {
- emit_writebyte_indexed(rt, addr+(int)rdram-0x80000000, map);
- }
-}
-void emit_writebyte_indexed_tlb(int rt, int addr, int rs, int map, int temp)
-{
- if(map<0) emit_writebyte_indexed(rt, addr+(int)rdram-0x80000000, rs);
- else
- if(rt<4) {
- assem_debug("movb %%%cl,%x(%%%s,%%%s,1)\n",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);
- }
-}
-void emit_writeword_imm(int imm, int addr)
-{
- assem_debug("movl $%x,%x\n",imm,addr);
- output_byte(0xC7);
- output_modrm(0,5,0);
- output_w32(addr);
- output_w32(imm);
-}
-void emit_writeword_imm_esp(int imm, int addr)
-{
- assem_debug("mov $%x,%x(%%esp)\n",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);
-}
-void emit_writebyte_imm(int imm, int addr)
-{
- assem_debug("movb $%x,%x\n",imm,addr);
- assert(imm>=-128&&imm<128);
- output_byte(0xC6);
- output_modrm(0,5,0);
- output_w32(addr);
- output_byte(imm);
-}
-void emit_writebyte_imm_esp(int imm, int addr)
-{
- assem_debug("movb $%x,%x(%%esp)\n",imm,addr);
- assert(addr>=-128&&addr<128);
- output_byte(0xC6);
- output_modrm(1,4,0);
- output_sib(0,4,4);
- output_byte(addr);
- output_byte(imm);
-}
-
-void emit_mul(int rs)
-{
- assem_debug("mul %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,4);
-}
-void emit_imul(int rs)
-{
- assem_debug("imul %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,5);
-}
-void emit_div(int rs)
-{
- assem_debug("div %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,6);
-}
-void emit_idiv(int rs)
-{
- assem_debug("idiv %%%s\n",regname[rs]);
- output_byte(0xF7);
- output_modrm(3,rs,7);
-}
-void emit_cdq()
-{
- assem_debug("cdq\n");
- output_byte(0x99);
-}
-
-// Load 2 immediates optimizing for small code size
-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);
-}
-
-// special case for checking pending_exception
-void emit_cmpmem_imm_byte(int addr,int imm)
-{
- assert(imm<128&&imm>=-127);
- assem_debug("cmpb $%d,%x\n",imm,addr);
- output_byte(0x80);
- output_modrm(0,5,7);
- output_w32(addr);
- output_byte(imm);
-}
-
-// special case for checking invalid_code
-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\n",imm,addr,regname[r]);
- output_byte(0x80);
- output_modrm(2,r,7);
- output_w32(addr);
- output_byte(imm);
-}
-
-// special case for checking hash_table
-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\n",addr,regname[rs],regname[rt]);
- output_byte(0x39);
- output_modrm(2,rs,rt);
- output_w32(addr);
-}
-
-// special case for checking memory_map in verify_mapping
-void emit_cmpmem(int addr,int rt)
-{
- assert(rt>=0&&rt<8);
- assem_debug("cmp %x,%%%s\n",addr,regname[rt]);
- output_byte(0x39);
- output_modrm(0,5,rt);
- output_w32(addr);
-}
-
-// Used to preload hash table entries
-void emit_prefetch(void *addr)
-{
- assem_debug("prefetch %x\n",(int)addr);
- output_byte(0x0F);
- output_byte(0x18);
- output_modrm(0,5,1);
- output_w32((int)addr);
-}
-
-/*void emit_submem(int r,int addr)
-{
- assert(r>=0&&r<8);
- assem_debug("sub %x,%%%s\n",addr,regname[r]);
- output_byte(0x2B);
- output_modrm(0,5,r);
- output_w32((int)addr);
-}*/
-void emit_subfrommem(int addr,int r)
-{
- assert(r>=0&&r<8);
- assem_debug("sub %%%s,%x\n",regname[r],addr);
- output_byte(0x29);
- output_modrm(0,5,r);
- output_w32((int)addr);
-}
-
-void emit_flds(int r)
-{
- assem_debug("flds (%%%s)\n",regname[r]);
- output_byte(0xd9);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fldl(int r)
-{
- assem_debug("fldl (%%%s)\n",regname[r]);
- output_byte(0xdd);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fucomip(u_int r)
-{
- assem_debug("fucomip %d\n",r);
- assert(r<8);
- output_byte(0xdf);
- output_byte(0xe8+r);
-}
-void emit_fchs()
-{
- assem_debug("fchs\n");
- output_byte(0xd9);
- output_byte(0xe0);
-}
-void emit_fabs()
-{
- assem_debug("fabs\n");
- output_byte(0xd9);
- output_byte(0xe1);
-}
-void emit_fsqrt()
-{
- assem_debug("fsqrt\n");
- output_byte(0xd9);
- output_byte(0xfa);
-}
-void emit_fadds(int r)
-{
- assem_debug("fadds (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_faddl(int r)
-{
- assem_debug("faddl (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fadd(int r)
-{
- assem_debug("fadd st%d\n",r);
- output_byte(0xd8);
- output_byte(0xc0+r);
-}
-void emit_fsubs(int r)
-{
- assem_debug("fsubs (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,4);
- else {output_modrm(1,EBP,4);output_byte(0);}
-}
-void emit_fsubl(int r)
-{
- assem_debug("fsubl (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,4);
- else {output_modrm(1,EBP,4);output_byte(0);}
-}
-void emit_fsub(int r)
-{
- assem_debug("fsub st%d\n",r);
- output_byte(0xd8);
- output_byte(0xe0+r);
-}
-void emit_fmuls(int r)
-{
- assem_debug("fmuls (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,1);
- else {output_modrm(1,EBP,1);output_byte(0);}
-}
-void emit_fmull(int r)
-{
- assem_debug("fmull (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,1);
- else {output_modrm(1,EBP,1);output_byte(0);}
-}
-void emit_fmul(int r)
-{
- assem_debug("fmul st%d\n",r);
- output_byte(0xd8);
- output_byte(0xc8+r);
-}
-void emit_fdivs(int r)
-{
- assem_debug("fdivs (%%%s)\n",regname[r]);
- output_byte(0xd8);
- if(r!=EBP) output_modrm(0,r,6);
- else {output_modrm(1,EBP,6);output_byte(0);}
-}
-void emit_fdivl(int r)
-{
- assem_debug("fdivl (%%%s)\n",regname[r]);
- output_byte(0xdc);
- if(r!=EBP) output_modrm(0,r,6);
- else {output_modrm(1,EBP,6);output_byte(0);}
-}
-void emit_fdiv(int r)
-{
- assem_debug("fdiv st%d\n",r);
- output_byte(0xd8);
- output_byte(0xf0+r);
-}
-void emit_fpop()
-{
- // fstp st(0)
- assem_debug("fpop\n");
- output_byte(0xdd);
- output_byte(0xd8);
-}
-void emit_fildl(int r)
-{
- assem_debug("fildl (%%%s)\n",regname[r]);
- output_byte(0xdb);
- if(r!=EBP) output_modrm(0,r,0);
- else {output_modrm(1,EBP,0);output_byte(0);}
-}
-void emit_fildll(int r)
-{
- assem_debug("fildll (%%%s)\n",regname[r]);
- output_byte(0xdf);
- if(r!=EBP) output_modrm(0,r,5);
- else {output_modrm(1,EBP,5);output_byte(0);}
-}
-void emit_fistpl(int r)
-{
- assem_debug("fistpl (%%%s)\n",regname[r]);
- output_byte(0xdb);
- if(r!=EBP) output_modrm(0,r,3);
- else {output_modrm(1,EBP,3);output_byte(0);}
-}
-void emit_fistpll(int r)
-{
- assem_debug("fistpll (%%%s)\n",regname[r]);
- output_byte(0xdf);
- if(r!=EBP) output_modrm(0,r,7);
- else {output_modrm(1,EBP,7);output_byte(0);}
-}
-void emit_fstps(int r)
-{
- assem_debug("fstps (%%%s)\n",regname[r]);
- output_byte(0xd9);
- if(r!=EBP) output_modrm(0,r,3);
- else {output_modrm(1,EBP,3);output_byte(0);}
-}
-void emit_fstpl(int r)
-{
- assem_debug("fstpl (%%%s)\n",regname[r]);
- output_byte(0xdd);
- if(r!=EBP) output_modrm(0,r,3);
- else {output_modrm(1,EBP,3);output_byte(0);}
-}
-void emit_fnstcw_stack()
-{
- assem_debug("fnstcw (%%esp)\n");
- output_byte(0xd9);
- output_modrm(0,4,7);
- output_sib(0,4,4);
-}
-void emit_fldcw_stack()
-{
- assem_debug("fldcw (%%esp)\n");
- output_byte(0xd9);
- output_modrm(0,4,5);
- output_sib(0,4,4);
-}
-void emit_fldcw_indexed(int addr,int r)
-{
- assem_debug("fldcw %x(%%%s)\n",addr,regname[r]);
- output_byte(0xd9);
- output_modrm(0,4,5);
- output_sib(1,r,5);
- output_w32(addr);
-}
-void emit_fldcw(int addr)
-{
- assem_debug("fldcw %x\n",addr);
- output_byte(0xd9);
- output_modrm(0,5,5);
- output_w32(addr);
-}
-void emit_movss_load(u_int addr,u_int ssereg)
-{
- assem_debug("movss (%%%s),xmm%d\n",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);}
-}
-void emit_movsd_load(u_int addr,u_int ssereg)
-{
- assem_debug("movsd (%%%s),xmm%d\n",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);}
-}
-void emit_movd_store(u_int ssereg,u_int addr)
-{
- assem_debug("movd xmm%d,(%%%s)\n",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);}
-}
-void emit_cvttps2dq(u_int ssereg1,u_int ssereg2)
-{
- assem_debug("cvttps2dq xmm%d,xmm%d\n",ssereg1,ssereg2);
- assert(ssereg1<8);
- assert(ssereg2<8);
- output_byte(0xf3);
- output_byte(0x0f);
- output_byte(0x5b);
- output_modrm(3,ssereg1,ssereg2);
-}
-void emit_cvttpd2dq(u_int ssereg1,u_int ssereg2)
-{
- assem_debug("cvttpd2dq xmm%d,xmm%d\n",ssereg1,ssereg2);
- assert(ssereg1<8);
- assert(ssereg2<8);
- output_byte(0x66);
- output_byte(0x0f);
- output_byte(0xe6);
- output_modrm(3,ssereg1,ssereg2);
-}
-
-/* Stubs/epilogue */
-
-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);
- //assert(addr>=0x7000000&&addr<0x7FFFFFF);
- //assert((target>=0x80000000&&target<0x80800000)||(target>0xA4000000&&target<0xA4001000));
-//DEBUG >
-#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)&Count);
- emit_sub(HOST_CCREG,ECX,HOST_CCREG);
- emit_writeword(ECX,(int)&last_count);
-#endif
-//DEBUG <
- emit_jmp(linker);
-}
-
-emit_extjump(int addr, int target)
-{
- emit_extjump2(addr, target, (int)dyna_linker);
-}
-emit_extjump_ds(int addr, int target)
-{
- emit_extjump2(addr, target, (int)dyna_linker_ds);
-}
-
-do_readstub(int n)
-{
- assem_debug("do_readstub %x\n",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);
- assert(rt>=0);
- if(addr<0) addr=rt;
- 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)&Count);
- emit_callreg(addr);
- // We really shouldn't need to update the count here,
- // but not doing so causes random crashes...
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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(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]); // return address
-}
-
-inline_readstub(int type, int i, u_int addr, signed char regmap[], int target, int adj, u_int reglist)
-{
- assem_debug("inline_readstub\n");
- int rs=get_reg(regmap,target);
- int rth=get_reg(regmap,target|64);
- int rt=get_reg(regmap,target);
- assert(rs>=0);
- assert(rt>=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();
- 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)&Count);
- if((signed int)addr>=(signed int)0xC0000000) {
- // Pagefault address
- 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]);
- // We really shouldn't need to update the count here,
- // but not doing so causes random crashes...
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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(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);
- }
-}
-
-do_writestub(int n)
-{
- assem_debug("do_writestub %x\n",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)&byte);
- if(type==STOREH_STUB)
- emit_writehword(rt,(int)&hword);
- if(type==STOREW_STUB)
- emit_writeword(rt,(int)&word);
- if(type==STORED_STUB) {
- emit_writeword(rt,(int)&dword);
- emit_writeword(r?rth:rt,(int)&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)&Count);
- emit_callreg(addr);
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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]); // return address
-}
-
-inline_writestub(int type, int i, u_int addr, signed char regmap[], int target, int adj, u_int reglist)
-{
- assem_debug("inline_writestub\n");
- 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)&byte);
- if(type==STOREH_STUB)
- emit_writehword(rt,(int)&hword);
- if(type==STOREW_STUB)
- emit_writeword(rt,(int)&word);
- if(type==STORED_STUB) {
- emit_writeword(rt,(int)&dword);
- emit_writeword(target?rth:rt,(int)&dword+4);
- }
- emit_pusha();
- 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)&Count);
- if((signed int)addr>=(signed int)0xC0000000) {
- // Pagefault address
- 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)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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);
- }
-}
-
-do_unalignedwritestub(int n)
-{
- set_jump_target(stubs[n][1],(int)out);
- output_byte(0xCC);
- emit_jmp(stubs[n][2]); // return address
-}
-
-void printregs(int edi,int esi,int ebp,int esp,int b,int d,int c,int a)
-{
- printf("regs: %x %x %x %x %x %x %x (%x)\n",a,b,c,d,ebp,esi,edi,(&edi)[-1]);
-}
-
-do_invstub(int n)
-{
- set_jump_target(stubs[n][1],(int)out);
- if(stubs[n][4]!=EDI) emit_xchg(stubs[n][4],EDI);
- emit_pusha();
- emit_call((int)&invalidate_block);
- emit_popa();
- if(stubs[n][4]!=EDI) emit_xchg(stubs[n][4],EDI);
- emit_jmp(stubs[n][2]); // return address
-}
-
-int do_dirty_stub(int i)
-{
- assem_debug("do_dirty_stub %x\n",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;
-}
-
-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);
-}
-
-do_cop1stub(int n)
-{
- assem_debug("do_cop1stub %x\n",start+stubs[n][3]*4);
- set_jump_target(stubs[n][1],(int)out);
- int i=stubs[n][3];
- int rs=stubs[n][4];
- 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);
- //if(i_regs!=®s[i]) printf("oops: regs[i]=%x i_regs=%x",(int)®s[i],(int)i_regs);
- }
- //else {printf("fp exception in delay slot\n");}
- 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); // Get PC
- emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG); // CHECK: is this right? There should probably be an extra cycle...
- emit_jmp(ds?(int)fp_exception_ds:(int)fp_exception);
-}
-
-/* TLB */
-
-int do_tlb_r(int s,int ar,int map,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; // No mapping
- }
- else {
- if(s!=map) emit_mov(s,map);
- emit_shrimm(map,12,map);
- // Schedule this while we wait on the load
- //if(x) emit_xorimm(addr,x,addr);
- if(shift>=0) emit_lea8(s,shift);
- if(~a) emit_andimm(s,a,ar);
- emit_movmem_indexedx4((int)memory_map,map,map);
- }
- return map;
-}
-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;
-}
-
-int gen_tlb_addr_r(int ar, int map) {
- if(map>=0) {
- emit_leairrx4(0,ar,map,ar);
- }
-}
-
-int do_tlb_w(int s,int ar,int map,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; // No mapping
- }
- else {
- if(s!=map) emit_mov(s,map);
- //if(s!=ar) emit_mov(s,ar);
- emit_shrimm(map,12,map);
- // Schedule this while we wait on the load
- //if(x) emit_xorimm(s,x,addr);
- emit_movmem_indexedx4((int)memory_map,map,map);
- }
- emit_shlimm(map,2,map);
- return map;
-}
-int 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);
- }
-}
-
-int gen_tlb_addr_w(int ar, int map) {
- if(map>=0) {
- emit_leairrx1(0,ar,map,ar);
- }
-}
-
-// We don't need this for x86
-generate_map_const(u_int addr,int reg) {
- // void *mapaddr=memory_map+(addr>>12);
-}
-
-/* Special assem */
-
-void shift_assemble_x86(int i,struct regstat *i_regs)
-{
- if(rt1[i]) {
- if(opcode2[i]<=0x07) // SLLV/SRLV/SRAV
- {
- 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) // SLLV
- {
- emit_shlcl(t==ECX?shift:t);
- }
- if(opcode2[i]==6) // SRLV
- {
- emit_shrcl(t==ECX?shift:t);
- }
- if(opcode2[i]==7) // SRAV
- {
- emit_sarcl(t==ECX?shift:t);
- }
- if(shift!=ECX&&i_regs->regmap[ECX]>=0) emit_xchg(shift,ECX);
- }
- }
- } else { // DSLLV/DSRLV/DSRAV
- 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
- {
- // FIXME: What if shift==tl ?
- assert(shift!=tl);
- int temp=get_reg(i_regs->regmap,-1);
- int real_th=th;
- if(th<0&&opcode2[i]!=0x14) {th=temp;} // DSLLV doesn't need a temporary register
- 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) // DSLLV
- {
- 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) // DSRLV
- {
- 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) // DSRAV
- {
- 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
-
-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(tl>=0) {
- //assert(tl>=0);
- //assert(rt1[i]);
- if(!using_tlb) {
- if(!c) {
- emit_lea8(addr,temp);
- if (opcode[i]==0x22||opcode[i]==0x26) {
- emit_andimm(addr,0xFFFFFFFC,temp2); // LWL/LWR
- }else{
- emit_andimm(addr,0xFFFFFFF8,temp2); // LDL/LDR
- }
- 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); // LWL/LWR
- }else{
- emit_movimm(((constmap[i][s]+offset)<<3)&56,temp); // LDL/LDR
- }
- }
- }else{ // using tlb
- int a;
- if(c) {
- a=-1;
- }else if (opcode[i]==0x22||opcode[i]==0x26) {
- a=0xFFFFFFFC; // LWL/LWR
- }else{
- a=0xFFFFFFF8; // LDL/LDR
- }
- map=get_reg(i_regs->regmap,TLREG);
- assert(map>=0);
- map=do_tlb_r(addr,temp2,map,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); // LWL/LWR
- }else{
- emit_movimm(((constmap[i][s]+offset)<<3)&56,temp); // LDL/LDR
- }
- }
- do_tlb_r_branch(map,c,constmap[i][s]+offset,&jaddr);
- }
- if (opcode[i]==0x22||opcode[i]==0x26) { // LWL/LWR
- if(!c||memtarget) {
- //emit_readword_indexed((int)rdram-0x80000000,temp2,temp2);
- 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);
- emit_andimm(temp,24,temp);
- if (opcode[i]==0x26) emit_xorimm(temp,24,temp); // LWR
- 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);
- //emit_storereg(rt1[i],tl); // DEBUG
- /*emit_pusha();
- //save_regs(0x100f);
- emit_readword((int)&last_count,ECX);
- if(get_reg(i_regs->regmap,CCREG)<0)
- emit_loadreg(CCREG,HOST_CCREG);
- emit_add(HOST_CCREG,ECX,HOST_CCREG);
- emit_addimm(HOST_CCREG,2*ccadj[i],HOST_CCREG);
- emit_writeword(HOST_CCREG,(int)&Count);
- emit_call((int)memdebug);
- emit_popa();
- //restore_regs(0x100f);*/
- }
- if (opcode[i]==0x1A||opcode[i]==0x1B) { // LDL/LDR
- 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) {
- //if(th>=0) emit_readword_indexed((int)rdram-0x80000000,temp2,temp2h);
- //emit_readword_indexed((int)rdram-0x7FFFFFFC,temp2,temp2);
- 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);
- 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
-
-void cop0_assemble(int i,struct regstat *i_regs)
-{
- if(opcode2[i]==0) // MFC0
- {
- signed char t=get_reg(i_regs->regmap,rt1[i]);
- char copr=(source[i]>>11)&0x1f;
- //assert(t>=0); // Why does this happen? OOT is weird
- 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); // TODO: do proper reg alloc
- emit_add(HOST_CCREG,ECX,HOST_CCREG);
- emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
- emit_writeword(HOST_CCREG,(int)&Count);
- }
- emit_call((int)MFC0);
- emit_readword((int)&readmem_dword,t);
- }
- }
- else if(opcode2[i]==4) // MTC0
- {
- 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); // TODO: do proper reg alloc
- emit_add(HOST_CCREG,ECX,HOST_CCREG);
- emit_addimm(HOST_CCREG,CLOCK_DIVIDER*ccadj[i],HOST_CCREG);
- emit_writeword(HOST_CCREG,(int)&Count);
- }
- // What a mess. The status register (12) can enable interrupts,
- // so needs a special case to handle a pending interrupt.
- // The interrupt must be taken immediately, because a subsequent
- // instruction might disable interrupts again.
- if(copr==12&&!is_delayslot) {
- emit_writeword_imm(start+i*4+4,(int)&pcaddr);
- emit_writebyte_imm(0,(int)&pending_exception);
- }
- //else if(copr==12&&is_delayslot) emit_call((int)MTC0_R12);
- //else
- emit_call((int)MTC0);
- if(copr==9||copr==11||copr==12) {
- emit_readword((int)&Count,HOST_CCREG);
- emit_readword((int)&next_interupt,ECX);
- emit_addimm(HOST_CCREG,-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);
- //if(is_delayslot) output_byte(0xcc);
- 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) // TLBR
- emit_call((int)TLBR);
- if((source[i]&0x3f)==0x02) // TLBWI
- emit_call((int)TLBWI_new);
- if((source[i]&0x3f)==0x06) { // TLBWR
- // The TLB entry written by TLBWR is dependent on the count,
- // so update the cycle count
- 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)&Count);
- emit_call((int)TLBWR_new);
- }
- if((source[i]&0x3f)==0x08) // TLBP
- emit_call((int)TLBP);
- if((source[i]&0x3f)==0x18) // ERET
- {
- 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); // TODO: Should there be an extra cycle here?
- emit_jmp((int)jump_eret);
- }
- }
-}
-
-void cop1_assemble(int i,struct regstat *i_regs)
-{
- // Check cop1 unusable
- 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) { // MFC1
- 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) { // DMFC1
- 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) { // MTC1
- 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) { // DMTC1
- 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) // CFC1
- {
- 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) // CTC1
- {
- 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);
- // Set the rounding mode
- char temp=get_reg(i_regs->regmap,-1);
- emit_movimm(3,temp);
- emit_and(sl,temp,temp);
- emit_fldcw_indexed((int)&rounding_modes,temp);
- }
- }
-}
-
-void fconv_assemble_x86(int i,struct regstat *i_regs)
-{
- signed char temp=get_reg(i_regs->regmap,-1);
- assert(temp>=0);
- // Check cop1 unusable
- 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]==0x10&&(source[i]&0x3f)==0x0d) { // trunc_w_s
- emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
- emit_movss_load(temp,0);
- emit_cvttps2dq(0,0); // float->int, truncate
- 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) { // trunc_w_d
- emit_readword((int)®_cop1_double[(source[i]>>11)&0x1f],temp);
- emit_movsd_load(temp,0);
- emit_cvttpd2dq(0,0); // double->int, truncate
- emit_readword((int)®_cop1_simple[(source[i]>>6)&0x1f],temp);
- emit_movd_store(0,temp);
- return;
- }
-
- if(opcode2[i]==0x14&&(source[i]&0x3f)==0x20) { // cvt_s_w
- 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) { // cvt_d_w
- 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) { // cvt_s_l
- 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) { // cvt_d_l
- 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) { // cvt_d_s
- 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) { // cvt_s_d
- 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) { // cvt_*_s
- emit_readword((int)®_cop1_simple[(source[i]>>11)&0x1f],temp);
- emit_flds(temp);
- }
- if(opcode2[i]==0x11) { // cvt_*_d
- 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); //printf("round\n");
- if((source[i]&3)==1) emit_fldcw((int)&trunc_mode); //printf("trunc\n");
- if((source[i]&3)==2) emit_fldcw((int)&ceil_mode); //printf("ceil\n");
- if((source[i]&3)==3) emit_fldcw((int)&floor_mode); //printf("floor\n");
- }
- if((source[i]&0x3f)==0x24||(source[i]&0x3c)==0x0c) { // cvt_w_*
- 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) { // cvt_l_*
- 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;
-
- // C emulation code for debugging
-
- 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();
- //emit_loadreg(CSREG,rs);
- return;
-}
-#define fconv_assemble fconv_assemble_x86
-
-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);
- // Check cop1 unusable
- 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) {
- // sf/ngle - these should throw exceptions for NaNs
- 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); // c_un_s
- if((source[i]&0x3f)==0x32) {emit_cmovne_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_eq_s
- if((source[i]&0x3f)==0x33) emit_cmovne_reg(temp,fs); // c_ueq_s
- if((source[i]&0x3f)==0x34) {emit_cmovnc_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_olt_s
- if((source[i]&0x3f)==0x35) emit_cmovnc_reg(temp,fs); // c_ult_s
- if((source[i]&0x3f)==0x36) {emit_cmova_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_ole_s
- if((source[i]&0x3f)==0x37) emit_cmova_reg(temp,fs); // c_ule_s
- if((source[i]&0x3f)==0x3a) emit_cmovne_reg(temp,fs); // c_seq_s
- if((source[i]&0x3f)==0x3b) emit_cmovne_reg(temp,fs); // c_ngl_s
- if((source[i]&0x3f)==0x3c) emit_cmovnc_reg(temp,fs); // c_lt_s
- if((source[i]&0x3f)==0x3d) emit_cmovnc_reg(temp,fs); // c_nge_s
- if((source[i]&0x3f)==0x3e) emit_cmova_reg(temp,fs); // c_le_s
- if((source[i]&0x3f)==0x3f) emit_cmova_reg(temp,fs); // c_ngt_s
- 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); // c_un_d
- if((source[i]&0x3f)==0x32) {emit_cmovne_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_eq_d
- if((source[i]&0x3f)==0x33) emit_cmovne_reg(temp,fs); // c_ueq_d
- if((source[i]&0x3f)==0x34) {emit_cmovnc_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_olt_d
- if((source[i]&0x3f)==0x35) emit_cmovnc_reg(temp,fs); // c_ult_d
- if((source[i]&0x3f)==0x36) {emit_cmova_reg(temp,fs);emit_cmovp_reg(temp,fs);} // c_ole_d
- if((source[i]&0x3f)==0x37) emit_cmova_reg(temp,fs); // c_ule_d
- if((source[i]&0x3f)==0x3a) emit_cmovne_reg(temp,fs); // c_seq_d
- if((source[i]&0x3f)==0x3b) emit_cmovne_reg(temp,fs); // c_ngl_d
- if((source[i]&0x3f)==0x3c) emit_cmovnc_reg(temp,fs); // c_lt_d
- if((source[i]&0x3f)==0x3d) emit_cmovnc_reg(temp,fs); // c_nge_d
- if((source[i]&0x3f)==0x3e) emit_cmova_reg(temp,fs); // c_le_d
- if((source[i]&0x3f)==0x3f) emit_cmova_reg(temp,fs); // c_ngt_d
- 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;
-}
-
-void float_assemble(int i,struct regstat *i_regs)
-{
- signed char temp=get_reg(i_regs->regmap,-1);
- assert(temp>=0);
- // Check cop1 unusable
- 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) // mov
- {
- 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) // sqrt
- emit_fsqrt();
- if((source[i]&0x3f)==5) // abs
- emit_fabs();
- if((source[i]&0x3f)==7) // neg
- 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) { // Single precision
- 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) { // Double precision
- 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();
- }
-}
-
-void multdiv_assemble_x86(int i,struct regstat *i_regs)
-{
- // case 0x18: MULT
- // case 0x19: MULTU
- // case 0x1A: DIV
- // case 0x1B: DIVU
- // case 0x1C: DMULT
- // case 0x1D: DMULTU
- // case 0x1E: DDIV
- // case 0x1F: DDIVU
- if(rs1[i]&&rs2[i])
- {
- if((opcode2[i]&4)==0) // 32-bit
- {
- if(opcode2[i]==0x18) // MULT
- {
- 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) // MULTU
- {
- 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) // DIV
- {
- 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) // DIVU
- {
- 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 // 64-bit
- {
- if(opcode2[i]==0x1C) // DMULT
- {
- 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) // DMULTU
- {
- 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);
- // DEBUG
- /*
- emit_pushreg(m2h);
- emit_pushreg(m2l);
- emit_pushreg(m1h);
- emit_pushreg(m1l);
- emit_call((int)&multu64);
- 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); // DEBUG
- if(hil>=0) emit_loadreg(HIREG,hil); // DEBUG
- */
- // Shouldn't be necessary
- //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]==0x1E) // DDIV
- {
- 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_pushreg(d2h);
- //emit_pushreg(d2l);
- //emit_pushreg(d1h);
- //emit_pushreg(d1l);
- 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_popreg(d1l);
- //emit_popreg(d1h);
- //emit_popreg(d2l);
- //emit_popreg(d2h);
- 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) // DDIVU
- {
- 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_pushreg(d2h);
- //emit_pushreg(d2l);
- //emit_pushreg(d1h);
- //emit_pushreg(d1l);
- 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_popreg(d1l);
- //emit_popreg(d1h);
- //emit_popreg(d2l);
- //emit_popreg(d2h);
- 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
- {
- // Multiply by zero is zero.
- // MIPS does not have a divide by zero exception.
- // The result is undefined, we return zero.
- 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
-
-void do_preload_rhash(int r) {
- emit_movimm(0xf8,r);
-}
-
-void do_preload_rhtbl(int r) {
- // Don't need this for x86
-}
-
-void do_rhash(int rs,int rh) {
- emit_and(rs,rh,rh);
-}
-
-void do_miniht_load(int ht,int rh) {
- // Don't need this for x86. The load and compare can be combined into
- // a single instruction (below)
-}
-
-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);
-}
-
-void do_miniht_insert(int return_address,int rt,int temp) {
- emit_movimm(return_address,rt); // PC into link register
- //emit_writeword_imm(return_address,(int)&mini_ht[(return_address&0xFF)>>8][0]);
- 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]);
-}
-
-// We don't need this for x86
-void literal_pool(int n) {}
-void literal_pool_jumpover(int n) {}
-
-// CPU-architecture-specific initialization, not needed for x86
-void arch_init() {}
+++ /dev/null
-#define HOST_REGS 8
-#define HOST_CCREG 6
-#define HOST_BTREG 5
-#define EXCLUDE_REG 4
-
-//#define IMM_PREFETCH 1
-#define HOST_IMM_ADDR32 1
-#define INVERTED_CARRY 1
-#define DESTRUCTIVE_WRITEBACK 1
-#define DESTRUCTIVE_SHIFT 1
-
-#define USE_MINI_HT 1
-
-#define BASE_ADDR 0x70000000 // Code generator target address
-#define TARGET_SIZE_2 25 // 2^25 = 32 megabytes
-
-/* x86 calling convention:
- caller-save: %eax %ecx %edx
- callee-save: %ebp %ebx %esi %edi */
+++ /dev/null
-/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
- * Mupen64plus - linkage_x86.s *
- * Copyright (C) 2009-2010 Ari64 *
- * *
- * This program is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 2 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with this program; if not, write to the *
- * Free Software Foundation, Inc., *
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. *
- * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
- .file "linkage_x86.s"
- .bss
- .align 4
-.globl rdram
-rdram = 0x80000000
-/*rdram:
- .space 8388608
- .type rdram, %object
- .size rdram, 8388608
-*/
- .section .rodata
- .text
-.globl dyna_linker
- .type dyna_linker, @function
-dyna_linker:
- /* eax = virtual target address */
- /* ebx = instruction to patch */
- mov %eax, %edi
- mov %eax, %ecx
- shr $12, %edi
- cmp $0xC0000000, %eax
- cmovge tlb_LUT_r(,%edi,4), %ecx
- test %ecx, %ecx
- cmovz %eax, %ecx
- xor $0x80000000, %ecx
- mov $2047, %edx
- shr $12, %ecx
- and %ecx, %edx
- or $2048, %edx
- cmp %edx, %ecx
- cmova %edx, %ecx
- /* jump_in lookup */
- mov jump_in(,%ecx,4), %edx
-.A1:
- test %edx, %edx
- je .A3
- mov (%edx), %edi
- xor %eax, %edi
- or 4(%edx), %edi
- je .A2
- movl 12(%edx), %edx
- jmp .A1
-.A2:
- mov (%ebx), %edi
- mov %esi, %ebp
- lea 4(%ebx,%edi,1), %esi
- mov %eax, %edi
- pusha
- call add_link
- popa
- mov 8(%edx), %edi
- mov %ebp, %esi
- lea -4(%edi), %edx
- subl %ebx, %edx
- movl %edx, (%ebx)
- jmp *%edi
-.A3:
- /* hash_table lookup */
- mov %eax, %edi
- mov %eax, %edx
- shr $16, %edi
- shr $12, %edx
- xor %eax, %edi
- and $2047, %edx
- movzwl %di, %edi
- shl $4, %edi
- cmp $2048, %ecx
- cmovc %edx, %ecx
- cmp hash_table(%edi), %eax
- jne .A5
-.A4:
- mov hash_table+4(%edi), %edx
- jmp *%edx
-.A5:
- cmp hash_table+8(%edi), %eax
- lea 8(%edi), %edi
- je .A4
- /* jump_dirty lookup */
- mov jump_dirty(,%ecx,4), %edx
-.A6:
- testl %edx, %edx
- je .A8
- mov (%edx), %ecx
- xor %eax, %ecx
- or 4(%edx), %ecx
- je .A7
- movl 12(%edx), %edx
- jmp .A6
-.A7:
- mov 8(%edx), %edx
- /* hash_table insert */
- mov hash_table-8(%edi), %ebx
- mov hash_table-4(%edi), %ecx
- mov %eax, hash_table-8(%edi)
- mov %edx, hash_table-4(%edi)
- mov %ebx, hash_table(%edi)
- mov %ecx, hash_table+4(%edi)
- jmp *%edx
-.A8:
- mov %eax, %edi
- pusha
- call new_recompile_block
- test %eax, %eax
- popa
- je dyna_linker
- /* pagefault */
- mov %eax, %ebx
- mov $0x08, %ecx
- .size dyna_linker, .-dyna_linker
-
-.globl exec_pagefault
- .type exec_pagefault, @function
-exec_pagefault:
- /* eax = instruction pointer */
- /* ebx = fault address */
- /* ecx = cause */
- mov reg_cop0+48, %edx
- mov reg_cop0+16, %edi
- or $2, %edx
- mov %ebx, reg_cop0+32 /* BadVAddr */
- and $0xFF80000F, %edi
- mov %edx, reg_cop0+48 /* Status */
- mov %ecx, reg_cop0+52 /* Cause */
- mov %eax, reg_cop0+56 /* EPC */
- mov %ebx, %ecx
- shr $9, %ebx
- and $0xFFFFE000, %ecx
- and $0x007FFFF0, %ebx
- mov %ecx, reg_cop0+40 /* EntryHI */
- or %ebx, %edi
- mov %edi, reg_cop0+16 /* Context */
- push %esi
- push $0x80000000
- call get_addr_ht
- pop %esi
- pop %esi
- jmp *%eax
- .size exec_pagefault, .-exec_pagefault
-
-/* Special dynamic linker for the case where a page fault
- may occur in a branch delay slot */
-.globl dyna_linker_ds
- .type dyna_linker_ds, @function
-dyna_linker_ds:
- mov %eax, %edi
- mov %eax, %ecx
- shr $12, %edi
- cmp $0xC0000000, %eax
- cmovge tlb_LUT_r(,%edi,4), %ecx
- test %ecx, %ecx
- cmovz %eax, %ecx
- xor $0x80000000, %ecx
- mov $2047, %edx
- shr $12, %ecx
- and %ecx, %edx
- or $2048, %edx
- cmp %edx, %ecx
- cmova %edx, %ecx
- /* jump_in lookup */
- mov jump_in(,%ecx,4), %edx
-.B1:
- test %edx, %edx
- je .B3
- mov (%edx), %edi
- xor %eax, %edi
- or 4(%edx), %edi
- je .B2
- movl 12(%edx), %edx
- jmp .B1
-.B2:
- mov (%ebx), %edi
- mov %esi, %ecx
- lea 4(%ebx,%edi,1), %esi
- mov %eax, %edi
- pusha
- call add_link
- popa
- mov 8(%edx), %edi
- mov %ecx, %esi
- lea -4(%edi), %edx
- subl %ebx, %edx
- movl %edx, (%ebx)
- jmp *%edi
-.B3:
- /* hash_table lookup */
- mov %eax, %edi
- mov %eax, %edx
- shr $16, %edi
- shr $12, %edx
- xor %eax, %edi
- and $2047, %edx
- movzwl %di, %edi
- shl $4, %edi
- cmp $2048, %ecx
- cmovc %edx, %ecx
- cmp hash_table(%edi), %eax
- jne .B5
-.B4:
- mov hash_table+4(%edi), %edx
- jmp *%edx
-.B5:
- cmp hash_table+8(%edi), %eax
- lea 8(%edi), %edi
- je .B4
- /* jump_dirty lookup */
- mov jump_dirty(,%ecx,4), %edx
-.B6:
- testl %edx, %edx
- je .B8
- mov (%edx), %ecx
- xor %eax, %ecx
- or 4(%edx), %ecx
- je .B7
- movl 12(%edx), %edx
- jmp .B6
-.B7:
- mov 8(%edx), %edx
- /* hash_table insert */
- mov hash_table-8(%edi), %ebx
- mov hash_table-4(%edi), %ecx
- mov %eax, hash_table-8(%edi)
- mov %edx, hash_table-4(%edi)
- mov %ebx, hash_table(%edi)
- mov %ecx, hash_table+4(%edi)
- jmp *%edx
-.B8:
- mov %eax, %edi
- and $0xFFFFFFF8, %edi
- inc %edi
- pusha
- call new_recompile_block
- test %eax, %eax
- popa
- je dyna_linker_ds
- /* pagefault */
- and $0xFFFFFFF8, %eax
- mov $0x80000008, %ecx /* High bit set indicates pagefault in delay slot */
- mov %eax, %ebx
- sub $4, %eax
- jmp exec_pagefault
- .size dyna_linker_ds, .-dyna_linker_ds
-
-.globl jump_vaddr_eax
- .type jump_vaddr_eax, @function
-jump_vaddr_eax:
- mov %eax, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_eax, .-jump_vaddr_eax
-.globl jump_vaddr_ecx
- .type jump_vaddr_ecx, @function
-jump_vaddr_ecx:
- mov %ecx, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_ecx, .-jump_vaddr_ecx
-.globl jump_vaddr_edx
- .type jump_vaddr_edx, @function
-jump_vaddr_edx:
- mov %edx, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_edx, .-jump_vaddr_edx
-.globl jump_vaddr_ebx
- .type jump_vaddr_ebx, @function
-jump_vaddr_ebx:
- mov %ebx, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_ebx, .-jump_vaddr_ebx
-.globl jump_vaddr_ebp
- .type jump_vaddr_ebp, @function
-jump_vaddr_ebp:
- mov %ebp, %edi
- .size jump_vaddr_ebp, .-jump_vaddr_ebp
-.globl jump_vaddr_edi
- .type jump_vaddr_edi, @function
-jump_vaddr_edi:
- mov %edi, %eax
- .size jump_vaddr_edi, .-jump_vaddr_edi
-
-.globl jump_vaddr
- .type jump_vaddr, @function
-jump_vaddr:
- /* Check hash table */
- shr $16, %eax
- xor %edi, %eax
- movzwl %ax, %eax
- shl $4, %eax
- cmp hash_table(%eax), %edi
- jne .C2
-.C1:
- mov hash_table+4(%eax), %edi
- jmp *%edi
-.C2:
- cmp hash_table+8(%eax), %edi
- lea 8(%eax), %eax
- je .C1
- /* No hit on hash table, call compiler */
- push %edi
- mov %esi, cycle_count /* CCREG */
- call get_addr
- mov cycle_count, %esi
- add $4, %esp
- jmp *%eax
- .size jump_vaddr, .-jump_vaddr
-
-.globl verify_code_ds
- .type verify_code_ds, @function
-verify_code_ds:
- mov %ebp, branch_target
- .size verify_code_ds, .-verify_code_ds
-
-.globl verify_code_vm
- .type verify_code_vm, @function
-verify_code_vm:
- /* eax = source (virtual address) */
- /* ebx = target */
- /* ecx = length */
- cmp $0xC0000000, %eax
- jl verify_code
- mov %eax, %edx
- lea -1(%eax,%ecx,1), %ebp
- shr $12, %edx
- shr $12, %ebp
- mov memory_map(,%edx,4), %edi
- test %edi, %edi
- js .D5
- lea (%eax,%edi,4), %eax
-.D1:
- xor memory_map(,%edx,4), %edi
- shl $2, %edi
- jne .D5
- mov memory_map(,%edx,4), %edi
- inc %edx
- cmp %ebp, %edx
- jbe .D1
- .size verify_code_vm, .-verify_code_vm
-
-.globl verify_code
- .type verify_code, @function
-verify_code:
- /* eax = source */
- /* ebx = target */
- /* ecx = length */
- mov -4(%eax,%ecx,1), %edi
- xor -4(%ebx,%ecx,1), %edi
- jne .D5
- mov %ecx, %edx
- add $-4, %ecx
- je .D3
- test $4, %edx
- cmove %edx, %ecx
- mov %esi, cycle_count
-.D2:
- mov -4(%eax,%ecx,1), %edx
- mov -4(%ebx,%ecx,1), %ebp
- mov -8(%eax,%ecx,1), %esi
- xor %edx, %ebp
- mov -8(%ebx,%ecx,1), %edi
- jne .D4
- xor %esi, %edi
- jne .D4
- add $-8, %ecx
- jne .D2
- mov cycle_count, %esi
- mov branch_target, %ebp
-.D3:
- ret
-.D4:
- mov cycle_count, %esi
-.D5:
- mov branch_target, %ebp
- add $4, %esp /* pop return address, we're not returning */
- call get_addr
- add $4, %esp /* pop virtual address */
- jmp *%eax
- .size verify_code, .-verify_code
-
-.globl cc_interrupt
- .type cc_interrupt, @function
-cc_interrupt:
- add last_count, %esi
- add $-28, %esp /* Align stack */
- mov %esi, reg_cop0+36 /* Count */
- shr $19, %esi
- movl $0, pending_exception
- and $0x7f, %esi
- cmpl $0, restore_candidate(,%esi,4)
- jne .E4
-.E1:
- call gen_interupt
- mov reg_cop0+36, %esi
- mov next_interupt, %eax
- mov pending_exception, %ebx
- mov stop, %ecx
- add $28, %esp
- mov %eax, last_count
- sub %eax, %esi
- test %ecx, %ecx
- jne .E3
- test %ebx, %ebx
- jne .E2
- ret
-.E2:
- mov pcaddr, %edi
- mov %esi, cycle_count /* CCREG */
- push %edi
- call get_addr_ht
- mov cycle_count, %esi
- add $8, %esp
- jmp *%eax
-.E3:
- add $16, %esp /* pop stack */
- pop %edi /* restore edi */
- pop %esi /* restore esi */
- pop %ebx /* restore ebx */
- pop %ebp /* restore ebp */
- ret /* exit dynarec */
-.E4:
- /* Move 'dirty' blocks to the 'clean' list */
- mov restore_candidate(,%esi,4), %ebx
- mov %esi, %ebp
- movl $0, restore_candidate(,%esi,4)
- shl $5, %ebp
-.E5:
- shr $1, %ebx
- jnc .E6
- mov %ebp, (%esp)
- call clean_blocks
-.E6:
- inc %ebp
- test $31, %ebp
- jne .E5
- jmp .E1
- .size cc_interrupt, .-cc_interrupt
-
-.globl do_interrupt
- .type do_interrupt, @function
-do_interrupt:
- mov pcaddr, %edi
- push %edi
- call get_addr_ht
- add $4, %esp
- mov reg_cop0+36, %esi
- mov next_interupt, %ebx
- mov %ebx, last_count
- sub %ebx, %esi
- add $2, %esi
- jmp *%eax
- .size do_interrupt, .-do_interrupt
-
-.globl fp_exception
- .type fp_exception, @function
-fp_exception:
- mov $0x1000002c, %edx
-.E7:
- mov reg_cop0+48, %ebx
- or $2, %ebx
- mov %ebx, reg_cop0+48 /* Status */
- mov %edx, reg_cop0+52 /* Cause */
- mov %eax, reg_cop0+56 /* EPC */
- push %esi
- push $0x80000180
- call get_addr_ht
- pop %esi
- pop %esi
- jmp *%eax
- .size fp_exception, .-fp_exception
-
-.globl fp_exception_ds
- .type fp_exception_ds, @function
-fp_exception_ds:
- mov $0x9000002c, %edx /* Set high bit if delay slot */
- jmp .E7
- .size fp_exception_ds, .-fp_exception_ds
-
-.globl jump_syscall
- .type jump_syscall, @function
-jump_syscall:
- mov $0x20, %edx
- mov reg_cop0+48, %ebx
- or $2, %ebx
- mov %ebx, reg_cop0+48 /* Status */
- mov %edx, reg_cop0+52 /* Cause */
- mov %eax, reg_cop0+56 /* EPC */
- push %esi
- push $0x80000180
- call get_addr_ht
- pop %esi
- pop %esi
- jmp *%eax
- .size jump_syscall, .-jump_syscall
-
-.globl jump_eret
- .type jump_eret, @function
-jump_eret:
- mov reg_cop0+48, %ebx /* Status */
- add last_count, %esi
- and $0xFFFFFFFD, %ebx
- mov %esi, reg_cop0+36 /* Count */
- mov %ebx, reg_cop0+48 /* Status */
- call check_interupt
- mov next_interupt, %eax
- mov reg_cop0+36, %esi
- mov %eax, last_count
- sub %eax, %esi
- mov reg_cop0+56, %eax /* EPC */
- jns .E11
-.E8:
- mov $248, %ebx
- xor %edi, %edi
-.E9:
- mov reg(%ebx), %ecx
- mov reg+4(%ebx), %edx
- sar $31, %ecx
- xor %ecx, %edx
- neg %edx
- adc %edi, %edi
- sub $8, %ebx
- jne .E9
- mov hi(%ebx), %ecx
- mov hi+4(%ebx), %edx
- sar $31, %ecx
- xor %ecx, %edx
- jne .E10
- mov lo(%ebx), %ecx
- mov lo+4(%ebx), %edx
- sar $31, %ecx
- xor %ecx, %edx
-.E10:
- neg %edx
- adc %edi, %edi
- push %edi
- push %eax
- mov %esi, cycle_count
- call get_addr_32
- mov cycle_count, %esi
- add $8, %esp
- jmp *%eax
-.E11:
- mov %eax, pcaddr
- call cc_interrupt
- mov pcaddr, %eax
- jmp .E8
- .size jump_eret, .-jump_eret
-
-.globl new_dyna_start
- .type new_dyna_start, @function
-new_dyna_start:
- push %ebp
- push %ebx
- push %esi
- push %edi
- push $0xa4000040
- call new_recompile_block
- add $-8, %esp /* align stack */
- movl next_interupt, %edi
- movl reg_cop0+36, %esi
- movl %edi, last_count
- subl %edi, %esi
- jmp 0x70000000
- .size new_dyna_start, .-new_dyna_start
-
-.globl write_rdram_new
- .type write_rdram_new, @function
-write_rdram_new:
- mov address, %edi
- mov word, %ecx
- mov %ecx, rdram-0x80000000(%edi)
- jmp .E12
- .size write_rdram_new, .-write_rdram_new
-
-.globl write_rdramb_new
- .type write_rdramb_new, @function
-write_rdramb_new:
- mov address, %edi
- xor $3, %edi
- movb byte, %cl
- movb %cl, rdram-0x80000000(%edi)
- jmp .E12
- .size write_rdramb_new, .-write_rdramb_new
-
-.globl write_rdramh_new
- .type write_rdramh_new, @function
-write_rdramh_new:
- mov address, %edi
- xor $2, %edi
- movw hword, %cx
- movw %cx, rdram-0x80000000(%edi)
- jmp .E12
- .size write_rdramh_new, .-write_rdramh_new
-
-.globl write_rdramd_new
- .type write_rdramd_new, @function
-write_rdramd_new:
- mov address, %edi
- mov dword+4, %ecx
- mov dword, %edx
- mov %ecx, rdram-0x80000000(%edi)
- mov %edx, rdram-0x80000000+4(%edi)
- jmp .E12
- .size write_rdramd_new, .-write_rdramd_new
-
-.globl do_invalidate
- .type do_invalidate, @function
-do_invalidate:
- mov address, %edi
- mov %edi, %ebx /* Return ebx to caller */
-.E12:
- shr $12, %edi
- cmpb $1, invalid_code(%edi)
- je .E13
- push %edi
- call invalidate_block
- pop %edi
-.E13:
- ret
- .size do_invalidate, .-do_invalidate
-
-.globl read_nomem_new
- .type read_nomem_new, @function
-read_nomem_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- mov (%ebx,%edi,4), %ecx
- mov %ecx, readmem_dword
- ret
- .size read_nomem_new, .-read_nomem_new
-
-.globl read_nomemb_new
- .type read_nomemb_new, @function
-read_nomemb_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- xor $3, %ebx
- movzbl (%ebx,%edi,4), %ecx
- mov %ecx, readmem_dword
- ret
- .size read_nomemb_new, .-read_nomemb_new
-
-.globl read_nomemh_new
- .type read_nomemh_new, @function
-read_nomemh_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- xor $2, %ebx
- movzwl (%ebx,%edi,4), %ecx
- mov %ecx, readmem_dword
- ret
- .size read_nomemh_new, .-read_nomemh_new
-
-.globl read_nomemd_new
- .type read_nomemd_new, @function
-read_nomemd_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- mov 4(%ebx,%edi,4), %ecx
- mov (%ebx,%edi,4), %edx
- mov %ecx, readmem_dword
- mov %edx, readmem_dword+4
- ret
- .size read_nomemd_new, .-read_nomemd_new
-
-.globl write_nomem_new
- .type write_nomem_new, @function
-write_nomem_new:
- call do_invalidate
- mov memory_map(,%edi,4),%edi
- mov word, %ecx
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- mov %ecx, (%ebx,%edi)
- ret
- .size write_nomem_new, .-write_nomem_new
-
-.globl write_nomemb_new
- .type write_nomemb_new, @function
-write_nomemb_new:
- call do_invalidate
- mov memory_map(,%edi,4),%edi
- movb byte, %cl
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- xor $3, %ebx
- movb %cl, (%ebx,%edi)
- ret
- .size write_nomemb_new, .-write_nomemb_new
-
-.globl write_nomemh_new
- .type write_nomemh_new, @function
-write_nomemh_new:
- call do_invalidate
- mov memory_map(,%edi,4),%edi
- movw hword, %cx
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- xor $2, %ebx
- movw %cx, (%ebx,%edi)
- ret
- .size write_nomemh_new, .-write_nomemh_new
-
-.globl write_nomemd_new
- .type write_nomemd_new, @function
-write_nomemd_new:
- call do_invalidate
- mov memory_map(,%edi,4),%edi
- mov dword+4, %edx
- mov dword, %ecx
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- mov %edx, (%ebx,%edi)
- mov %ecx, 4(%ebx,%edi)
- ret
- .size write_nomemd_new, .-write_nomemd_new
-
-.globl tlb_exception
- .type tlb_exception, @function
-tlb_exception:
- /* eax = cause */
- /* ebx = address */
- /* ebp = instr addr + flags */
- mov 0x24(%esp), %ebp
-/* Debug:
- push %ebp
- push %ebx
- push %eax
- call tlb_debug
- pop %eax
- pop %ebx
- pop %ebp
-/* end debug */
- mov reg_cop0+48, %esi
- mov %ebp, %ecx
- mov %ebp, %edx
- mov %ebp, %edi
- shl $31, %ebp
- shr $12, %ecx
- or %ebp, %eax
- sar $29, %ebp
- and $0xFFFFFFFC, %edx
- mov memory_map(,%ecx,4), %ecx
- or $2, %esi
- mov (%edx, %ecx, 4), %ecx
- add %ebp, %edx
- mov %esi, reg_cop0+48 /* Status */
- mov %eax, reg_cop0+52 /* Cause */
- mov %edx, reg_cop0+56 /* EPC */
- add $0x24, %esp
- mov $0x6000022, %edx
- mov %ecx, %ebp
- movswl %cx, %eax
- shr $26, %ecx
- shr $21, %ebp
- sub %eax, %ebx
- and $0x1f, %ebp
- ror %cl, %edx
- mov reg_cop0+16, %esi
- cmovc reg(,%ebp,8), %ebx
- and $0xFF80000F, %esi
- mov %ebx, reg(,%ebp,8)
- add %ebx, %eax
- sar $31, %ebx
- mov %eax, reg_cop0+32 /* BadVAddr */
- shr $9, %eax
- test $2, %edi
- cmove reg+4(,%ebp,8), %ebx
- and $0x007FFFF0, %eax
- push $0x80000180
- mov %ebx, reg+4(,%ebp,8)
- or %eax, %esi
- mov %esi, reg_cop0+16 /* Context */
- call get_addr_ht
- pop %esi
- movl next_interupt, %edi
- movl reg_cop0+36, %esi /* Count */
- movl %edi, last_count
- subl %edi, %esi
- jmp *%eax
- .size tlb_exception, .-tlb_exception
+++ /dev/null
-/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
- * Mupen64plus - linkage_x86_64.s *
- * Copyright (C) 2009-2010 Ari64 *
- * *
- * This program is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 2 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with this program; if not, write to the *
- * Free Software Foundation, Inc., *
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. *
- * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
- .file "linkage_x86_64.s"
- .bss
- .align 4
-//.globl rdram
-//rdram = 0x80000000
- .section .rodata
- .text
-.globl dyna_linker
- .type dyna_linker, @function
-dyna_linker:
- /* eax = virtual target address */
- /* ebx = instruction to patch */
- mov %eax, %edi
- mov %eax, %ecx
- shr $12, %edi
- cmp $0xC0000000, %eax
- cmovge tlb_LUT_r(,%edi,4), %ecx
- test %ecx, %ecx
- cmovz %eax, %ecx
- xor $0x80000000, %ecx
- mov $2047, %edx
- shr $12, %ecx
- and %ecx, %edx
- or $2048, %edx
- cmp %edx, %ecx
- cmova %edx, %ecx
- /* jump_in lookup */
- movq jump_in(,%ecx,8), %r12
-.A1:
- test %r12, %r12
- je .A3
- mov (%r12), %edi
- xor %eax, %edi
- or 4(%r12), %edi
- je .A2
- movq 16(%r12), %r12
- jmp .A1
-.A2:
- mov (%ebx), %edi
- mov %esi, %ebp
- lea 4(%ebx,%edi,1), %esi
- mov %eax, %edi
- call add_link
- mov 8(%r12), %edi
- mov %ebp, %esi
- lea -4(%edi), %edx
- subl %ebx, %edx
- movl %edx, (%ebx)
- jmp *%rdi
-.A3:
- /* hash_table lookup */
- mov %eax, %edi
- mov %eax, %edx
- shr $16, %edi
- shr $12, %edx
- xor %eax, %edi
- and $2047, %edx
- movzwl %di, %edi
- shl $4, %edi
- cmp $2048, %ecx
- cmovc %edx, %ecx
- cmp hash_table(%edi), %eax
- jne .A5
-.A4:
- mov hash_table+4(%edi), %edx
- jmp *%rdx
-.A5:
- cmp hash_table+8(%edi), %eax
- lea 8(%edi), %edi
- je .A4
- /* jump_dirty lookup */
- movq jump_dirty(,%ecx,8), %r12
-.A6:
- test %r12, %r12
- je .A8
- mov (%r12), %ecx
- xor %eax, %ecx
- or 4(%r12), %ecx
- je .A7
- movq 16(%r12), %r12
- jmp .A6
-.A7:
- movl 8(%r12), %edx
- /* hash_table insert */
- mov hash_table-8(%edi), %ebx
- mov hash_table-4(%edi), %ecx
- mov %eax, hash_table-8(%edi)
- mov %edx, hash_table-4(%edi)
- mov %ebx, hash_table(%edi)
- mov %ecx, hash_table+4(%edi)
- jmp *%rdx
-.A8:
- mov %eax, %edi
- mov %eax, %ebp /* Note: assumes %rbx and %rbp are callee-saved */
- mov %esi, %r12d
- call new_recompile_block
- test %eax, %eax
- mov %ebp, %eax
- mov %r12d, %esi
- je dyna_linker
- /* pagefault */
- mov %eax, %ebx
- mov $0x08, %ecx
- .size dyna_linker, .-dyna_linker
-
-.globl exec_pagefault
- .type exec_pagefault, @function
-exec_pagefault:
- /* eax = instruction pointer */
- /* ebx = fault address */
- /* ecx = cause */
- mov reg_cop0+48, %edx
- mov reg_cop0+16, %edi
- or $2, %edx
- mov %ebx, reg_cop0+32 /* BadVAddr */
- and $0xFF80000F, %edi
- mov %edx, reg_cop0+48 /* Status */
- mov %ecx, reg_cop0+52 /* Cause */
- mov %eax, reg_cop0+56 /* EPC */
- mov %ebx, %ecx
- shr $9, %ebx
- and $0xFFFFE000, %ecx
- and $0x007FFFF0, %ebx
- mov %ecx, reg_cop0+40 /* EntryHI */
- or %ebx, %edi
- mov %edi, reg_cop0+16 /* Context */
- mov %esi, %ebx
- mov $0x80000000, %edi
- call get_addr_ht
- mov %ebx, %esi
- jmp *%rax
- .size exec_pagefault, .-exec_pagefault
-
-/* Special dynamic linker for the case where a page fault
- may occur in a branch delay slot */
-.globl dyna_linker_ds
- .type dyna_linker_ds, @function
-dyna_linker_ds:
- mov %eax, %edi
- mov %eax, %ecx
- shr $12, %edi
- cmp $0xC0000000, %eax
- cmovge tlb_LUT_r(,%edi,4), %ecx
- test %ecx, %ecx
- cmovz %eax, %ecx
- xor $0x80000000, %ecx
- mov $2047, %edx
- shr $12, %ecx
- and %ecx, %edx
- or $2048, %edx
- cmp %edx, %ecx
- cmova %edx, %ecx
- /* jump_in lookup */
- movq jump_in(,%ecx,8), %r12
-.B1:
- test %r12, %r12
- je .B3
- mov (%r12), %edi
- xor %eax, %edi
- or 4(%r12), %edi
- je .B2
- movq 16(%r12), %r12
- jmp .B1
-.B2:
- mov (%ebx), %edi
- mov %esi, %r13d
- lea 4(%ebx,%edi,1), %esi
- mov %eax, %edi
- call add_link
- mov 8(%r12), %edi
- mov %r13d, %esi
- lea -4(%edi), %edx
- subl %ebx, %edx
- movl %edx, (%ebx)
- jmp *%rdi
-.B3:
- /* hash_table lookup */
- mov %eax, %edi
- mov %eax, %edx
- shr $16, %edi
- shr $12, %edx
- xor %eax, %edi
- and $2047, %edx
- movzwl %di, %edi
- shl $4, %edi
- cmp $2048, %ecx
- cmovc %edx, %ecx
- cmp hash_table(%edi), %eax
- jne .B5
-.B4:
- mov hash_table+4(%edi), %edx
- jmp *%rdx
-.B5:
- cmp hash_table+8(%edi), %eax
- lea 8(%edi), %edi
- je .B4
- /* jump_dirty lookup */
- movq jump_dirty(,%ecx,8), %r12
-.B6:
- test %r12, %r12
- je .B8
- mov (%r12), %ecx
- xor %eax, %ecx
- or 4(%r12), %ecx
- je .B7
- movq 16(%r12), %r12
- jmp .B6
-.B7:
- movl 8(%r12), %edx
- /* hash_table insert */
- mov hash_table-8(%edi), %ebx
- mov hash_table-4(%edi), %ecx
- mov %eax, hash_table-8(%edi)
- mov %edx, hash_table-4(%edi)
- mov %ebx, hash_table(%edi)
- mov %ecx, hash_table+4(%edi)
- jmp *%rdx
-.B8:
- mov %eax, %edi
- mov %eax, %r12d /* Note: assumes %rbx and %rbp are callee-saved */
- and $0xFFFFFFF8, %edi
- mov %esi, %r13d
- inc %edi
- call new_recompile_block
- test %eax, %eax
- mov %r12d, %eax
- mov %r13d, %esi
- je dyna_linker_ds
- /* pagefault */
- and $0xFFFFFFF8, %eax
- mov $0x80000008, %ecx /* High bit set indicates pagefault in delay slot */
- mov %eax, %ebx
- sub $4, %eax
- jmp exec_pagefault
- .size dyna_linker_ds, .-dyna_linker_ds
-
-.globl jump_vaddr_eax
- .type jump_vaddr_eax, @function
-jump_vaddr_eax:
- mov %eax, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_eax, .-jump_vaddr_eax
-.globl jump_vaddr_ecx
- .type jump_vaddr_ecx, @function
-jump_vaddr_ecx:
- mov %ecx, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_ecx, .-jump_vaddr_ecx
-.globl jump_vaddr_edx
- .type jump_vaddr_edx, @function
-jump_vaddr_edx:
- mov %edx, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_edx, .-jump_vaddr_edx
-.globl jump_vaddr_ebx
- .type jump_vaddr_ebx, @function
-jump_vaddr_ebx:
- mov %ebx, %edi
- jmp jump_vaddr_edi
- .size jump_vaddr_ebx, .-jump_vaddr_ebx
-.globl jump_vaddr_ebp
- .type jump_vaddr_ebp, @function
-jump_vaddr_ebp:
- mov %ebp, %edi
- .size jump_vaddr_ebp, .-jump_vaddr_ebp
-.globl jump_vaddr_edi
- .type jump_vaddr_edi, @function
-jump_vaddr_edi:
- mov %edi, %eax
- .size jump_vaddr_edi, .-jump_vaddr_edi
-
-.globl jump_vaddr
- .type jump_vaddr, @function
-jump_vaddr:
- /* Check hash table */
- shr $16, %eax
- xor %edi, %eax
- movzwl %ax, %eax
- shl $4, %eax
- cmp hash_table(%eax), %edi
- jne .C2
-.C1:
- mov hash_table+4(%eax), %edi
- jmp *%rdi
-.C2:
- cmp hash_table+8(%eax), %edi
- lea 8(%eax), %eax
- je .C1
- /* No hit on hash table, call compiler */
- mov %esi, cycle_count /* CCREG */
- call get_addr
- mov cycle_count, %esi
- jmp *%rax
- .size jump_vaddr, .-jump_vaddr
-
-.globl verify_code_ds
- .type verify_code_ds, @function
-verify_code_ds:
- nop
- .size verify_code_ds, .-verify_code_ds
-
-.globl verify_code_vm
- .type verify_code_vm, @function
-verify_code_vm:
- /* eax = source (virtual address) */
- /* ebx = target */
- /* ecx = length */
- cmp $0xC0000000, %eax
- jl verify_code
- mov %eax, %edx
- lea -1(%eax,%ecx,1), %r9d
- shr $12, %edx
- shr $12, %r9d
- mov memory_map(,%edx,4), %edi
- test %edi, %edi
- js .D4
- lea (%eax,%edi,4), %eax
- mov %edi, %r8d
-.D1:
- xor memory_map(,%edx,4), %edi
- shl $2, %edi
- jne .D4
- mov %r8d, %edi
- inc %edx
- cmp %r9d, %edx
- jbe .D1
- .size verify_code_vm, .-verify_code_vm
-
-.globl verify_code
- .type verify_code, @function
-verify_code:
- /* eax = source */
- /* ebx = target */
- /* ecx = length */
- /* r12d = instruction pointer */
- mov -4(%eax,%ecx,1), %edi
- xor -4(%ebx,%ecx,1), %edi
- jne .D4
- mov %ecx, %edx
- add $-4, %ecx
- je .D3
- test $4, %edx
- cmove %edx, %ecx
-.D2:
- mov -8(%eax,%ecx,1), %rdi
- cmp -8(%ebx,%ecx,1), %rdi
- jne .D4
- add $-8, %ecx
- jne .D2
-.D3:
- ret
-.D4:
- add $8, %rsp /* pop return address, we're not returning */
- mov %r12d, %edi
- mov %esi, %ebx
- call get_addr
- mov %ebx, %esi
- jmp *%rax
- .size verify_code, .-verify_code
-
-.globl cc_interrupt
- .type cc_interrupt, @function
-cc_interrupt:
- add last_count, %esi
- add $-8, %rsp /* Align stack */
- mov %esi, reg_cop0+36 /* Count */
- shr $19, %esi
- movl $0, pending_exception
- and $0x7f, %esi
- cmpl $0, restore_candidate(,%esi,4)
- jne .E4
-.E1:
- call gen_interupt
- mov reg_cop0+36, %esi
- mov next_interupt, %eax
- mov pending_exception, %ebx
- mov stop, %ecx
- add $8, %rsp
- mov %eax, last_count
- sub %eax, %esi
- test %ecx, %ecx
- jne .E3
- test %ebx, %ebx
- jne .E2
- ret
-.E2:
- mov pcaddr, %edi
- mov %esi, cycle_count /* CCREG */
- call get_addr_ht
- mov cycle_count, %esi
- add $8, %rsp /* pop return address */
- jmp *%rax
-.E3:
- pop %rbp /* pop return address and discard it */
- pop %rbp /* pop junk */
- pop %r15 /* restore callee-save registers */
- pop %r14
- pop %r13
- pop %r12
- pop %rbx
- pop %rbp
- ret /* exit dynarec */
-.E4:
- /* Move 'dirty' blocks to the 'clean' list */
- mov restore_candidate(,%esi,4), %ebx
- mov %esi, %ebp
- movl $0, restore_candidate(,%esi,4)
- shl $5, %ebp
-.E5:
- shr $1, %ebx
- jnc .E6
- mov %ebp, %edi
- call clean_blocks
-.E6:
- inc %ebp
- test $31, %ebp
- jne .E5
- jmp .E1
- .size cc_interrupt, .-cc_interrupt
-
-.globl do_interrupt
- .type do_interrupt, @function
-do_interrupt:
- mov pcaddr, %edi
- call get_addr_ht
- mov reg_cop0+36, %esi
- mov next_interupt, %ebx
- mov %ebx, last_count
- sub %ebx, %esi
- add $2, %esi
- jmp *%rax
- .size do_interrupt, .-do_interrupt
-
-.globl fp_exception
- .type fp_exception, @function
-fp_exception:
- mov $0x1000002c, %edx
-.E7:
- mov reg_cop0+48, %ebx
- or $2, %ebx
- mov %ebx, reg_cop0+48 /* Status */
- mov %edx, reg_cop0+52 /* Cause */
- mov %eax, reg_cop0+56 /* EPC */
- mov %esi, %ebx
- mov $0x80000180, %edi
- call get_addr_ht
- mov %ebx, %esi
- jmp *%rax
- .size fp_exception, .-fp_exception
-
-.globl fp_exception_ds
- .type fp_exception_ds, @function
-fp_exception_ds:
- mov $0x9000002c, %edx /* Set high bit if delay slot */
- jmp .E7
- .size fp_exception_ds, .-fp_exception_ds
-
-.globl jump_syscall
- .type jump_syscall, @function
-jump_syscall:
- mov $0x20, %edx
- mov reg_cop0+48, %ebx
- or $2, %ebx
- mov %ebx, reg_cop0+48 /* Status */
- mov %edx, reg_cop0+52 /* Cause */
- mov %eax, reg_cop0+56 /* EPC */
- mov %esi, %ebx
- mov $0x80000180, %edi
- call get_addr_ht
- mov %ebx, %esi
- jmp *%rax
- .size jump_syscall, .-jump_syscall
-
-.globl jump_eret
- .type jump_eret, @function
-jump_eret:
- mov reg_cop0+48, %ebx /* Status */
- add last_count, %esi
- and $0xFFFFFFFD, %ebx
- mov %esi, reg_cop0+36 /* Count */
- mov %ebx, reg_cop0+48 /* Status */
- call check_interupt
- mov next_interupt, %eax
- mov reg_cop0+36, %esi
- mov %eax, last_count
- sub %eax, %esi
- mov reg_cop0+56, %edi /* EPC */
- jns .E11
-.E8:
- mov %esi, %r12d
- mov $248, %ebx
- xor %esi, %esi
-.E9:
- mov reg(%ebx), %ecx
- mov reg+4(%ebx), %edx
- sar $31, %ecx
- xor %ecx, %edx
- neg %edx
- adc %esi, %esi
- sub $8, %ebx
- jne .E9
- mov hi(%ebx), %ecx
- mov hi+4(%ebx), %edx
- sar $31, %ecx
- xor %ecx, %edx
- jne .E10
- mov lo(%ebx), %ecx
- mov lo+4(%ebx), %edx
- sar $31, %ecx
- xor %ecx, %edx
-.E10:
- neg %edx
- adc %esi, %esi
- call get_addr_32
- mov %r12d, %esi
- jmp *%rax
-.E11:
- mov %edi, pcaddr
- call cc_interrupt
- mov pcaddr, %edi
- jmp .E8
- .size jump_eret, .-jump_eret
-
-.globl new_dyna_start
- .type new_dyna_start, @function
-new_dyna_start:
- push %rbp
- push %rbx
- push %r12
- push %r13
- push %r14
- push %r15
- mov $0xa4000040, %edi
- call new_recompile_block
- add $-8, %rsp /* align stack */
- movl next_interupt, %edi
- movl reg_cop0+36, %esi
- movl %edi, last_count
- subl %edi, %esi
- jmp 0x70000000
- .size new_dyna_start, .-new_dyna_start
-
-.globl write_rdram_new
- .type write_rdram_new, @function
-write_rdram_new:
- mov address, %edi
- mov word, %ecx
- and $0x7FFFFFFF, %edi
- mov %ecx, rdram(%rdi)
- jmp .E12
- .size write_rdram_new, .-write_rdram_new
-
-.globl write_rdramb_new
- .type write_rdramb_new, @function
-write_rdramb_new:
- mov address, %edi
- xor $3, %edi
- movb byte, %cl
- and $0x7FFFFFFF, %edi
- movb %cl, rdram(%rdi)
- jmp .E12
- .size write_rdramb_new, .-write_rdramb_new
-
-.globl write_rdramh_new
- .type write_rdramh_new, @function
-write_rdramh_new:
- mov address, %edi
- xor $2, %edi
- movw hword, %cx
- and $0x7FFFFFFF, %edi
- movw %cx, rdram(%rdi)
- jmp .E12
- .size write_rdramh_new, .-write_rdramh_new
-
-.globl write_rdramd_new
- .type write_rdramd_new, @function
-write_rdramd_new:
- mov address, %edi
- mov dword+4, %ecx
- mov dword, %edx
- and $0x7FFFFFFF, %edi
- mov %ecx, rdram(%rdi)
- mov %edx, rdram+4(%rdi)
- jmp .E12
- .size write_rdramd_new, .-write_rdramd_new
-
-.globl do_invalidate
- .type do_invalidate, @function
-do_invalidate:
- mov address, %edi
- mov %edi, %ebx /* Return ebx to caller */
-.E12:
- shr $12, %edi
- mov %edi, %r12d /* Return r12 to caller */
- cmpb $1, invalid_code(%edi)
- je .E13
- call invalidate_block
-.E13:
- ret
- .size do_invalidate, .-do_invalidate
-
-.globl read_nomem_new
- .type read_nomem_new, @function
-read_nomem_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- mov (%ebx,%edi,4), %ecx
- mov %ecx, readmem_dword
- ret
- .size read_nomem_new, .-read_nomem_new
-
-.globl read_nomemb_new
- .type read_nomemb_new, @function
-read_nomemb_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- xor $3, %ebx
- movzbl (%ebx,%edi,4), %ecx
- mov %ecx, readmem_dword
- ret
- .size read_nomemb_new, .-read_nomemb_new
-
-.globl read_nomemh_new
- .type read_nomemh_new, @function
-read_nomemh_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- xor $2, %ebx
- movzwl (%ebx,%edi,4), %ecx
- mov %ecx, readmem_dword
- ret
- .size read_nomemh_new, .-read_nomemh_new
-
-.globl read_nomemd_new
- .type read_nomemd_new, @function
-read_nomemd_new:
- mov address, %edi
- mov %edi, %ebx
- shr $12, %edi
- mov memory_map(,%edi,4),%edi
- mov $0x8, %eax
- test %edi, %edi
- js tlb_exception
- mov 4(%ebx,%edi,4), %ecx
- mov (%ebx,%edi,4), %edx
- mov %ecx, readmem_dword
- mov %edx, readmem_dword+4
- ret
- .size read_nomemd_new, .-read_nomemd_new
-
-.globl write_nomem_new
- .type write_nomem_new, @function
-write_nomem_new:
- call do_invalidate
- mov memory_map(,%r12d,4),%edi
- mov word, %ecx
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- mov %ecx, (%ebx,%edi)
- ret
- .size write_nomem_new, .-write_nomem_new
-
-.globl write_nomemb_new
- .type write_nomemb_new, @function
-write_nomemb_new:
- call do_invalidate
- mov memory_map(,%r12d,4),%edi
- movb byte, %cl
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- xor $3, %ebx
- movb %cl, (%ebx,%edi)
- ret
- .size write_nomemb_new, .-write_nomemb_new
-
-.globl write_nomemh_new
- .type write_nomemh_new, @function
-write_nomemh_new:
- call do_invalidate
- mov memory_map(,%r12d,4),%edi
- movw hword, %cx
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- xor $2, %ebx
- movw %cx, (%ebx,%edi)
- ret
- .size write_nomemh_new, .-write_nomemh_new
-
-.globl write_nomemd_new
- .type write_nomemd_new, @function
-write_nomemd_new:
- call do_invalidate
- mov memory_map(,%r12d,4),%edi
- mov dword+4, %edx
- mov dword, %ecx
- mov $0xc, %eax
- shl $2, %edi
- jc tlb_exception
- mov %edx, (%ebx,%edi)
- mov %ecx, 4(%ebx,%edi)
- ret
- .size write_nomemd_new, .-write_nomemd_new
-
-.globl tlb_exception
- .type tlb_exception, @function
-tlb_exception:
- /* eax = cause */
- /* ebx = address */
- /* ebp = instr addr + flags */
- mov 8(%rsp), %ebp
- mov reg_cop0+48, %esi
- mov %ebp, %ecx
- mov %ebp, %edx
- mov %ebp, %edi
- shl $31, %ebp
- shr $12, %ecx
- or %ebp, %eax
- sar $29, %ebp
- and $0xFFFFFFFC, %edx
- mov memory_map(,%ecx,4), %ecx
- or $2, %esi
- mov (%edx, %ecx, 4), %ecx
- add %ebp, %edx
- mov %esi, reg_cop0+48 /* Status */
- mov %eax, reg_cop0+52 /* Cause */
- mov %edx, reg_cop0+56 /* EPC */
- add $0x48, %rsp
- mov $0x6000022, %edx
- mov %ecx, %ebp
- movswl %cx, %eax
- shr $26, %ecx
- shr $21, %ebp
- sub %eax, %ebx
- and $0x1f, %ebp
- ror %cl, %edx
- mov reg_cop0+16, %esi
- cmovc reg(,%ebp,8), %ebx
- and $0xFF80000F, %esi
- mov %ebx, reg(,%ebp,8)
- add %ebx, %eax
- sar $31, %ebx
- mov %eax, reg_cop0+32 /* BadVAddr */
- shr $9, %eax
- test $2, %edi
- cmove reg+4(,%ebp,8), %ebx
- and $0x007FFFF0, %eax
- mov $0x80000180, %edi
- mov %ebx, reg+4(,%ebp,8)
- or %eax, %esi
- mov %esi, reg_cop0+16 /* Context */
- call get_addr_ht
- movl next_interupt, %edi
- movl reg_cop0+36, %esi /* Count */
- movl %edi, last_count
- subl %edi, %esi
- jmp *%rax
- .size tlb_exception, .-tlb_exception
notaz.gp2x.de / pcsx_rearmed.git / commitdiff