Subversion Repositories mips789

/* convert.c by Steve Rhoads 4/26/01 */
/* Now uses the ELF format (get gccmips_elf.zip) */
/* set $gp and zero .sbss and .bss */
/* Reads test.axf and creates code.txt */
/*modified by Liwei 2007-8-29*/
#include<stdio.h>
#include<stdlib.h>
#include<string.h>
#define BUF_SIZE (1024*1024*4)
/*Assumes running on PC little endian*/
#ifndef USE_BIG_ENDIAN 
#define ntohl(A)(((A)>>24)|(((A)&0x00ff0000)>>8)|(((A)&0xff00)<<8)|((A)<<24))
#define ntohs(A)(unsigned short)((((A)&0xff00)>>8)|((A)<<8))
#else 
#define ntohl(A)A 
#define ntohs(A)A 
#endif 
 
#define EI_NIDENT 16 
#define SHT_PROGBITS 1 
#define SHT_STRTAB 3 
#define SHT_NOBITS 8 
 
typedef struct 
{
    unsigned char e_ident[EI_NIDENT];
    unsigned short e_e_type ;
    unsigned short e_machine ;
    unsigned long e_version ;
    unsigned long e_entry ;
    unsigned long e_phoff ;
    unsigned long e_shoff ;
    unsigned long e_flags ;
    unsigned short e_ehsize ;
    unsigned short e_phentsize ;
    unsigned short e_phnum ;
    unsigned short e_shentsize ;
    unsigned short e_shnum ;
    unsigned short e_shstrndx ;
}
ElfHeader ;
 
typedef struct 
{
    unsigned long p_type ;
    unsigned long p_offset ;
    unsigned long p_vaddr ;
    unsigned long p_paddr ;
    unsigned long p_filesz ;
    unsigned long p_memsz ;
    unsigned long p_flags ;
    unsigned long p_align ;
}
Elf32_Phdr ;
 
typedef struct 
{
    unsigned long sh_name ;
    unsigned long sh_type ;
    unsigned long sh_flags ;
    unsigned long sh_addr ;
    unsigned long sh_offset ;
    unsigned long sh_size ;
    unsigned long sh_link ;
    unsigned long sh_info ;
    unsigned long sh_addralign ;
    unsigned long sh_entsize ;
}
Elf32_Shdr ;
 
typedef struct 
{
    unsigned long ri_gprmask ;
    unsigned long ri_cprmask[4];
    unsigned long ri_gp_value ;
}
ELF_RegInfo ;
 
#define PT_MIPS_REGINFO 0x70000000 
#define SHT_MIPS_REGINFO 0x70000006 
 
void set_low(unsigned char*ptr,unsigned long address,unsigned long value)
{
    unsigned long opcode ;
    opcode=*(unsigned long*)(ptr+address);
    opcode=ntohl(opcode);
    opcode=(opcode&0xffff0000)|(value&0xffff);
    opcode=ntohl(opcode);
    *(unsigned long*)(ptr+address)=opcode ;
}
 
/*the two functions listed between are added by Liwei 2007-8-29*/
 char HEX[]="0123456789ABCDEF" ;
 char hex[]="0123456789abcdef" ;
unsigned char hex2byte( char hex_char)
{
    unsigned char i ;
    for(i=0;i<16;++i)if(HEX[i]==hex_char)return i ;
    for(i=0;i<16;++i)if(hex[i]==hex_char)return i ;
    return 0 ;
}
unsigned int par2u32(char*par)
{
    unsigned int i,ret=0 ;
    if(par==NULL)return ;
    if((0==strncmp(par,"0x",2))||(0==strncmp(par,"0X",2))) 
    for(i=2;;++i)    {if(par[i]=='\0')return ret ; ret=ret*16+hex2byte(par[i]);}
    else 
    for(i=0;;++i)    {if(par[i]=='\0')return ret ; ret=ret*10+hex2byte(par[i]);}
    return 0 ;
}
/****************************/
 
