Subversion Repositories openrisc_me

/*
 **************************************************************************
 *
 * Component =   
 * 
 * Synopsis  =   rdbgexcep.c
 *
 * $Id: excep.c,v 1.2 2001-09-27 12:02:01 chris Exp $
 *
 **************************************************************************
 */
 
#include <rtems.h>
#include <rtems/error.h>
#include <assert.h>
#include <errno.h>
#include <rdbg/rdbg.h>
#include <rdbg/servrpc.h>
 
unsigned int NbExceptCtx;
volatile unsigned int NbSerializedCtx;
Exception_context *FirstCtx = NULL;
Exception_context *LastCtx = NULL;
 
CPU_Exception_frame SavedContext;
 
 
/********* Save an exception context at the end of a list *****/
 
int PushExceptCtx ( Objects_Id Id, Objects_Id semId, CPU_Exception_frame *ctx ) {
 
  Exception_context *SaveCtx;
 
  SaveCtx = (Exception_context *)malloc(sizeof(Exception_context));
  if (SaveCtx == NULL)
    rtems_panic("Can't allocate memory to save Exception context");
 
  SaveCtx->id = Id;
  SaveCtx->ctx = ctx;
  SaveCtx->semaphoreId = semId;
  SaveCtx->previous = NULL;
  SaveCtx->next = NULL;
 
  if (FirstCtx == NULL){  /* initialization */
    FirstCtx = SaveCtx;
    LastCtx  = SaveCtx;
    NbExceptCtx = 1;
  }
  else {
    NbExceptCtx ++;
    LastCtx->next = SaveCtx;
    SaveCtx->previous = LastCtx;
    LastCtx = SaveCtx;
  }
  return 0;
}
 
/********* Save an temporary exception context in a ******/
/********* global variable                          ******/
 
int PushSavedExceptCtx ( Objects_Id Id, CPU_Exception_frame *ctx ) {
 
  memcpy (&(SavedContext), ctx, sizeof(CPU_Exception_frame));
  return 0;
}
 
 
/****** Remove the context of the specified Id thread *********/
/****** If Id = -1, then return the first context     *********/
 
 
int PopExceptCtx ( Objects_Id Id ) {
 
  Exception_context *ExtractCtx;
 
  if (FirstCtx == NULL) return -1;
 
  if  (Id == -1) {
    ExtractCtx = LastCtx;
    LastCtx = LastCtx->previous;
    free(ExtractCtx);
    NbExceptCtx --;
    return 0;
  }
 
  ExtractCtx = LastCtx;
 
  while (ExtractCtx->id != Id && ExtractCtx != NULL) {
    ExtractCtx = ExtractCtx->previous;
  }
 
  if (ExtractCtx == NULL)
    return -1;
 
  if ( ExtractCtx->previous != NULL)
    (ExtractCtx->previous)->next = ExtractCtx->next;
 
  if ( ExtractCtx->next != NULL)
    (ExtractCtx->next)->previous = ExtractCtx->previous;
 
  if (ExtractCtx == FirstCtx)
    FirstCtx = FirstCtx->next;
  else
  if (ExtractCtx == LastCtx)
    LastCtx = LastCtx->previous;
 
  free(ExtractCtx);
  NbExceptCtx --;
  return 0;
}
 
/****** Return the context of the specified Id thread *********/
/****** If Id = -1, then return the first context     *********/
 
 
Exception_context *GetExceptCtx ( Objects_Id Id ) {
 
  Exception_context *ExtractCtx;
 
  if (FirstCtx == NULL) return NULL;
 
  if  (Id == -1) {
    return LastCtx;
  }
 
  ExtractCtx = LastCtx;
 
  while (ExtractCtx->id != Id && ExtractCtx != NULL) {
    ExtractCtx = ExtractCtx->previous;
  }
 
  if (ExtractCtx == NULL)
    return NULL;
 
  return ExtractCtx;
}