FreeCalypso > hg > fc-magnetite
view src/gpf2/osl/os_sem_fl.c @ 632:d968a3216ba0
new tangomdm build target
TCS211/Magnetite built for target leonardo runs just fine on the Tango-based
Caramel board, but a more proper tangomdm build target is preferable in order
to better market these Tango modems to prospective commercial customers. The
only differences are in GPIO and MCSI config:
* MCSI is enabled in the tangomdm build config.
* GPIO 1 is loudspeaker amplifier control on Leonardo, but on Tango platforms
it can be used for anything. On Caramel boards this GPIO should be
configured as an output driving high.
* GPIO 2 needs to be configured as Calypso input on Leonardo, but on Tango
platforms it can be used for anything. On Caramel boards this GPIO should be
configured as an output, either high or low is OK.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 04 Jan 2020 19:27:41 +0000 |
parents | 27db9775cbab |
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 "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++) memset(&SemTable[i], 0, 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((unsigned char *) 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((unsigned char *) 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); }