FreeCalypso > hg > freecalypso-sw
view gsm-fw/gpf/osl/os_sem_fl.c @ 515:cb38dc8aed39
gsm-fw/configs/{c139,c155}.ramdemo added
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Wed, 02 Jul 2014 04:00:01 +0000 |
parents | 03b6377d61db |
children |
line wrap: on
line source
/* * This C module is a reconstruction based on the disassembly of * os_sem.obj in frame_na7_db_fl.lib from the Leonardo package. */ /* set of included headers from COFF symtab: */ #include <stdio.h> #include <string.h> #include "gpfconf.h" /* FreeCalypso addition */ #include "../../nucleus/nucleus.h" #include "typedefs.h" #include "os.h" #include "gdi.h" #include "os_types.h" #include "os_glob.h" extern T_OS_SEM_TABLE_ENTRY SemTable[]; static NU_SEMAPHORE SemSemCB; static int os_GetSemaphoreEntry(USHORT Index, OS_HANDLE *Handle) { static USHORT Idx; if (Index == FIRST_ENTRY) Idx = 0; if (Index == FIRST_ENTRY || Index == NEXT_ENTRY) { for (;;) { Idx++; if (Idx > MaxSemaphores) return(OS_ERROR); if (SemTable[Idx].Name[0]) break; } } else Idx = Index; if (Idx > MaxSemaphores) return(OS_ERROR); if (SemTable[Idx].Name[0]) { *Handle = Idx; return(OS_OK); } else return(OS_ERROR); } GLOBAL LONG os_SemaphoreInformation(USHORT Index, char *Buffer) { OS_HANDLE Handle; OPTION SuspendType; UNSIGNED Current, TasksWaiting; NU_TASK *First; CHAR Name[NU_MAX_NAME]; if (os_GetSemaphoreEntry(Index, &Handle) < 0) return(OS_ERROR); if (NU_Semaphore_Information(&SemTable[Handle].SemCB, Name, &Current, &SuspendType, &TasksWaiting, &First) != NU_SUCCESS) return(OS_ERROR); sprintf(Buffer, "Semname:%s Count:%ld Suspend:%d Waiting:%ld", Name, Current, SuspendType, TasksWaiting); return(OS_OK); } GLOBAL LONG os_SemInit(void) { USHORT i; if (NU_Create_Semaphore(&SemSemCB, "SEMSEM", 1, NU_PRIORITY) != NU_SUCCESS) return(OS_ERROR); for (i = 1; i <= MaxSemaphores; i++) bzero(&SemTable[i], sizeof(T_OS_SEM_TABLE_ENTRY)); return(OS_OK); } GLOBAL LONG os_ResetSemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle, USHORT init_counter) { STATUS sts; sts = NU_Obtain_Semaphore(&SemSemCB, NU_SUSPEND); if (!SemTable[SemHandle].Name[0]) { error_out: if (sts == NU_SUCCESS) NU_Release_Semaphore(&SemSemCB); return(OS_ERROR); } if (NU_Reset_Semaphore(&SemTable[SemHandle].SemCB, init_counter) != NU_SUCCESS) goto error_out; if (sts == NU_SUCCESS) NU_Release_Semaphore(&SemSemCB); return(OS_OK); } GLOBAL LONG os_QuerySemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle, USHORT *Count) { OPTION SuspendType; UNSIGNED SemCount, TasksWaiting; NU_TASK *First; CHAR Name[NU_MAX_NAME]; if (NU_Semaphore_Information(&SemTable[SemHandle].SemCB, Name, &SemCount, &SuspendType, &TasksWaiting, &First) != NU_SUCCESS) return(OS_ERROR); *Count = SemCount; return(OS_OK); } GLOBAL LONG os_OpenSemaphore(OS_HANDLE TaskHandle, char *Name, OS_HANDLE *SemHandle) { USHORT i; for (i = 1; i <= MaxSemaphores; i++) { if (!SemTable[i].Name[0]) continue; if (strncmp(Name, SemTable[i].Name, RESOURCE_NAMELEN-1)) continue; *SemHandle = i; return(OS_OK); } return(OS_ERROR); } GLOBAL unsigned char * os_FindSuspendingSema(unsigned int *tcb) { USHORT i; SM_SUSPEND *susp, *susp_loopchk; for (i = 1; i <= MaxSemaphores; i++) { if (!SemTable[i].Name[0]) continue; susp = SemTable[i].SemCB.sm_suspension_list; if (!susp) continue; if (susp->sm_suspended_task == (NU_TASK *)tcb) return(SemTable[i].SemCB.sm_name); susp = (SM_SUSPEND *)susp->sm_suspend_link.cs_next; for (susp_loopchk = susp; susp != susp_loopchk; susp = (SM_SUSPEND *)susp->sm_suspend_link.cs_next) if (susp->sm_suspended_task == (NU_TASK *)tcb) return(SemTable[i].SemCB.sm_name); } return(0); } GLOBAL LONG os_DestroySemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle) { STATUS sts; sts = NU_Obtain_Semaphore(&SemSemCB, NU_SUSPEND); if (!SemTable[SemHandle].Name[0]) { error_out: if (sts == NU_SUCCESS) NU_Release_Semaphore(&SemSemCB); return(OS_ERROR); } if (NU_Delete_Semaphore(&SemTable[SemHandle].SemCB) != NU_SUCCESS) goto error_out; SemTable[SemHandle].Name[0] = 0; if (sts == NU_SUCCESS) NU_Release_Semaphore(&SemSemCB); return(OS_OK); } GLOBAL LONG os_CreateSemaphore(OS_HANDLE TaskHandle, char *Name, USHORT Count, OS_HANDLE *SemHandle, OS_HANDLE MemPoolHandle) { USHORT i; STATUS sts; if (os_OpenSemaphore(TaskHandle, Name, SemHandle) == OS_OK) return(OS_ERROR); sts = NU_Obtain_Semaphore(&SemSemCB, NU_SUSPEND); for (i = 1; i <= MaxSemaphores; i++) { if (SemTable[i].Name[0]) continue; if (NU_Create_Semaphore(&SemTable[i].SemCB, Name, Count, NU_PRIORITY) != NU_SUCCESS) break; strncpy(SemTable[i].Name, Name, RESOURCE_NAMELEN); SemTable[i].Name[RESOURCE_NAMELEN-1] = 0; *SemHandle = i; if (sts == NU_SUCCESS) NU_Release_Semaphore(&SemSemCB); return(OS_OK); } if (sts == NU_SUCCESS) NU_Release_Semaphore(&SemSemCB); return(OS_ERROR); } GLOBAL LONG os_CloseSemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle) { return(OS_OK); }