FreeCalypso > hg > fc-tourmaline
view src/gpf/osl/os_com_ir.c @ 221:5bf097aeaad7
LLS: when turning off all LEDs on boot, skip LED-C
Having LLS turn off LED-A and LED-B on boot is normally unnecessary
(they should already be off in Iota), but it is harmless, hence this
logic is kept for robustness. However, having LLS read-modify-write
the BCICTL2 register (to turn off LED-C) creates a potential race
condition with FCHG writes to this register, especially in the case
when baseband switch-on is caused by VCHG and charging is expected
to start right away. Furthermore, control of the charging LED itself
(on those hw targets that have it) is the responsibility of the FCHG
SWE, hence LLS should leave it alone.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Mon, 26 Apr 2021 21:55:13 +0000 |
parents | 4e78acac3d88 |
children |
line wrap: on
line source
/* * This C module is a reconstruction based on the disassembly of * os_com.obj in frame_na7_db_ir.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 TC_PROTECT TCD_System_Protect; extern VOID TCT_Protect(TC_PROTECT *protect); extern VOID TCT_Unprotect(VOID); extern VOID TCT_Unprotect_Specific(TC_PROTECT *protect); #define My_System_Protect() TCT_Protect(&TCD_System_Protect) #define My_System_Unprotect() TCT_Unprotect_Specific(&TCD_System_Protect) extern T_OS_COM_TABLE_ENTRY ComTable[]; extern unsigned os_tick_to_time_multiplier; extern int ObtainSemaphoreCB(NU_SEMAPHORE *SemCB, ULONG Timeout, USHORT wait_check); extern int ReleaseSemaphoreCB(NU_SEMAPHORE *SemCB); GLOBAL LONG os_SendToQueue(OS_HANDLE TaskHandle, OS_HANDLE ComHandle, USHORT Priority, ULONG Suspend, OS_QDATA *Msg) { T_OS_COM_TABLE_ENTRY *pTable; T_QDATA_ELEMENT *elem; T_QUEUE *queue; int ret; NU_SEMAPHORE *CBPtr; USHORT watmark; if (ComHandle <= 0 || ComHandle > MaxCommunications) return(OS_INVALID_QUEUE); pTable = ComTable + ComHandle; if (!pTable->Name[0]) return(OS_INVALID_QUEUE); CBPtr = &pTable->FreeSemCB; ret = ObtainSemaphoreCB(CBPtr, Suspend, 1); if (ret == OS_ERROR || ret == OS_TIMEOUT) return(ret); My_System_Protect(); elem = pTable->pFreeElement; pTable->pFreeElement = elem->pNext; memcpy(&elem->Data, Msg, sizeof(OS_QDATA)); queue = &pTable->Queue[Priority - OS_MIN_PRIORITY]; *queue->pWrite++ = &elem->Data; if (queue->pWrite - queue->pStart >= pTable->Entries + 1) queue->pWrite = queue->pStart; watmark = pTable->Entries - CBPtr->sm_semaphore_count; if (pTable->MaxUsed < watmark) pTable->MaxUsed = watmark; My_System_Unprotect(); ReleaseSemaphoreCB(&pTable->UsedSemCB); return(ret); } GLOBAL LONG os_ReceiveFromQueue(OS_HANDLE TaskHandle, OS_HANDLE ComHandle, OS_QDATA *Msg, ULONG Timeout) { T_QDATA_ELEMENT *pElem; UNSIGNED c_time; int ret; USHORT i; T_QUEUE *pQueue; T_OS_COM_TABLE_ENTRY *pTable; pTable = ComTable + ComHandle; if (!pTable->Name[0]) return(OS_ERROR); pTable->current_msg.type = 0; ret = ObtainSemaphoreCB(&pTable->UsedSemCB, Timeout, 0); if (ret == OS_ERROR || ret == OS_TIMEOUT) return(ret); My_System_Protect(); for (i = OS_MAX_PRIORITY; i >= OS_MIN_PRIORITY; i--) { pQueue = &pTable->Queue[i - OS_MIN_PRIORITY]; if (pQueue->pWrite != pQueue->pRead) break; } if (i < OS_MIN_PRIORITY) { My_System_Unprotect(); ReleaseSemaphoreCB(&pTable->FreeSemCB); return(OS_ERROR); } memcpy(Msg, *pQueue->pRead, sizeof(OS_QDATA)); pElem = (T_QDATA_ELEMENT *)*pQueue->pRead++; pElem->Data.data16 = 0; pElem->pNext = pTable->pFreeElement; pTable->pFreeElement = pElem; if (pQueue->pRead - pQueue->pStart >= pTable->Entries + 1) pQueue->pRead = pQueue->pStart; pTable->current_msg.type = Msg->data16; pTable->current_msg.opc = Msg->data32; c_time = NU_Retrieve_Clock(); pTable->current_msg.time = SYSTEM_TICKS_TO_TIME(c_time); pTable->current_msg.ptr = Msg->ptr; My_System_Unprotect(); ReleaseSemaphoreCB(&pTable->FreeSemCB); return(OS_OK); }