#include <mach/mach_types.h>
#include <mach/exception_types.h>
#include <ppc/exception.h>
#include <ppc/proc_reg.h>
#include <kdp/kdp_internal.h>
#include <ppc/savearea.h>
#include <kern/debug.h>
#define KDP_TEST_HARNESS 0
#if KDP_TEST_HARNESS
#define dprintf(x) kprintf x
#else
#define dprintf(x)
#endif
void print_saved_state(void *);
void kdp_call(void);
void kdp_trap( unsigned int, struct savearea *saved_state);
int kdp_getc(void);
boolean_t kdp_call_kdb(void);
void
kdp_exception(
unsigned char *pkt,
int *len,
unsigned short *remote_port,
unsigned int exception,
unsigned int code,
unsigned int subcode
)
{
struct {
kdp_exception_t pkt;
kdp_exc_info_t exc;
} aligned_pkt;
kdp_exception_t *rq = (kdp_exception_t *)&aligned_pkt;
bcopy((char *)pkt, (char *)rq, sizeof(*rq));
rq->hdr.request = KDP_EXCEPTION;
rq->hdr.is_reply = 0;
rq->hdr.seq = kdp.exception_seq;
rq->hdr.key = 0;
rq->hdr.len = sizeof (*rq) + sizeof(kdp_exc_info_t);
rq->n_exc_info = 1;
rq->exc_info[0].cpu = 0;
rq->exc_info[0].exception = exception;
rq->exc_info[0].code = code;
rq->exc_info[0].subcode = subcode;
rq->hdr.len += rq->n_exc_info * sizeof (kdp_exc_info_t);
bcopy((char *)rq, (char *)pkt, rq->hdr.len);
kdp.exception_ack_needed = TRUE;
*remote_port = kdp.exception_port;
*len = rq->hdr.len;
}
boolean_t
kdp_exception_ack(
unsigned char *pkt,
int len
)
{
kdp_exception_ack_t aligned_pkt;
kdp_exception_ack_t *rq = (kdp_exception_ack_t *)&aligned_pkt;
if (len < sizeof (*rq))
return(FALSE);
bcopy((char *)pkt, (char *)rq, sizeof(*rq));
if (!rq->hdr.is_reply || rq->hdr.request != KDP_EXCEPTION)
return(FALSE);
dprintf(("kdp_exception_ack seq %x %x\n", rq->hdr.seq, kdp.exception_seq));
if (rq->hdr.seq == kdp.exception_seq) {
kdp.exception_ack_needed = FALSE;
kdp.exception_seq++;
}
return(TRUE);
}
static void
kdp_getintegerstate(
struct ppc_thread_state *state
)
{
struct savearea *saved_state;
saved_state = kdp.saved_state;
bzero((char *)state,sizeof (struct ppc_thread_state)) ;
state->srr0 = saved_state->save_srr0;
state->srr1 = saved_state->save_srr1;
state->r0 = saved_state->save_r0;
state->r1 = saved_state->save_r1;
state->r2 = saved_state->save_r2;
state->r3 = saved_state->save_r3;
state->r4 = saved_state->save_r4;
state->r5 = saved_state->save_r5;
state->r6 = saved_state->save_r6;
state->r7 = saved_state->save_r7;
state->r8 = saved_state->save_r8;
state->r9 = saved_state->save_r9;
state->r10 = saved_state->save_r10;
state->r11 = saved_state->save_r11;
state->r12 = saved_state->save_r12;
state->r13 = saved_state->save_r13;
state->r14 = saved_state->save_r14;
state->r15 = saved_state->save_r15;
state->r16 = saved_state->save_r16;
state->r17 = saved_state->save_r17;
state->r18 = saved_state->save_r18;
state->r19 = saved_state->save_r19;
state->r20 = saved_state->save_r20;
state->r21 = saved_state->save_r21;
state->r22 = saved_state->save_r22;
state->r23 = saved_state->save_r23;
state->r24 = saved_state->save_r24;
state->r25 = saved_state->save_r25;
state->r26 = saved_state->save_r26;
state->r27 = saved_state->save_r27;
state->r28 = saved_state->save_r28;
state->r29 = saved_state->save_r29;
state->r30 = saved_state->save_r30;
state->r31 = saved_state->save_r31;
state->cr = saved_state->save_cr;
state->xer = saved_state->save_xer;
state->lr = saved_state->save_lr;
state->ctr = saved_state->save_ctr;
}
kdp_error_t
kdp_machine_read_regs(
unsigned int cpu,
unsigned int flavor,
char *data,
int *size
)
{
switch (flavor) {
case PPC_THREAD_STATE:
dprintf(("kdp_readregs THREAD_STATE\n"));
kdp_getintegerstate((struct ppc_thread_state *)data);
*size = PPC_THREAD_STATE_COUNT * sizeof(int);
return KDPERR_NO_ERROR;
case PPC_FLOAT_STATE:
dprintf(("kdp_readregs THREAD_FPSTATE\n"));
bzero((char *)data ,sizeof(struct ppc_float_state));
*size = PPC_FLOAT_STATE_COUNT * sizeof(int);
return KDPERR_NO_ERROR;
default:
dprintf(("kdp_readregs bad flavor %d\n"));
return KDPERR_BADFLAVOR;
}
}
static void
kdp_setintegerstate(
struct ppc_thread_state *state
)
{
struct savearea *saved_state;
saved_state = kdp.saved_state;
saved_state->save_srr0 = state->srr0;
saved_state->save_srr1 = state->srr1;
saved_state->save_r0 = state->r0;
saved_state->save_r1 = state->r1;
saved_state->save_r2 = state->r2;
saved_state->save_r3 = state->r3;
saved_state->save_r4 = state->r4;
saved_state->save_r5 = state->r5;
saved_state->save_r6 = state->r6;
saved_state->save_r7 = state->r7;
saved_state->save_r8 = state->r8;
saved_state->save_r9 = state->r9;
saved_state->save_r10 = state->r10;
saved_state->save_r11 = state->r11;
saved_state->save_r12 = state->r12;
saved_state->save_r13 = state->r13;
saved_state->save_r14 = state->r14;
saved_state->save_r15 = state->r15;
saved_state->save_r16 = state->r16;
saved_state->save_r17 = state->r17;
saved_state->save_r18 = state->r18;
saved_state->save_r19 = state->r19;
saved_state->save_r20 = state->r20;
saved_state->save_r21 = state->r21;
saved_state->save_r22 = state->r22;
saved_state->save_r23 = state->r23;
saved_state->save_r24 = state->r24;
saved_state->save_r25 = state->r25;
saved_state->save_r26 = state->r26;
saved_state->save_r27 = state->r27;
saved_state->save_r28 = state->r28;
saved_state->save_r29 = state->r29;
saved_state->save_r30 = state->r30;
saved_state->save_r31 = state->r31;
saved_state->save_cr = state->cr;
saved_state->save_xer = state->xer;
saved_state->save_lr = state->lr;
saved_state->save_ctr = state->ctr;
}
kdp_error_t
kdp_machine_write_regs(
unsigned int cpu,
unsigned int flavor,
char *data,
int *size
)
{
switch (flavor) {
case PPC_THREAD_STATE:
dprintf(("kdp_writeregs THREAD_STATE\n"));
kdp_setintegerstate((struct ppc_thread_state *)data);
#if KDP_TEST_HARNESS
DumpTheSave((struct savearea *)data);
#endif
return KDPERR_NO_ERROR;
case PPC_FLOAT_STATE:
dprintf(("kdp_writeregs THREAD_FPSTATE\n"));
return KDPERR_NO_ERROR;
default:
dprintf(("kdp_writeregs bad flavor %d\n"));
return KDPERR_BADFLAVOR;
}
}
void
kdp_machine_hostinfo(
kdp_hostinfo_t *hostinfo
)
{
machine_slot_t m;
int i;
hostinfo->cpus_mask = 0;
hostinfo->cpu_type = 0;
for (i = 0; i < machine_info.max_cpus; i++) {
m = &machine_slot[i];
if (!m->is_cpu)
continue;
hostinfo->cpus_mask |= (1 << i);
if (hostinfo->cpu_type == 0) {
hostinfo->cpu_type = m->cpu_type;
hostinfo->cpu_subtype = m->cpu_subtype;
}
}
}
void
kdp_panic(
const char *msg
)
{
printf("kdp panic: %s\n", msg);
while(1) {}
}
void
kdp_reboot(void)
{
halt_all_cpus(TRUE);;
}
int
kdp_intr_disbl(void)
{
return (splhigh());
}
void
kdp_intr_enbl(int s)
{
splx(s);
}
void
kdp_us_spin(int usec)
{
extern void delay(int);
delay(usec/100);
}
void print_saved_state(void *state)
{
struct ppc_thread_state *saved_state;
saved_state = state;
printf("pc = 0x%x\n", saved_state->srr0);
printf("msr = 0x%x\n", saved_state->srr1);
printf("rp = 0x%x\n", saved_state->lr);
printf("sp = 0x%x\n", saved_state->r1);
}
void
kdp_call()
{
Debugger("inline call to debugger(machine_startup)");
}
int kdp_trap_codes[] = {
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BREAKPOINT,
EXC_ARITHMETIC,
EXC_SOFTWARE,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_SOFTWARE,
EXC_BREAKPOINT,
EXC_SOFTWARE,
EXC_SOFTWARE,
EXC_ARITHMETIC,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BREAKPOINT,
EXC_SOFTWARE,
EXC_BAD_ACCESS,
EXC_ARITHMETIC,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BREAKPOINT,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_BAD_ACCESS,
EXC_SOFTWARE
};
int
kdp_getc()
{
return(cnmaygetc());
}
int kdp_backtrace;
int kdp_sr_dump;
int kdp_dabr;
int kdp_noisy;
#define kdp_code(x) kdp_trap_codes[((x)==T_AST?0x31:(x)/T_VECTOR_SIZE)]
void
kdp_trap(
unsigned int exception,
struct savearea *saved_state
)
{
unsigned int *fp;
unsigned int register sp;
struct savearea *state;
if (kdp_noisy) {
if (kdp_backtrace) {
printf("\nvector=%x, \n", exception/4);
sp = saved_state->save_r1;
printf("stack backtrace - sp(%x) ", sp);
fp = (unsigned int *) *((unsigned int *)sp);
while (fp) {
printf("0x%08x ", fp[2]);
fp = (unsigned int *)*fp;
}
printf("\n");
}
#ifdef XXX
if (kdp_sr_dump) {
dump_segment_registers();
}
#endif
printf("vector=%d ", exception/4);
}
kdp_raise_exception(kdp_code(exception), 0, 0, saved_state);
if (kdp_noisy)
printf("kdp_trap: kdp_raise_exception() ret\n");
if (*((int *)saved_state->save_srr0) == 0x7c800008)
saved_state->save_srr0 += 4;
if(saved_state->save_srr1 & (MASK(MSR_SE) | MASK(MSR_BE))) {
db_run_mode = STEP_ONCE;
}
else db_run_mode = STEP_CONTINUE;
#ifdef XXX
mtspr(dabr, kdp_dabr);
#endif
}
boolean_t
kdp_call_kdb(
void)
{
switch_debugger=1;
return(TRUE);
}
void kdp_print_registers(struct savearea *state)
{
int i;
for (i=0; i<32; i++) {
if ((i % 8) == 0)
printf("\n%4d :",i);
printf(" %08x",*(&state->save_r0+i));
}
printf("\n");
printf("cr = 0x%08x\t\t",state->save_cr);
printf("xer = 0x%08x\n",state->save_xer);
printf("lr = 0x%08x\t\t",state->save_lr);
printf("ctr = 0x%08x\n",state->save_ctr);
printf("srr0(iar) = 0x%08x\t\t",state->save_srr0);
printf("srr1(msr) = 0x%08B\n",state->save_srr1,
"\x10\x11""EE\x12PR\x13""FP\x14ME\x15""FE0\x16SE\x18"
"FE1\x19""AL\x1a""EP\x1bIT\x1c""DT");
printf("\n");
}
void
kdp_print_backtrace(
unsigned int exception,
struct savearea *saved_state)
{
extern void kdp_print_registers(struct savearea *);
extern void print_backtrace(struct savearea *);
extern unsigned int debug_mode, disableDebugOuput;
disableDebugOuput = FALSE;
debug_mode = TRUE;
printf("re-entering kdp:\n");
printf("vector=%x, \n", exception/4);
kdp_print_registers(saved_state);
print_backtrace(saved_state);
printf("panic: We are hanging here...\n");
while(1);
}
unsigned int kdp_ml_get_breakinsn()
{
return 0x7fe00008;
}