#include <sys/types.h>
#include <stand.h>
#include <next68k/next68k/nextrom.h>
#include "samachdep.h"
char *mg;
#define MON(type, off) (*(type *)((u_int) (mg) + off))
#ifdef DEBUG
int debug = 1;
#else
int debug = 0;
#endif
#ifdef DEBUG
#define DPRINTF(x) printf x
#else
#define DPRINTF(x)
#endif
void
machdep_start(char *entry, int howto, char *loadaddr, char *ssym, char *esym)
{
DPRINTF(("machdep_start(entry=%p,howto=0x%x,loadaddr=%p,ssym=%p,esym=%p\n",
entry, howto, loadaddr, ssym, esym));
MON(int,MG_boot_how) = howto;
entry_point = (int)entry + (int)loadaddr;
DPRINTF(("start=0x%lx\n", (u_long)entry_point));
*((u_int *)loadaddr) = (u_int)esym;
}
typedef int (*getcptr)(void);
typedef int (*putcptr)(int);
int
getchar(void)
{
return(MON(getcptr,MG_getc)());
}
void
putchar(int c)
{
MON(putcptr,MG_putc)(c);
}
__dead void
_rtt(void)
{
printf("Press any key to halt.\n");
getchar();
_halt();
}
struct trapframe {
int dregs[8];
int aregs[8];
short sr;
int pc;
u_short fmt:4,
vec:12;
char info[0];
} __attribute__ ((packed));
int trap(struct trapframe *);
int
trap(struct trapframe *fp)
{
static int intrap = 0;
if (intrap)
return 0;
intrap = 1;
printf("Got unexpected trap: format=%x vector=%x sr=%x pc=%x\n",
fp->fmt, fp->vec, fp->sr, fp->pc);
printf("dregs: %x %x %x %x %x %x %x %x\n",
fp->dregs[0], fp->dregs[1], fp->dregs[2], fp->dregs[3],
fp->dregs[4], fp->dregs[5], fp->dregs[6], fp->dregs[7]);
printf("aregs: %x %x %x %x %x %x %x %x\n",
fp->aregs[0], fp->aregs[1], fp->aregs[2], fp->aregs[3],
fp->aregs[4], fp->aregs[5], fp->aregs[6], fp->aregs[7]);
intrap = 0;
#ifdef DEBUG
if (debug)
{
int i;
int *p;
p = (int *)(fp->pc);
for (i = 0; i < 64; i++) {
if ((i % 8) == 0)
printf ("\npc %x: ", (int)&p[i-16]);
printf ("%x ", p[i]);
}
p = (int *)(fp->info);
for (i = 0; i < 64; i++) {
if ((i % 8) == 0)
printf ("\nstk %x: ", (int)&p[i-16]);
printf ("%x ", p[i]);
}
printf ("\n");
}
#endif
printf("Halting.\n");
return 0;
}