int main(int argc,char*argv[])
{
    FILE*infile,*outfile,*txtfile ;
    unsigned char*buf,*code ;
    long size,stack_pointer;
    long stack_limit=0 ;
    unsigned long length,d,i,gp_ptr=0,gp_ptr_backup=0 ;
    unsigned long bss_start=0,bss_end=0 ;
 
    ElfHeader*elfHeader ;
    Elf32_Phdr*elfProgram ;
    ELF_RegInfo*elfRegInfo ;
    Elf32_Shdr*elfSection ;
    (void)argc ;
    (void)argv ;
//    printf(">%s<=>%d<\n",argv[1],par2u32((char*)argv[1]));//Liwei 2007-8.29
 //   printf(">%s<=>%d<\n",argv[2],par2u32((char*)argv[2]));//Liwei 2007-8.29
// printf("argc = %d\n",argc);
    if (argc>=3)
    stack_limit=((par2u32((char*)argv[1]) - par2u32((char*)argv[2])));//alig 4
    /* added by Liwei  2007_8_29 */
    /*usage example :
                   convert_sp 0x800 0xf0
                   the sp_pointer is limited and set as (0x800 - 0xf0)
                   0x800 is your instructions space lenth while 0xf0 is your stack lenth 
                   but make sure your instructions space is big enough...
                   comment by Liwei
                   */
    printf("test.axf -> code.txt & test.bin\n");
    infile=fopen("test.axf","rb");
    if(infile==NULL)
    {
        printf("Can't open test.axf");
        return 0 ;
    }
    buf=(unsigned char*)malloc(BUF_SIZE);
    size=(int)fread(buf,1,BUF_SIZE,infile);
    fclose(infile);
    code=(unsigned char*)malloc(BUF_SIZE);
    memset(code,0,BUF_SIZE);
 
    elfHeader=(ElfHeader*)buf ;
    if(strncmp((char*)elfHeader->e_ident+1,"ELF",3))
    {
        printf("Error:  Not an ELF file!\n");
        printf("Use the gccmips_elf.zip from opencores/projects/plasma!\n");
        return-1 ;
    }
 
    elfHeader->e_entry=ntohl(elfHeader->e_entry);
    elfHeader->e_phoff=ntohl(elfHeader->e_phoff);
    elfHeader->e_shoff=ntohl(elfHeader->e_shoff);
    elfHeader->e_flags=ntohl(elfHeader->e_flags);
    elfHeader->e_phentsize=ntohs(elfHeader->e_phentsize);
    elfHeader->e_phnum=ntohs(elfHeader->e_phnum);
    elfHeader->e_shentsize=ntohs(elfHeader->e_shentsize);
    elfHeader->e_shnum=ntohs(elfHeader->e_shnum);
    printf("Entry=0x%x ",elfHeader->e_entry);
    length=0 ;
 
    for(i=0;i<elfHeader->e_phnum;++i)
    {
        elfProgram=(Elf32_Phdr*)(buf+elfHeader->e_phoff+
        elfHeader->e_phentsize*i);
        elfProgram->p_type=ntohl(elfProgram->p_type);
        elfProgram->p_offset=ntohl(elfProgram->p_offset);
        elfProgram->p_vaddr=ntohl(elfProgram->p_vaddr);
        elfProgram->p_filesz=ntohl(elfProgram->p_filesz);
        elfProgram->p_memsz=ntohl(elfProgram->p_memsz);
        elfProgram->p_flags=ntohl(elfProgram->p_flags);
 
        elfProgram->p_vaddr-=elfHeader->e_entry ;
 
        if(elfProgram->p_type==PT_MIPS_REGINFO)
        {
            elfRegInfo=(ELF_RegInfo*)(buf+elfProgram->p_offset);
            gp_ptr=ntohl(elfRegInfo->ri_gp_value);
        }
        if(elfProgram->p_vaddr<BUF_SIZE)
        {
            /* printf("[0x%x,0x%x,0x%x,0x%x,0x%x]\n", elfProgram->p_vaddr, */
            /*    elfProgram->p_offset, elfProgram->p_filesz, elfProgram->p_memsz, */
            /*    elfProgram->p_flags); */
            memcpy(code+elfProgram->p_vaddr,buf+elfProgram->p_offset,
            elfProgram->p_filesz);
            length=elfProgram->p_vaddr+elfProgram->p_filesz ;
            /* printf("length = %d 0x%x\n", length, length); */
        }
    }
 
    for(i=0;i<elfHeader->e_shnum;++i)
    {
        elfSection=(Elf32_Shdr*)(buf+elfHeader->e_shoff+
        elfHeader->e_shentsize*i);
        elfSection->sh_name=ntohl(elfSection->sh_name);
        elfSection->sh_type=ntohl(elfSection->sh_type);
        elfSection->sh_addr=ntohl(elfSection->sh_addr);
        elfSection->sh_offset=ntohl(elfSection->sh_offset);
        elfSection->sh_size=ntohl(elfSection->sh_size);
 
        if(elfSection->sh_type==SHT_MIPS_REGINFO)
        {
            elfRegInfo=(ELF_RegInfo*)(buf+elfSection->sh_offset);
            gp_ptr=ntohl(elfRegInfo->ri_gp_value);
        }
        if(elfSection->sh_type==SHT_PROGBITS)
        {
            /* printf("elfSection->sh_addr=0x%x\n", elfSection->sh_addr); */
            if(elfSection->sh_addr>gp_ptr_backup)
            gp_ptr_backup=elfSection->sh_addr ;
        }
        if(elfSection->sh_type==SHT_NOBITS)
        {
            if(bss_start==0)
            {
                bss_start=elfSection->sh_addr ;
            }
            bss_end=elfSection->sh_addr+elfSection->sh_size ;
        }
    }
 
    if(length>bss_start-elfHeader->e_entry)
    {
        length=bss_start-elfHeader->e_entry ;
    }
    if(bss_start==length)
    {
        bss_start=length ;
        bss_end=length+4 ;
    }
    if(gp_ptr==0)
    gp_ptr=gp_ptr_backup+0x7ff0 ;
 
    /* #if 0 */
    /*Initialize the $gp register for sdata and sbss */
    printf("gp_ptr=0x%x ",gp_ptr);
    /*modify the first opcodes in boot.asm */
    /*modify the lui opcode */
    set_low(code,0,gp_ptr>>16);
    /*modify the ori opcode */
    set_low(code,4,gp_ptr&0xffff);
 
    /*Clear .sbss and .bss */
    printf("sbss=0x%x bss_end=0x%x\nlength=0x%x ",bss_start,bss_end,length);
    set_low(code,8,bss_start>>16);
    set_low(code,12,bss_start&0xffff);
    set_low(code,16,bss_end>>16);
    set_low(code,20,bss_end&0xffff);
 
    /*Set stack pointer */
    if(elfHeader->e_entry<0x10000000)
    stack_pointer=bss_end+512 ;
    else 
    stack_pointer=bss_end+1024*4 ;
 
    if(stack_limit)stack_pointer=(stack_pointer<stack_limit)?stack_pointer:stack_limit;
    //added by Liwei 2007-8-29
    stack_pointer&=~7 ;
    printf("SP=0x%x\n",stack_pointer);
    set_low(code,24,stack_pointer>>16);
    set_low(code,28,stack_pointer&0xffff);
    /* #endif */
 
    /*write out test.bin */
    outfile=fopen("test.bin","wb");
    fwrite(code,length,1,outfile);
    fclose(outfile);
 
 
    /*write out code.txt */
    txtfile=fopen("code.txt","w");
    for(i=0;i<=length;i+=4)
    {
        d=ntohl(*(unsigned long*)(code+i));
        fprintf(txtfile,"%8.8x\n",d);
    }
    fclose(txtfile);
    free(buf);
    printf("\n");
    return 0 ;
}