#include "defs.h"
#include "frame.h"
#include "symtab.h"
#include "value.h"
#include "gdbcmd.h"
#include "regcache.h"
#include "symfile.h"
#include "gdbcore.h"
#include "inferior.h"
static CORE_ADDR mcore_analyze_prologue (struct frame_info *fi, CORE_ADDR pc, int skip_prologue);
static struct frame_info *analyze_dummy_frame (CORE_ADDR pc, CORE_ADDR frame);
static int get_insn (CORE_ADDR pc);
int mcore_use_struct_convention (int gcc_p, struct type *type);
void _initialize_mcore (void);
void mcore_init_extra_frame_info (struct frame_info *fi);
CORE_ADDR mcore_frame_saved_pc (struct frame_info *fi);
CORE_ADDR mcore_find_callers_reg (struct frame_info *fi, int regnum);
CORE_ADDR mcore_frame_args_address (struct frame_info *fi);
CORE_ADDR mcore_frame_locals_address (struct frame_info *fi);
CORE_ADDR mcore_push_return_address (CORE_ADDR pc, CORE_ADDR sp);
CORE_ADDR mcore_push_arguments (int nargs, struct value ** args, CORE_ADDR sp,
unsigned char struct_return, CORE_ADDR struct_addr);
void mcore_pop_frame (struct frame_info *fi);
CORE_ADDR mcore_skip_prologue (CORE_ADDR pc);
CORE_ADDR mcore_frame_chain (struct frame_info *fi);
unsigned char *mcore_breakpoint_from_pc (CORE_ADDR * bp_addr, int *bp_size);
int mcore_use_struct_convention (int gcc_p, struct type *type);
void mcore_store_return_value (struct type *type, char *valbuf);
CORE_ADDR mcore_extract_struct_value_address (char *regbuf);
void mcore_extract_return_value (struct type *type, char *regbuf, char *valbuf);
#ifdef MCORE_DEBUG
int mcore_debug = 0;
#endif
char *mcore_register_names[] =
{ "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
"r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
"ar0", "ar1", "ar2", "ar3", "ar4", "ar5", "ar6", "ar7",
"ar8", "ar9", "ar10", "ar11", "ar12", "ar13", "ar14", "ar15",
"psr", "vbr", "epsr", "fpsr", "epc", "fpc", "ss0", "ss1",
"ss2", "ss3", "ss4", "gcr", "gsr", "cr13", "cr14", "cr15",
"cr16", "cr17", "cr18", "cr19", "cr20", "cr21", "cr22", "cr23",
"cr24", "cr25", "cr26", "cr27", "cr28", "cr29", "cr30", "cr31",
"pc" };
struct frame_extra_info
{
int status;
int framesize;
int fp_regnum;
};
#define MY_FRAME_IN_SP 0x1
#define MY_FRAME_IN_FP 0x2
#define NO_MORE_FRAMES 0x4
#define IS_SUBI0(x) (((x) & 0xfe0f) == 0x2400)
#define IS_STM(x) (((x) & 0xfff0) == 0x0070)
#define IS_STWx0(x) (((x) & 0xf00f) == 0x9000)
#define IS_STWxy(x) (((x) & 0xf000) == 0x9000)
#define IS_MOVx0(x) (((x) & 0xfff0) == 0x1200)
#define IS_LRW1(x) (((x) & 0xff00) == 0x7100)
#define IS_MOVI1(x) (((x) & 0xf80f) == 0x6001)
#define IS_BGENI1(x) (((x) & 0xfe0f) == 0x3201)
#define IS_BMASKI1(x) (((x) & 0xfe0f) == 0x2C01)
#define IS_ADDI1(x) (((x) & 0xfe0f) == 0x2001)
#define IS_SUBI1(x) (((x) & 0xfe0f) == 0x2401)
#define IS_RSUBI1(x) (((x) & 0xfe0f) == 0x2801)
#define IS_NOT1(x) (((x) & 0xffff) == 0x01f1)
#define IS_ROTLI1(x) (((x) & 0xfe0f) == 0x3801)
#define IS_BSETI1(x) (((x) & 0xfe0f) == 0x3401)
#define IS_BCLRI1(x) (((x) & 0xfe0f) == 0x3001)
#define IS_IXH1(x) (((x) & 0xffff) == 0x1d11)
#define IS_IXW1(x) (((x) & 0xffff) == 0x1511)
#define IS_SUB01(x) (((x) & 0xffff) == 0x0510)
#define IS_RTS(x) (((x) & 0xffff) == 0x00cf)
#define IS_R1_ADJUSTER(x) \
(IS_ADDI1(x) || IS_SUBI1(x) || IS_ROTLI1(x) || IS_BSETI1(x) \
|| IS_BCLRI1(x) || IS_RSUBI1(x) || IS_NOT1(x) \
|| IS_IXH1(x) || IS_IXW1(x))
#ifdef MCORE_DEBUG
static void
mcore_dump_insn (char *commnt, CORE_ADDR pc, int insn)
{
if (mcore_debug)
{
printf_filtered ("MCORE: %s %08x %08x ",
commnt, (unsigned int) pc, (unsigned int) insn);
TARGET_PRINT_INSN (pc, &tm_print_insn_info);
printf_filtered ("\n");
}
}
#define mcore_insn_debug(args) { if (mcore_debug) printf_filtered args; }
#else
#define mcore_dump_insn(a,b,c) {}
#define mcore_insn_debug(args) {}
#endif
unsigned char *
mcore_breakpoint_from_pc (CORE_ADDR * bp_addr, int *bp_size)
{
static char breakpoint[] =
{0x00, 0x00};
*bp_size = 2;
return breakpoint;
}
static struct frame_info *
analyze_dummy_frame (CORE_ADDR pc, CORE_ADDR frame)
{
static struct frame_info *dummy = NULL;
if (dummy == NULL)
{
dummy = (struct frame_info *) xmalloc (sizeof (struct frame_info));
dummy->saved_regs = (CORE_ADDR *) xmalloc (SIZEOF_FRAME_SAVED_REGS);
dummy->extra_info =
(struct frame_extra_info *) xmalloc (sizeof (struct frame_extra_info));
}
dummy->next = NULL;
dummy->prev = NULL;
dummy->pc = pc;
dummy->frame = frame;
dummy->extra_info->status = 0;
dummy->extra_info->framesize = 0;
memset (dummy->saved_regs, '\000', SIZEOF_FRAME_SAVED_REGS);
mcore_analyze_prologue (dummy, 0, 0);
return dummy;
}
static CORE_ADDR
mcore_analyze_prologue (struct frame_info *fi, CORE_ADDR pc, int skip_prologue)
{
CORE_ADDR func_addr, func_end, addr, stop;
CORE_ADDR stack_size;
int insn, rn;
int status;
int fp_regnum = 0;
int flags;
int framesize;
int register_offsets[NUM_REGS];
char *name;
pc = (fi == NULL ? pc : fi->pc);
status = find_pc_partial_function (pc, &name, &func_addr, &func_end);
if (status == 0)
return pc;
if (func_addr == entry_point_address ())
{
if (fi != NULL)
fi->extra_info->status |= NO_MORE_FRAMES;
return pc;
}
flags = MY_FRAME_IN_SP;
mcore_insn_debug (("MCORE: starting prologue decoding\n"));
insn = get_insn (pc);
mcore_dump_insn ("got 1: ", pc, insn);
if (fi != NULL && IS_RTS (insn))
{
mcore_insn_debug (("MCORE: got jmp r15"));
if (fi->next == NULL)
fi->frame = read_sp ();
return fi->pc;
}
if (fi != NULL && fi->pc == func_addr)
{
if (fi->next == NULL)
fi->frame = read_sp ();
return fi->pc;
}
stop = (fi ? fi->pc : func_end);
stop = (stop > func_end ? func_end : stop);
for (rn = 0; rn < NUM_REGS; rn++)
register_offsets[rn] = -1;
mcore_insn_debug (("MCORE: Scanning prologue: func_addr=0x%x, stop=0x%x\n",
(unsigned int) func_addr, (unsigned int) stop));
framesize = 0;
for (addr = func_addr; addr < stop; addr += 2)
{
insn = get_insn (addr);
mcore_dump_insn ("got 2: ", addr, insn);
if (IS_SUBI0 (insn))
{
int offset = 1 + ((insn >> 4) & 0x1f);
mcore_insn_debug (("MCORE: got subi r0,%d; continuing\n", offset));
framesize += offset;
continue;
}
else if (IS_STM (insn))
{
int offset;
int start_register;
start_register = (insn & 0xf);
mcore_insn_debug (("MCORE: got stm r%d-r15,(r0)\n", start_register));
for (rn = start_register, offset = 0; rn <= 15; rn++, offset += 4)
{
register_offsets[rn] = framesize - offset;
mcore_insn_debug (("MCORE: r%d saved at 0x%x (offset %d)\n", rn,
register_offsets[rn], offset));
}
mcore_insn_debug (("MCORE: continuing\n"));
continue;
}
else if (IS_STWx0 (insn))
{
int imm;
rn = (insn >> 8) & 0xf;
imm = (insn >> 4) & 0xf;
register_offsets[rn] = framesize - (imm << 2);
mcore_insn_debug (("MCORE: r%d saved at offset 0x%x\n", rn, register_offsets[rn]));
mcore_insn_debug (("MCORE: continuing\n"));
continue;
}
else if (IS_MOVx0 (insn))
{
flags |= MY_FRAME_IN_FP;
flags &= ~MY_FRAME_IN_SP;
fp_regnum = insn & 0xf;
mcore_insn_debug (("MCORE: Found a frame pointer: r%d\n", fp_regnum));
mcore_insn_debug (("MCORE: end of prologue\n"));
if (skip_prologue)
continue;
addr += 2;
break;
}
else if (IS_STWxy (insn) && (flags & MY_FRAME_IN_FP) && ((insn & 0xf) == fp_regnum))
{
mcore_insn_debug (("MCORE: push arg onto stack.\n"));
continue;
}
else if (IS_LRW1 (insn) || IS_MOVI1 (insn)
|| IS_BGENI1 (insn) || IS_BMASKI1 (insn))
{
int adjust = 0;
int offset = 0;
int insn2;
mcore_insn_debug (("MCORE: looking at large frame\n"));
if (IS_LRW1 (insn))
{
adjust =
read_memory_integer ((addr + 2 + ((insn & 0xff) << 2)) & 0xfffffffc, 4);
}
else if (IS_MOVI1 (insn))
adjust = (insn >> 4) & 0x7f;
else if (IS_BGENI1 (insn))
adjust = 1 << ((insn >> 4) & 0x1f);
else
adjust = (1 << (adjust >> 4) & 0x1f) - 1;
mcore_insn_debug (("MCORE: base framesize=0x%x\n", adjust));
mcore_insn_debug (("MCORE: looking for r1 adjusters...\n"));
offset = 2;
insn2 = get_insn (addr + offset);
while (IS_R1_ADJUSTER (insn2))
{
int imm;
imm = (insn2 >> 4) & 0x1f;
mcore_dump_insn ("got 3: ", addr + offset, insn);
if (IS_ADDI1 (insn2))
{
adjust += (imm + 1);
mcore_insn_debug (("MCORE: addi r1,%d\n", imm + 1));
}
else if (IS_SUBI1 (insn2))
{
adjust -= (imm + 1);
mcore_insn_debug (("MCORE: subi r1,%d\n", imm + 1));
}
else if (IS_RSUBI1 (insn2))
{
adjust = imm - adjust;
mcore_insn_debug (("MCORE: rsubi r1,%d\n", imm + 1));
}
else if (IS_NOT1 (insn2))
{
adjust = ~adjust;
mcore_insn_debug (("MCORE: not r1\n"));
}
else if (IS_ROTLI1 (insn2))
{
adjust <<= imm;
mcore_insn_debug (("MCORE: rotli r1,%d\n", imm + 1));
}
else if (IS_BSETI1 (insn2))
{
adjust |= (1 << imm);
mcore_insn_debug (("MCORE: bseti r1,%d\n", imm));
}
else if (IS_BCLRI1 (insn2))
{
adjust &= ~(1 << imm);
mcore_insn_debug (("MCORE: bclri r1,%d\n", imm));
}
else if (IS_IXH1 (insn2))
{
adjust *= 3;
mcore_insn_debug (("MCORE: ix.h r1,r1\n"));
}
else if (IS_IXW1 (insn2))
{
adjust *= 5;
mcore_insn_debug (("MCORE: ix.w r1,r1\n"));
}
offset += 2;
insn2 = get_insn (addr + offset);
};
mcore_insn_debug (("MCORE: done looking for r1 adjusters\n"));
if (IS_SUB01 (insn2))
{
addr += offset;
framesize += adjust;
mcore_insn_debug (("MCORE: found stack adjustment of 0x%x bytes.\n", adjust));
mcore_insn_debug (("MCORE: skipping to new address 0x%x\n", addr));
mcore_insn_debug (("MCORE: continuing\n"));
continue;
}
mcore_insn_debug (("MCORE: no subu r1,r0, NOT altering framesize.\n"));
break;
}
mcore_insn_debug (("MCORE: insn is not a prologue insn -- ending scan\n"));
break;
}
mcore_insn_debug (("MCORE: done analyzing prologue\n"));
mcore_insn_debug (("MCORE: prologue end = 0x%x\n", addr));
if (fi != NULL)
{
fi->extra_info->framesize = framesize;
fi->extra_info->fp_regnum = fp_regnum;
fi->extra_info->status = flags;
if (fi->next == NULL)
{
if (fi->extra_info->status & MY_FRAME_IN_SP)
fi->frame = read_sp () + framesize;
else
fi->frame = read_register (fp_regnum) + framesize;
}
for (rn = 0; rn < NUM_REGS; rn++)
{
if (register_offsets[rn] >= 0)
{
fi->saved_regs[rn] = fi->frame - register_offsets[rn];
mcore_insn_debug (("Saved register %s stored at 0x%08x, value=0x%08x\n",
mcore_register_names[rn], fi->saved_regs[rn],
read_memory_integer (fi->saved_regs[rn], 4)));
}
}
}
return addr;
}
CORE_ADDR
mcore_frame_chain (struct frame_info * fi)
{
struct frame_info *dummy;
CORE_ADDR callers_addr;
if (fi->extra_info->status == 0)
mcore_analyze_prologue (fi, 0, 0);
if (fi->extra_info->status & NO_MORE_FRAMES)
return 0;
dummy = analyze_dummy_frame (FRAME_SAVED_PC (fi), fi->frame);
if (dummy->extra_info->status & MY_FRAME_IN_FP)
{
int fp = dummy->extra_info->fp_regnum;
if (fi->saved_regs[fp] != 0)
{
callers_addr = read_memory_integer (fi->saved_regs[fp], REGISTER_SIZE)
+ dummy->extra_info->framesize;
}
else
{
callers_addr = read_register (fp) + dummy->extra_info->framesize;
}
}
else
{
callers_addr = fi->frame + dummy->extra_info->framesize;
}
return callers_addr;
}
CORE_ADDR
mcore_skip_prologue (CORE_ADDR pc)
{
CORE_ADDR func_addr, func_end;
struct symtab_and_line sal;
if (find_pc_partial_function (pc, NULL, &func_addr, &func_end))
{
sal = find_pc_line (func_addr, 0);
if (sal.end && sal.end < func_end)
return sal.end;
}
return mcore_analyze_prologue (NULL, pc, 1);
}
CORE_ADDR
mcore_frame_args_address (struct frame_info * fi)
{
return fi->frame - fi->extra_info->framesize;
}
CORE_ADDR
mcore_frame_locals_address (struct frame_info * fi)
{
return fi->frame - fi->extra_info->framesize;
}
void
mcore_virtual_frame_pointer (CORE_ADDR pc, int *reg, LONGEST *offset)
{
struct frame_info *dummy = analyze_dummy_frame (pc, 0);
if (dummy->extra_info->status & MY_FRAME_IN_SP)
{
*reg = SP_REGNUM;
*offset = 0;
}
else
{
*reg = dummy->extra_info->fp_regnum;
*offset = 0;
}
}
CORE_ADDR
mcore_find_callers_reg (struct frame_info *fi, int regnum)
{
for (; fi != NULL; fi = fi->next)
{
if (PC_IN_CALL_DUMMY (fi->pc, fi->frame, fi->frame))
return generic_read_register_dummy (fi->pc, fi->frame, regnum);
else if (fi->saved_regs[regnum] != 0)
return read_memory_integer (fi->saved_regs[regnum],
REGISTER_SIZE);
}
return read_register (regnum);
}
CORE_ADDR
mcore_frame_saved_pc (struct frame_info * fi)
{
if (PC_IN_CALL_DUMMY (fi->pc, fi->frame, fi->frame))
return generic_read_register_dummy (fi->pc, fi->frame, PC_REGNUM);
else
return mcore_find_callers_reg (fi, PR_REGNUM);
}
void
mcore_pop_frame (struct frame_info *fi)
{
int rn;
if (PC_IN_CALL_DUMMY (fi->pc, fi->frame, fi->frame))
generic_pop_dummy_frame ();
else
{
write_register (PC_REGNUM, FRAME_SAVED_PC (fi));
for (rn = 0; rn < NUM_REGS; rn++)
{
if (fi->saved_regs[rn] != 0)
{
ULONGEST value;
value = read_memory_unsigned_integer (fi->saved_regs[rn],
REGISTER_SIZE);
write_register (rn, value);
}
}
write_register (SP_REGNUM, FRAME_FP (fi));
}
flush_cached_frames ();
}
CORE_ADDR
mcore_push_arguments (int nargs, struct value **args, CORE_ADDR sp,
unsigned char struct_return, CORE_ADDR struct_addr)
{
int argreg;
int argnum;
struct stack_arg
{
int len;
char *val;
}
*stack_args;
int nstack_args = 0;
stack_args = (struct stack_arg *) alloca (nargs * sizeof (struct stack_arg));
argreg = FIRST_ARGREG;
sp &= ~3;
if (struct_return)
write_register (argreg++, struct_addr);
for (argnum = 0; argnum < nargs; argnum++)
{
char *val = (char *) VALUE_CONTENTS (args[argnum]);
int len = TYPE_LENGTH (VALUE_TYPE (args[argnum]));
struct type *type = VALUE_TYPE (args[argnum]);
int olen;
mcore_insn_debug (("MCORE PUSH: argreg=%d; len=%d; %s\n",
argreg, len, TYPE_CODE (type) == TYPE_CODE_STRUCT ? "struct" : "not struct"));
olen = len;
if (TYPE_CODE (type) != TYPE_CODE_STRUCT && len > REGISTER_SIZE && argreg % 2)
{
mcore_insn_debug (("MCORE PUSH: %d > REGISTER_SIZE: and %s is not even\n",
len, mcore_register_names[argreg]));
argreg++;
}
if ((argreg <= LAST_ARGREG && len <= (LAST_ARGREG - argreg + 1) * REGISTER_SIZE)
|| (TYPE_CODE (type) == TYPE_CODE_STRUCT))
{
mcore_insn_debug (("MCORE PUSH: arg %d going into regs\n", argnum));
if (TYPE_CODE (type) == TYPE_CODE_STRUCT && olen < REGISTER_SIZE)
{
write_register (argreg, extract_unsigned_integer (val, len));
argreg++;
len = 0;
}
while (len > 0 && argreg <= LAST_ARGREG)
{
write_register (argreg, extract_unsigned_integer (val, REGISTER_SIZE));
argreg++;
val += REGISTER_SIZE;
len -= REGISTER_SIZE;
}
}
else if (TYPE_CODE (VALUE_TYPE (args[argnum])) != TYPE_CODE_STRUCT
&& len > REGISTER_SIZE)
{
mcore_insn_debug (("MCORE PUSH: does not fit into regs, going onto stack\n"));
argnum = LAST_ARGREG + 1;
}
if (len > 0)
{
mcore_insn_debug (("MCORE PUSH: adding arg %d to stack\n", argnum));
stack_args[nstack_args].val = val;
stack_args[nstack_args].len = len;
nstack_args++;
}
}
while (nstack_args--)
{
sp -= stack_args[nstack_args].len;
write_memory (sp, stack_args[nstack_args].val, stack_args[nstack_args].len);
}
return sp;
}
CORE_ADDR
mcore_push_return_address (CORE_ADDR pc, CORE_ADDR sp)
{
write_register (PR_REGNUM, CALL_DUMMY_ADDRESS ());
return sp;
}
int
mcore_use_struct_convention (int gcc_p, struct type *type)
{
return (TYPE_LENGTH (type) > 8);
}
CORE_ADDR
mcore_extract_struct_value_address (char *regbuf)
{
return extract_address (regbuf + REGISTER_BYTE (FIRST_ARGREG), REGISTER_SIZE);
}
void
mcore_extract_return_value (struct type *type, char *regbuf, char *valbuf)
{
memcpy (valbuf, regbuf + REGISTER_BYTE (RETVAL_REGNUM) +
(TYPE_LENGTH (type) < 4 ? 4 - TYPE_LENGTH (type) : 0), TYPE_LENGTH (type));
}
void
mcore_store_return_value (struct type *type, char *valbuf)
{
int value_size;
int return_size;
int offset;
char *zeros;
value_size = TYPE_LENGTH (type);
return_size = (value_size + REGISTER_SIZE - 1) & ~(REGISTER_SIZE - 1);
offset = REGISTER_BYTE (RETVAL_REGNUM) + (return_size - value_size);
zeros = alloca (return_size);
memset (zeros, 0, return_size);
write_register_bytes (REGISTER_BYTE (RETVAL_REGNUM), zeros, return_size);
write_register_bytes (offset, valbuf, value_size);
}
void
mcore_init_extra_frame_info (struct frame_info *fi)
{
if (fi->next)
fi->pc = FRAME_SAVED_PC (fi->next);
frame_saved_regs_zalloc (fi);
fi->extra_info = (struct frame_extra_info *)
frame_obstack_alloc (sizeof (struct frame_extra_info));
fi->extra_info->status = 0;
fi->extra_info->framesize = 0;
if (PC_IN_CALL_DUMMY (fi->pc, fi->frame, fi->frame))
{
fi->frame = generic_read_register_dummy (fi->pc, fi->frame, SP_REGNUM);
}
else
mcore_analyze_prologue (fi, 0, 0);
}
static int
get_insn (CORE_ADDR pc)
{
char buf[4];
int status = read_memory_nobpt (pc, buf, 2);
if (status != 0)
return 0;
return extract_unsigned_integer (buf, 2);
}
void
_initialize_mcore_tdep (void)
{
extern int print_insn_mcore (bfd_vma, disassemble_info *);
tm_print_insn = print_insn_mcore;
#ifdef MCORE_DEBUG
add_show_from_set (add_set_cmd ("mcoredebug", no_class,
var_boolean, (char *) &mcore_debug,
"Set mcore debugging.\n", &setlist),
&showlist);
#endif
}