URL
https://opencores.org/ocsvn/openrisc/openrisc/trunk
Subversion Repositories openrisc
[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [librdbg/] [src/] [excep.c] - Rev 30
Go to most recent revision | Compare with Previous | Blame | View Log
/* ************************************************************************** * * 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; }
Go to most recent revision | Compare with Previous | Blame | View Log