mirror of
https://github.com/elliotnunn/NetBoot.git
synced 2024-12-27 17:29:15 +00:00
307 lines
6.8 KiB
C
307 lines
6.8 KiB
C
/* cpu.c example cpu-description file */
|
|
/* (c) in 2002 by Volker Barthelmann */
|
|
|
|
#include "vasm.h"
|
|
|
|
char *cpu_copyright="vasm test cpu backend (c) in 2002 Volker Barthelmann";
|
|
|
|
/* example machine.
|
|
valid Registers: R0-R3
|
|
valid extensions: .b/.w (default .w)
|
|
|
|
Instruction format:
|
|
XCCCCCCC 11112222 [32bit op1] [32bit op2]
|
|
|
|
X: set if byte-extension
|
|
C: instruction code
|
|
1/2: operand 1/2 type
|
|
0-3 register
|
|
4-7 register indirect (32bit offset follows)
|
|
8 absolute (32bit value follows)
|
|
9 immediate (32bit value follows)
|
|
Special case for addq: 1111: immediate 0-15
|
|
Special case for bra: 11112222: 0-255 relative offset
|
|
*/
|
|
|
|
char *cpuname="test";
|
|
int bitsperbyte=8;
|
|
int bytespertaddr=4;
|
|
|
|
mnemonic mnemonics[]={
|
|
"move",{OP_ALL,OP_REG},{CPU_ALL,0x0},
|
|
"move",{OP_REG,OP_ALL_DEST},{CPU_ALL,0x1},
|
|
"add",{OP_ALL,OP_REG},{CPU_ALL,0x2},
|
|
"add",{OP_REG,OP_ALL_DEST},{CPU_ALL,0x3},
|
|
"add",{OP_IMM32,OP_MEM},{CPU_ALL,0x4},
|
|
"addq",{OP_IMM32,OP_ALL_DEST},{CPU_ALL,0x5},
|
|
"jmp",{OP_ABS,0},{CPU_ALL,0x6},
|
|
"bra",{OP_ABS,0},{CPU_ALL,0x7},
|
|
};
|
|
|
|
int mnemonic_cnt=sizeof(mnemonics)/sizeof(mnemonics[0]);
|
|
|
|
|
|
char *parse_instruction(char *s,int *inst_len,char **ext,int *ext_len,
|
|
int *ext_cnt)
|
|
/* parse instruction and save extension locations */
|
|
{
|
|
char *inst = s;
|
|
|
|
while (*s && *s!='.' && !isspace((unsigned char)*s))
|
|
s++;
|
|
*inst_len = s - inst;
|
|
if (*s =='.') {
|
|
/* extension present */
|
|
ext[*ext_cnt] = ++s;
|
|
while (*s && *s!='.' && !isspace((unsigned char)*s))
|
|
s++;
|
|
ext_len[*ext_cnt] = s - ext[*ext_cnt];
|
|
*ext_cnt += 1;
|
|
}
|
|
return s;
|
|
}
|
|
|
|
int set_default_qualifiers(char **q,int *q_len)
|
|
/* fill in pointers to default qualifiers, return number of qualifiers */
|
|
{
|
|
q[0] = "w";
|
|
q_len[0] = 1;
|
|
return 1;
|
|
}
|
|
|
|
/* Does not do much useful parsing yet. */
|
|
int parse_operand(char *p,int len,operand *op,int requires)
|
|
{
|
|
p=skip(p);
|
|
if(len==2&&(p[0]=='r'||p[0]=='R')&&p[1]>='0'&&p[1]<='3'){
|
|
op->type=OP_REG;
|
|
op->basereg=p[1]-'0';
|
|
}else if(p[0]=='#'){
|
|
op->type=OP_IMM32;
|
|
p=skip(p+1);
|
|
op->offset=parse_expr(&p);
|
|
}else{
|
|
int parent=0;
|
|
expr *tree;
|
|
op->type=-1;
|
|
if(*p=='('){
|
|
parent=1;
|
|
p=skip(p+1);
|
|
}
|
|
tree=parse_expr(&p);
|
|
if(!tree)
|
|
return 0;
|
|
p=skip(p);
|
|
if(parent){
|
|
if(*p==','){
|
|
p=skip(p+1);
|
|
if((*p!='r'&&*p!='R')||p[1]<'0'||p[1]>'3'){
|
|
cpu_error(0);
|
|
return 0;
|
|
}
|
|
op->type=OP_REGIND;
|
|
op->basereg=p[1]-'0';
|
|
p=skip(p+2);
|
|
}
|
|
if(*p!=')'){
|
|
cpu_error(0);
|
|
return 0;
|
|
}else
|
|
p=skip(p+1);
|
|
}
|
|
if(op->type!=OP_REGIND)
|
|
op->type=OP_ABS;
|
|
op->offset=tree;
|
|
}
|
|
if(requires==op->type)
|
|
return 1;
|
|
if(requires==OP_ALL_DEST&&op->type!=OP_IMM32)
|
|
return 1;
|
|
if(requires==OP_MEM&&OP_ISMEM(op->type))
|
|
return 1;
|
|
if(requires==OP_ALL)
|
|
return 1;
|
|
return 0;
|
|
}
|
|
|
|
/* Return new instruction code, if instruction can be optimized
|
|
to another one. */
|
|
static int opt_inst(instruction *p,section *sec,taddr pc)
|
|
{
|
|
/* Ganz simples Beispiel. */
|
|
|
|
/* add->addq */
|
|
if((p->code==2||p->code==4)&&p->op[0]->type==OP_IMM32){
|
|
taddr val;
|
|
if(eval_expr(p->op[0]->offset,&val,sec,pc)&&val<16)
|
|
return 5;
|
|
}
|
|
/* jmp->bra */
|
|
if(p->code==6){
|
|
expr *tree=p->op[0]->offset;
|
|
if(tree->type==SYM&&tree->c.sym->sec==sec&&LOCREF(tree->c.sym)&&
|
|
tree->c.sym->pc-pc>=-128&&tree->c.sym->pc-pc<=127)
|
|
return 7;
|
|
}
|
|
return p->code;
|
|
}
|
|
|
|
static int operand_code(operand *p)
|
|
{
|
|
if(!p)
|
|
return 0;
|
|
if(p->type==OP_REG)
|
|
return p->basereg;
|
|
if(p->type==OP_REGIND)
|
|
return 4+p->basereg;
|
|
if(p->type==OP_ABS)
|
|
return 8;
|
|
if(p->type==OP_IMM32)
|
|
return 9;
|
|
ierror(0);
|
|
}
|
|
static char *fill_operand(operand *p,section *sec,taddr pc,char *d,rlist **relocs,int roffset)
|
|
{
|
|
taddr val;
|
|
if(!p||p->type==OP_REG)
|
|
return d;
|
|
/* FIXME: Test for valid operand, create reloc */
|
|
if(!eval_expr(p->offset,&val,sec,pc)){
|
|
symbol *base;
|
|
if (find_base(p->offset,&base,sec,pc)!=BASE_OK)
|
|
general_error(38);
|
|
else
|
|
add_nreloc(relocs,base,0,REL_ABS,16,roffset*8);
|
|
}
|
|
*d++=val>>24;
|
|
*d++=val>>16;
|
|
*d++=val>>8;
|
|
*d++=val;
|
|
return d;
|
|
}
|
|
|
|
/* Convert an instruction into a DATA atom including relocations,
|
|
if necessary. */
|
|
dblock *eval_instruction(instruction *p,section *sec,taddr pc)
|
|
{
|
|
/* Auch simpel. Fehlerchecks fehlen. */
|
|
size_t size=instruction_size(p,sec,pc);
|
|
dblock *db=new_dblock();
|
|
int c=opt_inst(p,sec,pc);
|
|
unsigned char *d;
|
|
taddr val;
|
|
db->size=size;
|
|
d=db->data=mymalloc(size);
|
|
*d=c;
|
|
if(p->qualifiers[0]){
|
|
if(c>5)
|
|
cpu_error(1,p->qualifiers[0]);
|
|
else if(!strcmp(p->qualifiers[0],"b"))
|
|
*d|=128;
|
|
else if(strcmp(p->qualifiers[0],"w"))
|
|
cpu_error(1,p->qualifiers[0]);
|
|
}
|
|
d++;
|
|
if(c==5){
|
|
/* addq */
|
|
taddr val;
|
|
if(!eval_expr(p->op[0]->offset,&val,sec,pc)||val>15)
|
|
cpu_error(0);
|
|
*d=((val<<4)|operand_code(p->op[1]));
|
|
return db;
|
|
}
|
|
if(c==7){
|
|
expr *tree=p->op[0]->offset;
|
|
if(!(tree->type==SYM&&tree->c.sym->sec==sec&&LOCREF(tree->c.sym)&&
|
|
tree->c.sym->pc-pc>=-128&&tree->c.sym->pc-pc<=127))
|
|
cpu_error(0);
|
|
else
|
|
*d=tree->c.sym->pc-pc;
|
|
return db;
|
|
}
|
|
|
|
*d=((operand_code(p->op[0])<<4)|operand_code(p->op[1]));
|
|
d++;
|
|
d=fill_operand(p->op[0],sec,pc,d,&db->relocs,d-db->data);
|
|
d=fill_operand(p->op[1],sec,pc,d,&db->relocs,d-db->data);
|
|
return db;
|
|
}
|
|
|
|
/* Create a dblock (with relocs, if necessary) for size bits of data. */
|
|
dblock *eval_data(operand *op,size_t bitsize,section *sec,taddr pc)
|
|
{
|
|
dblock *new=new_dblock();
|
|
taddr val;
|
|
new->size=(bitsize+7)/8;
|
|
new->data=mymalloc(new->size);
|
|
if(op->type!=OP_ABS)
|
|
ierror(0);
|
|
if(bitsize!=8&&bitsize!=16&&bitsize!=32)
|
|
cpu_error(2);
|
|
if(!eval_expr(op->offset,&val,sec,pc)&&bitsize!=32)
|
|
general_error(38);
|
|
if(bitsize==8){
|
|
new->data[0]=val;
|
|
}else if(bitsize==16){
|
|
new->data[0]=val>>8;
|
|
new->data[1]=val;
|
|
}else if(bitsize==32){
|
|
fill_operand(op,sec,pc,new->data,&new->relocs,0);
|
|
}
|
|
return new;
|
|
}
|
|
|
|
static taddr opsize(operand *p)
|
|
{
|
|
if(!p)
|
|
return 0;
|
|
if(p->type!=OP_REG)
|
|
return 4;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
/* Calculate the size of the current instruction; must be identical
|
|
to the data created by eval_instruction. */
|
|
size_t instruction_size(instruction *p,section *sec,taddr pc)
|
|
{
|
|
int c;
|
|
size_t size=2;
|
|
size+=opsize(p->op[0]);
|
|
size+=opsize(p->op[1]);
|
|
c=opt_inst(p,sec,pc);
|
|
if(c==5||c==7){
|
|
/* addq/bra */
|
|
size-=4;
|
|
}
|
|
return size;
|
|
}
|
|
|
|
operand *new_operand()
|
|
{
|
|
operand *new=mymalloc(sizeof(*new));
|
|
new->type=-1;
|
|
return new;
|
|
}
|
|
|
|
/* return true, if initialization was successfull */
|
|
int init_cpu()
|
|
{
|
|
return 1;
|
|
}
|
|
|
|
/* return true, if the passed argument is understood */
|
|
int cpu_args(char *p)
|
|
{
|
|
/* no args */
|
|
return 0;
|
|
}
|
|
|
|
/* parse cpu-specific directives; return pointer to end of
|
|
cpu-specific text */
|
|
char *parse_cpu_special(char *s)
|
|
{
|
|
/* no specials */
|
|
return s;
|
|
}
|