static void handler_system_manager(void) { static uint32_t offset = 0; /* We don't have much time in the critical section. Just * buffer the registers */ uint32_t oreg; for (oreg = 0; oreg < SMPC_OREGS; oreg++, offset++) { OREG_SET(offset, MEMORY_READ(8, OREG(oreg))); } uint8_t sr; sr = MEMORY_READ(8, SMPC(SR)); if ((sr & 0x80) == 0x80) { if ((sr & NPE) == 0x00) { /* Mark that SMPC status and peripheral data * collection is complete */ _collection_complete = true; offset = 0; /* Issue a "BREAK" for the "INTBACK" command */ MEMORY_WRITE(8, IREG(0), BR); return; } } /* Issue a "CONTINUE" for the "INTBACK" command */ MEMORY_WRITE(8, IREG(0), CONT); }
/* copy a context structure according to the flags */ void copy_context( CONTEXT *to, const CONTEXT *from, unsigned int flags ) { if (flags & CONTEXT_CONTROL) { CREG(Msr); CREG(Ctr); CREG(Iar); to->ContextFlags |= CONTEXT_CONTROL; } if (flags & CONTEXT_INTEGER) { IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6); IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13); IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19); IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25); IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31); CREG(Xer); CREG(Cr); to->ContextFlags |= CONTEXT_INTEGER; } if (flags & CONTEXT_FLOATING_POINT) { FREG(0); FREG(1); FREG(2); FREG(3); FREG(4); FREG(5); FREG(6); FREG(7); FREG(8); FREG(9); FREG(10); FREG(11); FREG(12); FREG(13); FREG(14); FREG(15); FREG(16); FREG(17); FREG(18); FREG(19); FREG(20); FREG(21); FREG(22); FREG(23); FREG(24); FREG(25); FREG(26); FREG(27); FREG(28); FREG(29); FREG(30); FREG(31); CREG(Fpscr); to->ContextFlags |= CONTEXT_FLOATING_POINT; } }
/* retrieve a thread context */ static void get_thread_context_ptrace( struct thread *thread, unsigned int flags, CONTEXT *context ) { int pid = get_ptrace_pid(thread); if (flags & CONTEXT_INTEGER) { #define XREG(x,y) if (ptrace( PTRACE_PEEKUSER, pid, (void*)(x<<2), &context->y) == -1) goto error; #define IREG(x) if (ptrace( PTRACE_PEEKUSER, pid, (void*)(x<<2), &context->Gpr##x) == -1) goto error; IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6); IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13); IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19); IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25); IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31); #undef IREG XREG(37,Xer); XREG(38,Cr); context->ContextFlags |= CONTEXT_INTEGER; } if (flags & CONTEXT_CONTROL) { XREG(32,Iar); XREG(33,Msr); XREG(35,Ctr); XREG(36,Lr); /* 36 is LNK ... probably Lr ? */ context->ContextFlags |= CONTEXT_CONTROL; } if (flags & CONTEXT_FLOATING_POINT) { #define FREG(x) if (ptrace( PTRACE_PEEKUSER, pid, (void*)((48+x*2)<<2), &context->Fpr##x) == -1) goto error; FREG(0); FREG(1); FREG(2); FREG(3); FREG(4); FREG(5); FREG(6); FREG(7); FREG(8); FREG(9); FREG(10); FREG(11); FREG(12); FREG(13); FREG(14); FREG(15); FREG(16); FREG(17); FREG(18); FREG(19); FREG(20); FREG(21); FREG(22); FREG(23); FREG(24); FREG(25); FREG(26); FREG(27); FREG(28); FREG(29); FREG(30); FREG(31); XREG((48+32*2),Fpscr); context->ContextFlags |= CONTEXT_FLOATING_POINT; } return; error: file_set_error(); }
/* set a thread context */ static void set_thread_context_ptrace( struct thread *thread, unsigned int flags, const CONTEXT *context ) { int pid = get_ptrace_pid(thread); if (flags & CONTEXT_FULL) { if (flags & CONTEXT_INTEGER) { IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6); IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13); IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19); IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25); IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31); XREG(37,Xer); XREG(38,Cr); } if (flags & CONTEXT_CONTROL) { XREG(32,Iar); XREG(33,Msr); XREG(35,Ctr); XREG(36,Lr); } } if (flags & CONTEXT_FLOATING_POINT) { FREG(0); FREG(1); FREG(2); FREG(3); FREG(4); FREG(5); FREG(6); FREG(7); FREG(8); FREG(9); FREG(10); FREG(11); FREG(12); FREG(13); FREG(14); FREG(15); FREG(16); FREG(17); FREG(18); FREG(19); FREG(20); FREG(21); FREG(22); FREG(23); FREG(24); FREG(25); FREG(26); FREG(27); FREG(28); FREG(29); FREG(30); FREG(31); #undef FREG XREG((48+32*2),Fpscr); } return; error: file_set_error(); }