#include "defs.h"
#include "frame.h"
#include "frame-base.h"
#include "frame-unwind.h"
#include "dwarf2-frame.h"
#include "symtab.h"
#include "gdbtypes.h"
#include "gdbcmd.h"
#include "gdbcore.h"
#include "value.h"
#include "dis-asm.h"
#include "inferior.h"
#include "gdb_string.h"
#include "gdb_assert.h"
#include "arch-utils.h"
#include "floatformat.h"
#include "regcache.h"
#include "doublest.h"
#include "osabi.h"
#include "objfiles.h"
enum gdb_regnum
{
E_R0_REGNUM,
E_R1_REGNUM,
E_R2_REGNUM, E_1ST_ARG_REGNUM = E_R2_REGNUM, E_PTR_RET_REGNUM = E_R2_REGNUM,
E_R3_REGNUM,
E_R4_REGNUM,
E_R5_REGNUM,
E_R6_REGNUM,
E_R7_REGNUM, E_LST_ARG_REGNUM = E_R7_REGNUM,
E_R8_REGNUM,
E_R9_REGNUM,
E_R10_REGNUM,
E_R11_REGNUM,
E_R12_REGNUM,
E_R13_REGNUM, E_FP_REGNUM = E_R13_REGNUM,
E_R14_REGNUM, E_PSW_REGNUM = E_R14_REGNUM,
E_R15_REGNUM, E_SP_REGNUM = E_R15_REGNUM,
E_PC_REGNUM,
E_NUM_REGS
};
enum { REG_UNAVAIL = (CORE_ADDR) -1 };
struct xstormy16_frame_cache
{
CORE_ADDR base;
CORE_ADDR pc;
LONGEST framesize;
int uses_fp;
CORE_ADDR saved_regs[E_NUM_REGS];
CORE_ADDR saved_sp;
};
enum
{
xstormy16_inst_size = 2,
xstormy16_reg_size = 2,
xstormy16_pc_size = 4
};
#define E_MAX_RETTYPE_SIZE(regnum) ((E_LST_ARG_REGNUM - (regnum) + 1) \
* xstormy16_reg_size)
enum
{
E_MAX_RETTYPE_SIZE_IN_REGS = E_MAX_RETTYPE_SIZE (E_R2_REGNUM)
};
static const char *
xstormy16_register_name (int regnum)
{
static char *register_names[] = {
"r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
"r8", "r9", "r10", "r11", "r12", "r13",
"psw", "sp", "pc"
};
if (regnum < 0 || regnum >= E_NUM_REGS)
internal_error (__FILE__, __LINE__,
_("xstormy16_register_name: illegal register number %d"),
regnum);
else
return register_names[regnum];
}
static struct type *
xstormy16_register_type (struct gdbarch *gdbarch, int regnum)
{
if (regnum == E_PC_REGNUM)
return builtin_type_uint32;
else
return builtin_type_uint16;
}
static int
xstormy16_type_is_scalar (struct type *t)
{
return (TYPE_CODE(t) != TYPE_CODE_STRUCT
&& TYPE_CODE(t) != TYPE_CODE_UNION
&& TYPE_CODE(t) != TYPE_CODE_ARRAY);
}
static int
xstormy16_use_struct_convention (struct type *type)
{
return !xstormy16_type_is_scalar (type)
|| TYPE_LENGTH (type) > E_MAX_RETTYPE_SIZE_IN_REGS;
}
static void
xstormy16_extract_return_value (struct type *type, struct regcache *regcache,
void *valbuf)
{
int len = TYPE_LENGTH (type);
int i, regnum = E_1ST_ARG_REGNUM;
for (i = 0; i < len; i += xstormy16_reg_size)
regcache_raw_read (regcache, regnum++, (char *) valbuf + i);
}
static void
xstormy16_store_return_value (struct type *type, struct regcache *regcache,
const void *valbuf)
{
if (TYPE_LENGTH (type) == 1)
{
char buf[xstormy16_reg_size];
memset (buf, 0, xstormy16_reg_size);
memcpy (buf, valbuf, 1);
regcache_raw_write (regcache, E_1ST_ARG_REGNUM, buf);
}
else
{
int len = TYPE_LENGTH (type);
int i, regnum = E_1ST_ARG_REGNUM;
for (i = 0; i < len; i += xstormy16_reg_size)
regcache_raw_write (regcache, regnum++, (char *) valbuf + i);
}
}
static enum return_value_convention
xstormy16_return_value (struct gdbarch *gdbarch, struct type *type,
struct regcache *regcache,
void *readbuf, const void *writebuf)
{
if (xstormy16_use_struct_convention (type))
return RETURN_VALUE_STRUCT_CONVENTION;
if (writebuf)
xstormy16_store_return_value (type, regcache, writebuf);
else if (readbuf)
xstormy16_extract_return_value (type, regcache, readbuf);
return RETURN_VALUE_REGISTER_CONVENTION;
}
static CORE_ADDR
xstormy16_frame_align (struct gdbarch *gdbarch, CORE_ADDR addr)
{
if (addr & 1)
++addr;
return addr;
}
static CORE_ADDR
xstormy16_push_dummy_call (struct gdbarch *gdbarch,
struct value *function,
struct regcache *regcache,
CORE_ADDR bp_addr, int nargs,
struct value **args,
CORE_ADDR sp, int struct_return,
CORE_ADDR struct_addr)
{
CORE_ADDR stack_dest = sp;
int argreg = E_1ST_ARG_REGNUM;
int i, j;
int typelen, slacklen;
char *val;
char buf[xstormy16_pc_size];
if (struct_return)
{
regcache_cooked_write_unsigned (regcache, E_PTR_RET_REGNUM, struct_addr);
argreg++;
}
for (i = 0; i < nargs && argreg <= E_LST_ARG_REGNUM; i++)
{
typelen = TYPE_LENGTH (value_enclosing_type (args[i]));
if (typelen > E_MAX_RETTYPE_SIZE (argreg))
break;
val = value_contents (args[i]);
for (j = 0; j < typelen; j += xstormy16_reg_size)
regcache_cooked_write_unsigned (regcache, argreg++,
extract_unsigned_integer (val + j,
typelen - j ==
1 ? 1 :
xstormy16_reg_size));
}
stack_dest = xstormy16_frame_align (gdbarch, stack_dest);
for (j = nargs - 1; j >= i; j--)
{
typelen = TYPE_LENGTH (value_enclosing_type (args[j]));
slacklen = typelen & 1;
val = alloca (typelen + slacklen);
memcpy (val, value_contents (args[j]), typelen);
memset (val + typelen, 0, slacklen);
write_memory (stack_dest, val, typelen + slacklen);
stack_dest += typelen + slacklen;
}
store_unsigned_integer (buf, xstormy16_pc_size, bp_addr);
write_memory (stack_dest, buf, xstormy16_pc_size);
stack_dest += xstormy16_pc_size;
regcache_cooked_write_unsigned (regcache, E_SP_REGNUM, stack_dest);
return stack_dest - xstormy16_pc_size;
}
static CORE_ADDR
xstormy16_analyze_prologue (CORE_ADDR start_addr, CORE_ADDR end_addr,
struct xstormy16_frame_cache *cache,
struct frame_info *next_frame)
{
CORE_ADDR next_addr;
ULONGEST inst, inst2;
LONGEST offset;
int regnum;
cache->saved_regs[E_PC_REGNUM] = 0;
cache->framesize = xstormy16_pc_size;
if (start_addr >= end_addr)
return end_addr;
for (next_addr = start_addr;
next_addr < end_addr; next_addr += xstormy16_inst_size)
{
inst = read_memory_unsigned_integer (next_addr, xstormy16_inst_size);
inst2 = read_memory_unsigned_integer (next_addr + xstormy16_inst_size,
xstormy16_inst_size);
if (inst >= 0x0082 && inst <= 0x008d)
{
regnum = inst & 0x000f;
cache->saved_regs[regnum] = cache->framesize;
cache->framesize += xstormy16_reg_size;
}
else if (inst == 0x301f || inst == 0x303f)
{
cache->framesize += ((inst & 0x0030) >> 4) + 1;
}
else if ((inst & 0xff0f) == 0x510f)
{
cache->framesize += (inst & 0x00f0) >> 4;
}
else if (inst == 0x314f && inst2 >= 0x0010)
{
cache->framesize += inst2;
next_addr += xstormy16_inst_size;
}
else if (inst == 0x46fd)
{
cache->uses_fp = 1;
}
else if ((inst & 0xff00) == 0x4600
&& (inst & 0x00f0) >= 0x0020 && (inst & 0x00f0) <= 0x0070
&& (inst & 0x000f) >= 0x00a0 && (inst & 0x000f) <= 0x000d)
;
else if ((inst & 0xfed8) == 0x72d8 && (inst & 0x0007) >= 2)
{
regnum = inst & 0x0007;
offset = (LONGEST) (inst2 & 0x0fff);
if (offset & 0x0800)
offset -= 0x1000;
cache->saved_regs[regnum] = cache->framesize + offset;
next_addr += xstormy16_inst_size;
}
else
break;
}
return next_addr;
}
static CORE_ADDR
xstormy16_skip_prologue (CORE_ADDR pc)
{
CORE_ADDR func_addr = 0, func_end = 0;
char *func_name;
if (find_pc_partial_function (pc, &func_name, &func_addr, &func_end))
{
struct symtab_and_line sal;
struct symbol *sym;
struct xstormy16_frame_cache cache;
memset (&cache, 0, sizeof cache);
CORE_ADDR plg_end = xstormy16_analyze_prologue (func_addr, func_end,
&cache, NULL);
if (!cache.uses_fp)
return plg_end;
sym = lookup_symbol (func_name, NULL, VAR_DOMAIN, NULL, NULL);
if (sym && SYMBOL_LANGUAGE (sym) != language_asm)
{
sal = find_pc_line (func_addr, 0);
if (sal.end && sal.end < func_end)
{
return sal.end;
}
}
return plg_end;
}
return (CORE_ADDR) pc;
}
static int
xstormy16_in_function_epilogue_p (struct gdbarch *gdbarch, CORE_ADDR pc)
{
CORE_ADDR func_addr = 0, func_end = 0;
if (find_pc_partial_function (pc, NULL, &func_addr, &func_end))
{
ULONGEST inst, inst2;
CORE_ADDR addr = func_end - xstormy16_inst_size;
if (pc < func_end - 7 * xstormy16_inst_size)
return 0;
inst = read_memory_unsigned_integer (addr, xstormy16_inst_size);
if (inst != 0x0003)
return 0;
while ((addr -= xstormy16_inst_size) >= func_addr)
{
inst = read_memory_unsigned_integer (addr, xstormy16_inst_size);
if (inst >= 0x009a && inst <= 0x009d)
continue;
if (inst == 0x305f || inst == 0x307f)
break;
inst2 = read_memory_unsigned_integer (addr - xstormy16_inst_size,
xstormy16_inst_size);
if (inst2 == 0x314f && inst >= 0x8000)
{
addr -= xstormy16_inst_size;
break;
}
return 0;
}
if (pc > addr)
return 1;
}
return 0;
}
const static unsigned char *
xstormy16_breakpoint_from_pc (CORE_ADDR *pcptr, int *lenptr)
{
static unsigned char breakpoint[] = { 0x06, 0x0 };
*lenptr = sizeof (breakpoint);
return breakpoint;
}
static CORE_ADDR
xstormy16_resolve_jmp_table_entry (CORE_ADDR faddr)
{
struct obj_section *faddr_sect = find_pc_section (faddr);
if (faddr_sect)
{
LONGEST inst, inst2, addr;
char buf[2 * xstormy16_inst_size];
if (strcmp (faddr_sect->the_bfd_section->name, ".plt"))
return faddr;
if (!target_read_memory (faddr, buf, sizeof buf))
{
inst = extract_unsigned_integer (buf, xstormy16_inst_size);
inst2 = extract_unsigned_integer (buf + xstormy16_inst_size,
xstormy16_inst_size);
addr = inst2 << 8 | (inst & 0xff);
return addr;
}
}
return 0;
}
static CORE_ADDR
xstormy16_find_jmp_table_entry (CORE_ADDR faddr)
{
struct obj_section *faddr_sect = find_pc_section (faddr);
if (faddr_sect)
{
struct obj_section *osect;
if (!strcmp (faddr_sect->the_bfd_section->name, ".plt"))
return faddr;
ALL_OBJFILE_OSECTIONS (faddr_sect->objfile, osect)
{
if (!strcmp (osect->the_bfd_section->name, ".plt"))
break;
}
if (osect < faddr_sect->objfile->sections_end)
{
CORE_ADDR addr;
for (addr = osect->addr;
addr < osect->endaddr; addr += 2 * xstormy16_inst_size)
{
LONGEST inst, inst2, faddr2;
char buf[2 * xstormy16_inst_size];
if (target_read_memory (addr, buf, sizeof buf))
return 0;
inst = extract_unsigned_integer (buf, xstormy16_inst_size);
inst2 = extract_unsigned_integer (buf + xstormy16_inst_size,
xstormy16_inst_size);
faddr2 = inst2 << 8 | (inst & 0xff);
if (faddr == faddr2)
return addr;
}
}
}
return 0;
}
static CORE_ADDR
xstormy16_skip_trampoline_code (CORE_ADDR pc)
{
CORE_ADDR tmp = xstormy16_resolve_jmp_table_entry (pc);
if (tmp && tmp != pc)
return tmp;
return 0;
}
static CORE_ADDR
xstormy16_pointer_to_address (struct type *type, const void *buf)
{
enum type_code target = TYPE_CODE (TYPE_TARGET_TYPE (type));
CORE_ADDR addr = extract_unsigned_integer (buf, TYPE_LENGTH (type));
if (target == TYPE_CODE_FUNC || target == TYPE_CODE_METHOD)
{
CORE_ADDR addr2 = xstormy16_resolve_jmp_table_entry (addr);
if (addr2)
addr = addr2;
}
return addr;
}
static void
xstormy16_address_to_pointer (struct type *type, void *buf, CORE_ADDR addr)
{
enum type_code target = TYPE_CODE (TYPE_TARGET_TYPE (type));
if (target == TYPE_CODE_FUNC || target == TYPE_CODE_METHOD)
{
CORE_ADDR addr2 = xstormy16_find_jmp_table_entry (addr);
if (addr2)
addr = addr2;
}
store_unsigned_integer (buf, TYPE_LENGTH (type), addr);
}
static struct xstormy16_frame_cache *
xstormy16_alloc_frame_cache (void)
{
struct xstormy16_frame_cache *cache;
int i;
cache = FRAME_OBSTACK_ZALLOC (struct xstormy16_frame_cache);
cache->base = 0;
cache->saved_sp = 0;
cache->pc = 0;
cache->uses_fp = 0;
cache->framesize = 0;
for (i = 0; i < E_NUM_REGS; ++i)
cache->saved_regs[i] = REG_UNAVAIL;
return cache;
}
static struct xstormy16_frame_cache *
xstormy16_frame_cache (struct frame_info *next_frame, void **this_cache)
{
struct xstormy16_frame_cache *cache;
CORE_ADDR current_pc;
int i;
if (*this_cache)
return *this_cache;
cache = xstormy16_alloc_frame_cache ();
*this_cache = cache;
cache->base = frame_unwind_register_unsigned (next_frame, E_FP_REGNUM);
if (cache->base == 0)
return cache;
cache->pc = frame_func_unwind (next_frame);
current_pc = frame_pc_unwind (next_frame);
if (cache->pc)
xstormy16_analyze_prologue (cache->pc, current_pc, cache, next_frame);
if (!cache->uses_fp)
cache->base = frame_unwind_register_unsigned (next_frame, E_SP_REGNUM);
cache->saved_sp = cache->base - cache->framesize;
for (i = 0; i < E_NUM_REGS; ++i)
if (cache->saved_regs[i] != REG_UNAVAIL)
cache->saved_regs[i] += cache->saved_sp;
return cache;
}
static void
xstormy16_frame_prev_register (struct frame_info *next_frame, void **this_cache,
int regnum, enum opt_state *optimizedp,
enum lval_type *lvalp, CORE_ADDR *addrp,
int *realnump, void *valuep)
{
struct xstormy16_frame_cache *cache = xstormy16_frame_cache (next_frame,
this_cache);
gdb_assert (regnum >= 0);
if (regnum == E_SP_REGNUM && cache->saved_sp)
{
*optimizedp = opt_okay;
*lvalp = not_lval;
*addrp = 0;
*realnump = -1;
if (valuep)
{
store_unsigned_integer (valuep, xstormy16_reg_size, cache->saved_sp);
}
return;
}
if (regnum < E_NUM_REGS && cache->saved_regs[regnum] != REG_UNAVAIL)
{
*optimizedp = opt_okay;
*lvalp = lval_memory;
*addrp = cache->saved_regs[regnum];
*realnump = -1;
if (valuep)
{
read_memory (*addrp, valuep,
register_size (current_gdbarch, regnum));
}
return;
}
*optimizedp = opt_okay;
*lvalp = lval_register;
*addrp = 0;
*realnump = regnum;
if (valuep)
frame_unwind_register (next_frame, (*realnump), valuep);
}
static void
xstormy16_frame_this_id (struct frame_info *next_frame, void **this_cache,
struct frame_id *this_id)
{
struct xstormy16_frame_cache *cache = xstormy16_frame_cache (next_frame,
this_cache);
if (cache->base == 0)
return;
*this_id = frame_id_build (cache->saved_sp, cache->pc);
}
static CORE_ADDR
xstormy16_frame_base_address (struct frame_info *next_frame, void **this_cache)
{
struct xstormy16_frame_cache *cache = xstormy16_frame_cache (next_frame,
this_cache);
return cache->base;
}
static const struct frame_unwind xstormy16_frame_unwind = {
NORMAL_FRAME,
xstormy16_frame_this_id,
xstormy16_frame_prev_register
};
static const struct frame_base xstormy16_frame_base = {
&xstormy16_frame_unwind,
xstormy16_frame_base_address,
xstormy16_frame_base_address,
xstormy16_frame_base_address
};
static const struct frame_unwind *
xstormy16_frame_sniffer (struct frame_info *next_frame)
{
return &xstormy16_frame_unwind;
}
static CORE_ADDR
xstormy16_unwind_sp (struct gdbarch *gdbarch, struct frame_info *next_frame)
{
return frame_unwind_register_unsigned (next_frame, E_SP_REGNUM);
}
static CORE_ADDR
xstormy16_unwind_pc (struct gdbarch *gdbarch, struct frame_info *next_frame)
{
return frame_unwind_register_unsigned (next_frame, E_PC_REGNUM);
}
static struct frame_id
xstormy16_unwind_dummy_id (struct gdbarch *gdbarch,
struct frame_info *next_frame)
{
return frame_id_build (xstormy16_unwind_sp (gdbarch, next_frame),
frame_pc_unwind (next_frame));
}
static struct gdbarch *
xstormy16_gdbarch_init (struct gdbarch_info info, struct gdbarch_list *arches)
{
struct gdbarch *gdbarch;
arches = gdbarch_list_lookup_by_info (arches, &info);
if (arches != NULL)
return (arches->gdbarch);
gdbarch = gdbarch_alloc (&info, NULL);
set_gdbarch_num_regs (gdbarch, E_NUM_REGS);
set_gdbarch_num_pseudo_regs (gdbarch, 0);
set_gdbarch_sp_regnum (gdbarch, E_SP_REGNUM);
set_gdbarch_pc_regnum (gdbarch, E_PC_REGNUM);
set_gdbarch_register_name (gdbarch, xstormy16_register_name);
set_gdbarch_register_type (gdbarch, xstormy16_register_type);
set_gdbarch_char_signed (gdbarch, 0);
set_gdbarch_short_bit (gdbarch, 2 * TARGET_CHAR_BIT);
set_gdbarch_int_bit (gdbarch, 2 * TARGET_CHAR_BIT);
set_gdbarch_long_bit (gdbarch, 4 * TARGET_CHAR_BIT);
set_gdbarch_long_long_bit (gdbarch, 8 * TARGET_CHAR_BIT);
set_gdbarch_float_bit (gdbarch, 4 * TARGET_CHAR_BIT);
set_gdbarch_double_bit (gdbarch, 8 * TARGET_CHAR_BIT);
set_gdbarch_long_double_bit (gdbarch, 8 * TARGET_CHAR_BIT);
set_gdbarch_ptr_bit (gdbarch, 2 * TARGET_CHAR_BIT);
set_gdbarch_addr_bit (gdbarch, 4 * TARGET_CHAR_BIT);
set_gdbarch_address_to_pointer (gdbarch, xstormy16_address_to_pointer);
set_gdbarch_pointer_to_address (gdbarch, xstormy16_pointer_to_address);
set_gdbarch_write_pc (gdbarch, generic_target_write_pc);
set_gdbarch_inner_than (gdbarch, core_addr_greaterthan);
set_gdbarch_unwind_sp (gdbarch, xstormy16_unwind_sp);
set_gdbarch_unwind_pc (gdbarch, xstormy16_unwind_pc);
set_gdbarch_unwind_dummy_id (gdbarch, xstormy16_unwind_dummy_id);
set_gdbarch_frame_align (gdbarch, xstormy16_frame_align);
frame_base_set_default (gdbarch, &xstormy16_frame_base);
set_gdbarch_skip_prologue (gdbarch, xstormy16_skip_prologue);
set_gdbarch_in_function_epilogue_p (gdbarch,
xstormy16_in_function_epilogue_p);
set_gdbarch_push_dummy_call (gdbarch, xstormy16_push_dummy_call);
set_gdbarch_breakpoint_from_pc (gdbarch, xstormy16_breakpoint_from_pc);
set_gdbarch_return_value (gdbarch, xstormy16_return_value);
set_gdbarch_skip_trampoline_code (gdbarch, xstormy16_skip_trampoline_code);
set_gdbarch_print_insn (gdbarch, print_insn_xstormy16);
gdbarch_init_osabi (info, gdbarch);
frame_unwind_append_sniffer (gdbarch, dwarf2_frame_sniffer);
frame_unwind_append_sniffer (gdbarch, xstormy16_frame_sniffer);
return gdbarch;
}
extern initialize_file_ftype _initialize_xstormy16_tdep;
void
_initialize_xstormy16_tdep (void)
{
register_gdbarch_init (bfd_arch_xstormy16, xstormy16_gdbarch_init);
}