diff options
Diffstat (limited to 'c/src/lib/librdbg/powerpc/rdbg_f.c')
-rw-r--r-- | c/src/lib/librdbg/powerpc/rdbg_f.c | 156 |
1 files changed, 156 insertions, 0 deletions
diff --git a/c/src/lib/librdbg/powerpc/rdbg_f.c b/c/src/lib/librdbg/powerpc/rdbg_f.c new file mode 100644 index 0000000000..6149b5d426 --- /dev/null +++ b/c/src/lib/librdbg/powerpc/rdbg_f.c @@ -0,0 +1,156 @@ +/* + ************************************************************************** + * + * Component = + * + * Synopsis = rdbg/powerpc/rdbg_f.c + * + * $Id$ + * + ************************************************************************** + */ + +#include <assert.h> +#include <errno.h> +#include <rdbg/reg.h> +#include <rdbg/remdeb.h> +#include <rdbg/rdbg.h> +#include <rtems/score/cpu.h> +#include <rtems/score/thread.h> +#include <libcpu/cpu.h> + +void +CtxToRegs (const CPU_Exception_frame* ctx, xdr_regs* regs) +{ + * ((CPU_Exception_frame*) regs) = *ctx; +} + + + void +RegsToCtx (const xdr_regs* regs, CPU_Exception_frame* ctx) +{ + *ctx = * ((CPU_Exception_frame*) regs); +} + +void +get_ctx_thread( Thread_Control *thread, CPU_Exception_frame* ctx) +{ + unsigned int *ptr; + unsigned int i; + + ctx->EXC_SRR0 = thread->Registers.pc; + ctx->EXC_SRR1 = thread->Registers.msr; + ctx->_EXC_number = 0xdeadbeef; + + ctx->GPR1 = thread->Registers.gpr1; + ctx->GPR2 = thread->Registers.gpr2; + /* + * Fill with dummy values... + */ + ptr = &ctx->GPR3; + for (i = 0; i < 10; i++) + ptr [i] = 0xdeadbeef; + + ctx->GPR13 = thread->Registers.gpr13; + ctx->GPR14 = thread->Registers.gpr14; + ctx->GPR15 = thread->Registers.gpr15; + ctx->GPR16 = thread->Registers.gpr16; + ctx->GPR17 = thread->Registers.gpr17; + ctx->GPR18 = thread->Registers.gpr18; + ctx->GPR19 = thread->Registers.gpr19; + ctx->GPR20 = thread->Registers.gpr20; + ctx->GPR21 = thread->Registers.gpr21; + ctx->GPR22 = thread->Registers.gpr22; + ctx->GPR23 = thread->Registers.gpr23; + ctx->GPR24 = thread->Registers.gpr24; + ctx->GPR25 = thread->Registers.gpr25; + ctx->GPR26 = thread->Registers.gpr26; + ctx->GPR27 = thread->Registers.gpr27; + ctx->GPR28 = thread->Registers.gpr28; + ctx->GPR29 = thread->Registers.gpr29; + ctx->GPR30 = thread->Registers.gpr30; + ctx->GPR31 = thread->Registers.gpr31; + ctx->EXC_CR = thread->Registers.cr; + ctx->EXC_CTR = 0xdeadbeef; + ctx->EXC_XER = 0xdeadbeef; + ctx->EXC_LR = 0xdeadbeef; + ctx->EXC_MSR = 0xdeadbeef; + ctx->EXC_DAR = 0xdeadbeef; +} + +void +set_ctx_thread( Thread_Control *thread, CPU_Exception_frame* ctx) +{ + thread->Registers.gpr1 = ctx->GPR1; + thread->Registers.gpr2 = ctx->GPR2; + + thread->Registers.gpr13 = ctx->GPR13; + thread->Registers.gpr14 = ctx->GPR14; + thread->Registers.gpr15 = ctx->GPR15; + thread->Registers.gpr16 = ctx->GPR16; + thread->Registers.gpr17 = ctx->GPR17; + thread->Registers.gpr18 = ctx->GPR18; + thread->Registers.gpr19 = ctx->GPR19; + thread->Registers.gpr20 = ctx->GPR20; + thread->Registers.gpr21 = ctx->GPR21; + thread->Registers.gpr22 = ctx->GPR22; + thread->Registers.gpr23 = ctx->GPR23; + thread->Registers.gpr24 = ctx->GPR24; + thread->Registers.gpr25 = ctx->GPR25; + thread->Registers.gpr26 = ctx->GPR26; + thread->Registers.gpr27 = ctx->GPR27; + thread->Registers.gpr28 = ctx->GPR28; + thread->Registers.gpr29 = ctx->GPR29; + thread->Registers.gpr30 = ctx->GPR30; + thread->Registers.gpr31 = ctx->GPR31; + thread->Registers.cr = ctx->EXC_CR; + thread->Registers.pc = ctx->EXC_SRR0; + thread->Registers.msr = ctx->EXC_SRR1; +} + + + +int +Single_Step(CPU_Exception_frame* ctx) +{ + if ((ctx->EXC_SRR1 & MSR_SE) != 0 || ExitForSingleStep != 0) { + /* Check coherency */ + assert ((ctx->EXC_SRR1 & MSR_SE) != 0); + assert (ExitForSingleStep != 0); + return 0; + } + ctx->EXC_SRR1 |= MSR_SE; + ++ExitForSingleStep; + return 0; +} + + int +CheckForSingleStep (CPU_Exception_frame* ctx) +{ + if (ExitForSingleStep) { + /* + * This functions can be called both from + * INT1 and INT3 handlers. In case it is + * called from INT3, need to clear TF. + */ + ctx->EXC_SRR1 &= ~MSR_SE; + ExitForSingleStep = 0; + return 1; + } + return 0; +} + +void +CancelSingleStep (CPU_Exception_frame* ctx) +{ + /* Cancel scheduled SS */ + ctx->EXC_SRR1 &= ~MSR_SE; + ExitForSingleStep-- ; +} +cpuExcHandlerType oldExcHandler; + +void connect_rdbg_exception() +{ + oldExcHandler = globalExceptHdl; + globalExceptHdl = BreakPointExcHdl ; +} |