rdbg_f.c

RTEMS (Real-Time Executive for Multiprocessor Systems) is a free open source real-time operating sys

/*
 **************************************************************************
 *
 * Component =   
 * 
 * Synopsis  =   rdbg/powerpc/rdbg_f.c
 *
 * $Id: rdbg_f.c,v 1.4 2002/04/19 16:17:25 joel Exp $
 *
 **************************************************************************
 */

#include <rtems.h>
#include <assert.h>
#include <errno.h>
#include <rdbg/reg.h>
#include <rdbg/remdeb.h>
#include <rdbg/rdbg.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--;
}

static cpuExcHandlerType oldExcHandler;

  void
connect_rdbg_exception ()
{
  /*
   * test if rdbg already connected its exception handler
   */
  if (globalExceptHdl != BreakPointExcHdl) {
    oldExcHandler = globalExceptHdl;
    globalExceptHdl = BreakPointExcHdl;
  }
}

  void
disconnect_rdbg_exception ()
{
  /*
   * test if current execption handler is rdbg's one
   * and restore the original one in this case.
   */
  if (globalExceptHdl == BreakPointExcHdl) {
    globalExceptHdl = oldExcHandler;
  }
}