#include "defs.h"
#include "frame.h"
#include "symtab.h"
#include "gdbcore.h"
#include "value.h"
#include "gdb_string.h"
#include "inferior.h"
#include "regcache.h"
#define P_LINKL_FP 0x480e
#define P_LINKW_FP 0x4e56
#define P_PEA_FP 0x4856
#define P_MOVL_SP_FP 0x2c4f
#define P_MOVL 0x207c
#define P_JSR 0x4eb9
#define P_BSR 0x61ff
#define P_LEAL 0x43fb
#define P_MOVML 0x48ef
#define P_FMOVM 0xf237
#define P_TRAP 0x4e40
extern CORE_ADDR
altos_skip_prologue (CORE_ADDR pc)
{
register int op = read_memory_integer (pc, 2);
if (op == P_LINKW_FP)
pc += 4;
else if (op == P_LINKL_FP)
pc += 6;
else if (op == 0060000)
pc += 4;
else if (op == 00600377)
pc += 6;
else if ((op & 0177400) == 0060000)
pc += 2;
return pc;
}
int
delta68_in_sigtramp (CORE_ADDR pc, char *name)
{
if (name != NULL)
return strcmp (name, "_sigcode") == 0;
else
return 0;
}
CORE_ADDR
delta68_frame_args_address (struct frame_info *frame_info)
{
if (frame_info->signal_handler_caller)
return frame_info->frame + 12;
else if (frameless_look_for_prologue (frame_info))
{
if (frame_info->next && frame_info->next->signal_handler_caller)
return frame_info->next->frame + 16;
else
return frame_info->frame + 4;
}
else
return frame_info->frame;
}
CORE_ADDR
delta68_frame_saved_pc (struct frame_info *frame_info)
{
return read_memory_integer (delta68_frame_args_address (frame_info) + 4, 4);
}
int
isi_frame_num_args (struct frame_info *fi)
{
int val;
CORE_ADDR pc = FRAME_SAVED_PC (fi);
int insn = 0177777 & read_memory_integer (pc, 2);
val = 0;
if (insn == 0047757 || insn == 0157374)
val = read_memory_integer (pc + 2, 2);
else if ((insn & 0170777) == 0050217
|| (insn & 0170777) == 0050117)
{
val = (insn >> 9) & 7;
if (val == 0)
val = 8;
}
else if (insn == 0157774)
val = read_memory_integer (pc + 2, 4);
val >>= 2;
return val;
}
int
delta68_frame_num_args (struct frame_info *fi)
{
int val;
CORE_ADDR pc = FRAME_SAVED_PC (fi);
int insn = 0177777 & read_memory_integer (pc, 2);
val = 0;
if (insn == 0047757 || insn == 0157374)
val = read_memory_integer (pc + 2, 2);
else if ((insn & 0170777) == 0050217
|| (insn & 0170777) == 0050117)
{
val = (insn >> 9) & 7;
if (val == 0)
val = 8;
}
else if (insn == 0157774)
val = read_memory_integer (pc + 2, 4);
val >>= 2;
return val;
}
int
news_frame_num_args (struct frame_info *fi)
{
int val;
CORE_ADDR pc = FRAME_SAVED_PC (fi);
int insn = 0177777 & read_memory_integer (pc, 2);
val = 0;
if (insn == 0047757 || insn == 0157374)
val = read_memory_integer (pc + 2, 2);
else if ((insn & 0170777) == 0050217
|| (insn & 0170777) == 0050117)
{
val = (insn >> 9) & 7;
if (val == 0)
val = 8;
}
else if (insn == 0157774)
val = read_memory_integer (pc + 2, 4);
val >>= 2;
return val;
}
void
m68k_push_dummy_frame (void)
{
register CORE_ADDR sp = read_register (SP_REGNUM);
register int regnum;
char raw_buffer[12];
sp = push_word (sp, read_register (PC_REGNUM));
sp = push_word (sp, read_register (FP_REGNUM));
write_register (FP_REGNUM, sp);
for (regnum = FP0_REGNUM + 7; regnum >= FP0_REGNUM; regnum--)
{
read_register_bytes (REGISTER_BYTE (regnum), raw_buffer, 12);
sp = push_bytes (sp, raw_buffer, 12);
}
for (regnum = FP_REGNUM - 1; regnum >= 0; regnum--)
{
sp = push_word (sp, read_register (regnum));
}
sp = push_word (sp, read_register (PS_REGNUM));
write_register (SP_REGNUM, sp);
}
void
m68k_pop_frame (void)
{
register struct frame_info *frame = get_current_frame ();
register CORE_ADDR fp;
register int regnum;
struct frame_saved_regs fsr;
char raw_buffer[12];
fp = FRAME_FP (frame);
get_frame_saved_regs (frame, &fsr);
for (regnum = FP0_REGNUM + 7; regnum >= FP0_REGNUM; regnum--)
{
if (fsr.regs[regnum])
{
read_memory (fsr.regs[regnum], raw_buffer, 12);
write_register_bytes (REGISTER_BYTE (regnum), raw_buffer, 12);
}
}
for (regnum = FP_REGNUM - 1; regnum >= 0; regnum--)
{
if (fsr.regs[regnum])
{
write_register (regnum, read_memory_integer (fsr.regs[regnum], 4));
}
}
if (fsr.regs[PS_REGNUM])
{
write_register (PS_REGNUM, read_memory_integer (fsr.regs[PS_REGNUM], 4));
}
write_register (FP_REGNUM, read_memory_integer (fp, 4));
write_register (PC_REGNUM, read_memory_integer (fp + 4, 4));
write_register (SP_REGNUM, fp + 8);
flush_cached_frames ();
}
CORE_ADDR
m68k_skip_prologue (CORE_ADDR ip)
{
register CORE_ADDR limit;
struct symtab_and_line sal;
register int op;
sal = find_pc_line (ip, 0);
limit = (sal.end) ? sal.end : (CORE_ADDR) ~ 0;
while (ip < limit)
{
op = read_memory_integer (ip, 2);
op &= 0xFFFF;
if (op == P_LINKW_FP)
ip += 4;
else if (op == P_PEA_FP)
ip += 2;
else if (op == P_MOVL_SP_FP)
ip += 2;
else if (op == P_LINKL_FP)
ip += 6;
else if (op == P_MOVML)
ip += 6;
else if (op == P_FMOVM)
ip += 10;
else
break;
}
return (ip);
}
void
m68k_find_saved_regs (struct frame_info *frame_info,
struct frame_saved_regs *saved_regs)
{
register int regnum;
register int regmask;
register CORE_ADDR next_addr;
register CORE_ADDR pc;
CORE_ADDR possible_call_dummy_start =
(frame_info)->frame - CALL_DUMMY_LENGTH - FP_REGNUM * 4 - 4 - 8 * 12;
int nextinsn;
memset (saved_regs, 0, sizeof (*saved_regs));
if ((frame_info)->pc >= possible_call_dummy_start
&& (frame_info)->pc <= (frame_info)->frame)
{
next_addr = (frame_info)->frame;
pc = possible_call_dummy_start;
}
else
{
pc = get_pc_function_start ((frame_info)->pc);
nextinsn = read_memory_integer (pc, 2);
if (P_PEA_FP == nextinsn
&& P_MOVL_SP_FP == read_memory_integer (pc + 2, 2))
{
next_addr = frame_info->frame;
pc += 4;
}
else if (P_LINKL_FP == nextinsn)
{
next_addr = (frame_info)->frame + read_memory_integer (pc + 2, 4);
pc += 6;
}
else if (P_LINKW_FP == nextinsn)
{
next_addr = (frame_info)->frame + read_memory_integer (pc + 2, 2);
pc += 4;
}
else
goto lose;
if ((0177777 & read_memory_integer (pc, 2)) == 0157774)
next_addr += read_memory_integer (pc += 2, 4), pc += 4;
}
for ( ; ; )
{
nextinsn = 0xffff & read_memory_integer (pc, 2);
regmask = read_memory_integer (pc + 2, 2);
if (0xf227 == nextinsn && (regmask & 0xff00) == 0xe000)
{
for (regnum = FP0_REGNUM + 8; --regnum >= FP0_REGNUM; regmask >>= 1)
if (regmask & 1)
saved_regs->regs[regnum] = (next_addr -= 12);
pc += 4;
}
else if (0171056 == nextinsn && (regmask & 0xff00) == 0xf000)
{
register CORE_ADDR addr;
addr = (frame_info)->frame + read_memory_integer (pc + 4, 2);
for (regnum = FP0_REGNUM + 8; --regnum >= FP0_REGNUM; regmask >>= 1)
if (regmask & 1)
{
saved_regs->regs[regnum] = addr;
addr += 12;
}
pc += 6;
}
else if (0044327 == nextinsn)
{
for (regnum = 0; regnum < 16; regnum++, regmask >>= 1)
if (regmask & 1)
{
saved_regs->regs[regnum] = next_addr;
next_addr += 4;
}
pc += 4;
}
else if (0044356 == nextinsn)
{
register CORE_ADDR addr;
addr = (frame_info)->frame + read_memory_integer (pc + 4, 2);
for (regnum = 0; regnum < 16; regnum++, regmask >>= 1)
if (regmask & 1)
{
saved_regs->regs[regnum] = addr;
addr += 4;
}
pc += 6;
}
else if (0044347 == nextinsn)
{
for (regnum = 16; --regnum >= 0; regmask >>= 1)
if (regmask & 1)
saved_regs->regs[regnum] = (next_addr -= 4);
pc += 4;
}
else if (0x2f00 == (0xfff0 & nextinsn))
{
regnum = 0xf & nextinsn;
saved_regs->regs[regnum] = (next_addr -= 4);
pc += 2;
}
else if (0xf236 == nextinsn && (regmask & 0xff00) == 0xf000)
{
for (regnum = FP0_REGNUM + 8; --regnum >= FP0_REGNUM; regmask >>= 1)
if (regmask & 1)
{
saved_regs->regs[regnum] = next_addr;
next_addr += 12;
}
pc += 10;
}
else if (0x4267 == nextinsn && 0x42e7 == regmask)
{
saved_regs->regs[PS_REGNUM] = (next_addr -= 4);
pc += 4;
}
else
break;
}
lose:;
saved_regs->regs[SP_REGNUM] = (frame_info)->frame + 8;
saved_regs->regs[FP_REGNUM] = (frame_info)->frame;
saved_regs->regs[PC_REGNUM] = (frame_info)->frame + 4;
#ifdef SIG_SP_FP_OFFSET
if (frame_info->signal_handler_caller && frame_info->next)
saved_regs->regs[SP_REGNUM] = frame_info->next->frame + SIG_SP_FP_OFFSET;
#endif
}
#ifdef USE_PROC_FS
#include <sys/procfs.h>
#include "gregset.h"
#if !defined (R_PS) && defined (R_SR)
#define R_PS R_SR
#endif
void
supply_gregset (gregset_t *gregsetp)
{
register int regi;
register greg_t *regp = (greg_t *) gregsetp;
for (regi = 0; regi < R_PC; regi++)
{
supply_register (regi, (char *) (regp + regi));
}
supply_register (PS_REGNUM, (char *) (regp + R_PS));
supply_register (PC_REGNUM, (char *) (regp + R_PC));
}
void
fill_gregset (gregset_t *gregsetp, int regno)
{
register int regi;
register greg_t *regp = (greg_t *) gregsetp;
for (regi = 0; regi < R_PC; regi++)
{
if ((regno == -1) || (regno == regi))
{
*(regp + regi) = *(int *) ®isters[REGISTER_BYTE (regi)];
}
}
if ((regno == -1) || (regno == PS_REGNUM))
{
*(regp + R_PS) = *(int *) ®isters[REGISTER_BYTE (PS_REGNUM)];
}
if ((regno == -1) || (regno == PC_REGNUM))
{
*(regp + R_PC) = *(int *) ®isters[REGISTER_BYTE (PC_REGNUM)];
}
}
#if defined (FP0_REGNUM)
void
supply_fpregset (fpregset_t *fpregsetp)
{
register int regi;
char *from;
for (regi = FP0_REGNUM; regi < FPC_REGNUM; regi++)
{
from = (char *) &(fpregsetp->f_fpregs[regi - FP0_REGNUM][0]);
supply_register (regi, from);
}
supply_register (FPC_REGNUM, (char *) &(fpregsetp->f_pcr));
supply_register (FPS_REGNUM, (char *) &(fpregsetp->f_psr));
supply_register (FPI_REGNUM, (char *) &(fpregsetp->f_fpiaddr));
}
void
fill_fpregset (fpregset_t *fpregsetp, int regno)
{
int regi;
char *to;
char *from;
for (regi = FP0_REGNUM; regi < FPC_REGNUM; regi++)
{
if ((regno == -1) || (regno == regi))
{
from = (char *) ®isters[REGISTER_BYTE (regi)];
to = (char *) &(fpregsetp->f_fpregs[regi - FP0_REGNUM][0]);
memcpy (to, from, REGISTER_RAW_SIZE (regi));
}
}
if ((regno == -1) || (regno == FPC_REGNUM))
{
fpregsetp->f_pcr = *(int *) ®isters[REGISTER_BYTE (FPC_REGNUM)];
}
if ((regno == -1) || (regno == FPS_REGNUM))
{
fpregsetp->f_psr = *(int *) ®isters[REGISTER_BYTE (FPS_REGNUM)];
}
if ((regno == -1) || (regno == FPI_REGNUM))
{
fpregsetp->f_fpiaddr = *(int *) ®isters[REGISTER_BYTE (FPI_REGNUM)];
}
}
#endif
#endif
int
m68k_get_longjmp_target (CORE_ADDR *pc)
{
#if defined (JB_PC) && defined (JB_ELEMENT_SIZE)
char *buf;
CORE_ADDR sp, jb_addr;
buf = alloca (TARGET_PTR_BIT / TARGET_CHAR_BIT);
sp = read_register (SP_REGNUM);
if (target_read_memory (sp + SP_ARG0,
buf,
TARGET_PTR_BIT / TARGET_CHAR_BIT))
return 0;
jb_addr = extract_address (buf, TARGET_PTR_BIT / TARGET_CHAR_BIT);
if (target_read_memory (jb_addr + JB_PC * JB_ELEMENT_SIZE, buf,
TARGET_PTR_BIT / TARGET_CHAR_BIT))
return 0;
*pc = extract_address (buf, TARGET_PTR_BIT / TARGET_CHAR_BIT);
return 1;
#else
internal_error (__FILE__, __LINE__,
"m68k_get_longjmp_target: not implemented");
return 0;
#endif
}
CORE_ADDR
m68k_saved_pc_after_call (struct frame_info *frame)
{
#ifdef SYSCALL_TRAP
int op;
op = read_memory_integer (frame->pc - SYSCALL_TRAP_OFFSET, 2);
if (op == SYSCALL_TRAP)
return read_memory_integer (read_register (SP_REGNUM) + 4, 4);
else
#endif
return read_memory_integer (read_register (SP_REGNUM), 4);
}
void
_initialize_m68k_tdep (void)
{
tm_print_insn = print_insn_m68k;
}