FreeCalypso > hg > fc-tourmaline
view src/gpf/osl/os_sem_fl.c @ 51:04aaa5622fa7
disable deep sleep when Iota LEDB is on
TI's Iota chip docs say that CLK13M must be running in order for
LEDB to work, and practical experience on Mot C139 which uses
Iota LEDB for its keypad backlight concurs: if Calypso enters
deep sleep while the keypad backlight is turned on, the light
flickers visibly as the chipset goes into and out of deep sleep.
TI's original L1 sleep manager code had logic to disable deep sleep
when LT_Status() returns nonzero, but that function only works
for B-Sample and C-Sample LT, always returns 0 on BOARD 41 - no
check of Iota LEDB status anywhere. Change this code for our
current hardware: disable deep sleep when Iota LEDB has been
turned on through LLS.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Mon, 19 Oct 2020 05:11:29 +0000 |
parents | 4e78acac3d88 |
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); }