source: rtems/c/src/lib/librdbg/powerpc/rdbg_f.c @ 981b99f

/*
 **************************************************************************
 *
 * 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 ;
}