123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637 |
- #define MICRIUM_SOURCE
- #ifndef OS_MASTER_FILE
- #include <ucos_ii.h>
- #endif
- #if OS_SEM_EN > 0u
- #if OS_SEM_ACCEPT_EN > 0u
- INT16U OSSemAccept (OS_EVENT *pevent)
- {
- INT16U cnt;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- return (0u);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- return (0u);
- }
- OS_ENTER_CRITICAL();
- cnt = pevent->OSEventCnt;
- if (cnt > 0u) {
- pevent->OSEventCnt--;
- }
- OS_EXIT_CRITICAL();
- return (cnt);
- }
- #endif
- OS_EVENT *OSSemCreate (INT16U cnt)
- {
- OS_EVENT *pevent;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #ifdef OS_SAFETY_CRITICAL_IEC61508
- if (OSSafetyCriticalStartFlag == OS_TRUE) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return ((OS_EVENT *)0);
- }
- #endif
- if (OSIntNesting > 0u) {
- return ((OS_EVENT *)0);
- }
- OS_ENTER_CRITICAL();
- pevent = OSEventFreeList;
- if (OSEventFreeList != (OS_EVENT *)0) {
- OSEventFreeList = (OS_EVENT *)OSEventFreeList->OSEventPtr;
- }
- OS_EXIT_CRITICAL();
- if (pevent != (OS_EVENT *)0) {
- pevent->OSEventType = OS_EVENT_TYPE_SEM;
- pevent->OSEventCnt = cnt;
- pevent->OSEventPtr = (void *)0;
- #if OS_EVENT_NAME_EN > 0u
- pevent->OSEventName = (INT8U *)(void *)"?";
- #endif
- OS_EventWaitListInit(pevent);
- }
- return (pevent);
- }
- #if OS_SEM_DEL_EN > 0u
- OS_EVENT *OSSemDel (OS_EVENT *pevent,
- INT8U opt,
- INT8U *perr)
- {
- BOOLEAN tasks_waiting;
- OS_EVENT *pevent_return;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return ((OS_EVENT *)0);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- *perr = OS_ERR_PEVENT_NULL;
- return (pevent);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- *perr = OS_ERR_EVENT_TYPE;
- return (pevent);
- }
- if (OSIntNesting > 0u) {
- *perr = OS_ERR_DEL_ISR;
- return (pevent);
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventGrp != 0u) {
- tasks_waiting = OS_TRUE;
- } else {
- tasks_waiting = OS_FALSE;
- }
- switch (opt) {
- case OS_DEL_NO_PEND:
- if (tasks_waiting == OS_FALSE) {
- #if OS_EVENT_NAME_EN > 0u
- pevent->OSEventName = (INT8U *)(void *)"?";
- #endif
- pevent->OSEventType = OS_EVENT_TYPE_UNUSED;
- pevent->OSEventPtr = OSEventFreeList;
- pevent->OSEventCnt = 0u;
- OSEventFreeList = pevent;
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- pevent_return = (OS_EVENT *)0;
- } else {
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_TASK_WAITING;
- pevent_return = pevent;
- }
- break;
- case OS_DEL_ALWAYS:
- while (pevent->OSEventGrp != 0u) {
- (void)OS_EventTaskRdy(pevent, (void *)0, OS_STAT_SEM, OS_STAT_PEND_ABORT);
- }
- #if OS_EVENT_NAME_EN > 0u
- pevent->OSEventName = (INT8U *)(void *)"?";
- #endif
- pevent->OSEventType = OS_EVENT_TYPE_UNUSED;
- pevent->OSEventPtr = OSEventFreeList;
- pevent->OSEventCnt = 0u;
- OSEventFreeList = pevent;
- OS_EXIT_CRITICAL();
- if (tasks_waiting == OS_TRUE) {
- OS_Sched();
- }
- *perr = OS_ERR_NONE;
- pevent_return = (OS_EVENT *)0;
- break;
- default:
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_INVALID_OPT;
- pevent_return = pevent;
- break;
- }
- return (pevent_return);
- }
- #endif
- void OSSemPend (OS_EVENT *pevent,
- INT32U timeout,
- INT8U *perr)
- {
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return;
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- *perr = OS_ERR_PEVENT_NULL;
- return;
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- *perr = OS_ERR_EVENT_TYPE;
- return;
- }
- if (OSIntNesting > 0u) {
- *perr = OS_ERR_PEND_ISR;
- return;
- }
- if (OSLockNesting > 0u) {
- *perr = OS_ERR_PEND_LOCKED;
- return;
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventCnt > 0u) {
- pevent->OSEventCnt--;
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- return;
- }
-
- OSTCBCur->OSTCBStat |= OS_STAT_SEM;
- OSTCBCur->OSTCBStatPend = OS_STAT_PEND_OK;
- OSTCBCur->OSTCBDly = timeout;
- OS_EventTaskWait(pevent);
- OS_EXIT_CRITICAL();
- OS_Sched();
- OS_ENTER_CRITICAL();
- switch (OSTCBCur->OSTCBStatPend) {
- case OS_STAT_PEND_OK:
- *perr = OS_ERR_NONE;
- break;
- case OS_STAT_PEND_ABORT:
- *perr = OS_ERR_PEND_ABORT;
- break;
- case OS_STAT_PEND_TO:
- default:
- OS_EventTaskRemove(OSTCBCur, pevent);
- *perr = OS_ERR_TIMEOUT;
- break;
- }
- OSTCBCur->OSTCBStat = OS_STAT_RDY;
- OSTCBCur->OSTCBStatPend = OS_STAT_PEND_OK;
- OSTCBCur->OSTCBEventPtr = (OS_EVENT *)0;
- #if (OS_EVENT_MULTI_EN > 0u)
- OSTCBCur->OSTCBEventMultiPtr = (OS_EVENT **)0;
- #endif
- OS_EXIT_CRITICAL();
- }
- #if OS_SEM_PEND_ABORT_EN > 0u
- INT8U OSSemPendAbort (OS_EVENT *pevent,
- INT8U opt,
- INT8U *perr)
- {
- INT8U nbr_tasks;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return (0u);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- *perr = OS_ERR_PEVENT_NULL;
- return (0u);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- *perr = OS_ERR_EVENT_TYPE;
- return (0u);
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventGrp != 0u) {
- nbr_tasks = 0u;
- switch (opt) {
- case OS_PEND_OPT_BROADCAST:
- while (pevent->OSEventGrp != 0u) {
- (void)OS_EventTaskRdy(pevent, (void *)0, OS_STAT_SEM, OS_STAT_PEND_ABORT);
- nbr_tasks++;
- }
- break;
- case OS_PEND_OPT_NONE:
- default:
- (void)OS_EventTaskRdy(pevent, (void *)0, OS_STAT_SEM, OS_STAT_PEND_ABORT);
- nbr_tasks++;
- break;
- }
- OS_EXIT_CRITICAL();
- OS_Sched();
- *perr = OS_ERR_PEND_ABORT;
- return (nbr_tasks);
- }
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- return (0u);
- }
- #endif
- INT8U OSSemPost (OS_EVENT *pevent)
- {
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- return (OS_ERR_PEVENT_NULL);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- return (OS_ERR_EVENT_TYPE);
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventGrp != 0u) {
-
- (void)OS_EventTaskRdy(pevent, (void *)0, OS_STAT_SEM, OS_STAT_PEND_OK);
- OS_EXIT_CRITICAL();
- OS_Sched();
- return (OS_ERR_NONE);
- }
- if (pevent->OSEventCnt < 65535u) {
- pevent->OSEventCnt++;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- OS_EXIT_CRITICAL();
- return (OS_ERR_SEM_OVF);
- }
- #if OS_SEM_QUERY_EN > 0u
- INT8U OSSemQuery (OS_EVENT *pevent,
- OS_SEM_DATA *p_sem_data)
- {
- INT8U i;
- OS_PRIO *psrc;
- OS_PRIO *pdest;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- return (OS_ERR_PEVENT_NULL);
- }
- if (p_sem_data == (OS_SEM_DATA *)0) {
- return (OS_ERR_PDATA_NULL);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- return (OS_ERR_EVENT_TYPE);
- }
- OS_ENTER_CRITICAL();
- p_sem_data->OSEventGrp = pevent->OSEventGrp;
- psrc = &pevent->OSEventTbl[0];
- pdest = &p_sem_data->OSEventTbl[0];
- for (i = 0u; i < OS_EVENT_TBL_SIZE; i++) {
- *pdest++ = *psrc++;
- }
- p_sem_data->OSCnt = pevent->OSEventCnt;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_SEM_SET_EN > 0u
- void OSSemSet (OS_EVENT *pevent,
- INT16U cnt,
- INT8U *perr)
- {
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return;
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- *perr = OS_ERR_PEVENT_NULL;
- return;
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_SEM) {
- *perr = OS_ERR_EVENT_TYPE;
- return;
- }
- OS_ENTER_CRITICAL();
- *perr = OS_ERR_NONE;
- if (pevent->OSEventCnt > 0u) {
- pevent->OSEventCnt = cnt;
- } else {
- if (pevent->OSEventGrp == 0u) {
- pevent->OSEventCnt = cnt;
- } else {
- *perr = OS_ERR_TASK_WAITING;
- }
- }
- OS_EXIT_CRITICAL();
- }
- #endif
- #endif
|