123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901 |
- #define MICRIUM_SOURCE
- #ifndef OS_MASTER_FILE
- #include <ucos_ii.h>
- #endif
- #if (OS_Q_EN > 0u) && (OS_MAX_QS > 0u)
- #if OS_Q_ACCEPT_EN > 0u
- void *OSQAccept (OS_EVENT *pevent,
- INT8U *perr)
- {
- void *pmsg;
- OS_Q *pq;
- #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 ((void *)0);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- *perr = OS_ERR_PEVENT_NULL;
- return ((void *)0);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_Q) {
- *perr = OS_ERR_EVENT_TYPE;
- return ((void *)0);
- }
- OS_ENTER_CRITICAL();
- pq = (OS_Q *)pevent->OSEventPtr;
- if (pq->OSQEntries > 0u) {
- pmsg = *pq->OSQOut++;
- pq->OSQEntries--;
- if (pq->OSQOut == pq->OSQEnd) {
- pq->OSQOut = pq->OSQStart;
- }
- *perr = OS_ERR_NONE;
- } else {
- *perr = OS_ERR_Q_EMPTY;
- pmsg = (void *)0;
- }
- OS_EXIT_CRITICAL();
- return (pmsg);
- }
- #endif
- OS_EVENT *OSQCreate (void **start,
- INT16U size)
- {
- OS_EVENT *pevent;
- OS_Q *pq;
- #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) {
- OS_ENTER_CRITICAL();
- pq = OSQFreeList;
- if (pq != (OS_Q *)0) {
- OSQFreeList = OSQFreeList->OSQPtr;
- OS_EXIT_CRITICAL();
- pq->OSQStart = start;
- pq->OSQEnd = &start[size];
- pq->OSQIn = start;
- pq->OSQOut = start;
- pq->OSQSize = size;
- pq->OSQEntries = 0u;
- pevent->OSEventType = OS_EVENT_TYPE_Q;
- pevent->OSEventCnt = 0u;
- pevent->OSEventPtr = pq;
- #if OS_EVENT_NAME_EN > 0u
- pevent->OSEventName = (INT8U *)(void *)"?";
- #endif
- OS_EventWaitListInit(pevent);
- } else {
- pevent->OSEventPtr = (void *)OSEventFreeList;
- OSEventFreeList = pevent;
- OS_EXIT_CRITICAL();
- pevent = (OS_EVENT *)0;
- }
- }
- return (pevent);
- }
- #if OS_Q_DEL_EN > 0u
- OS_EVENT *OSQDel (OS_EVENT *pevent,
- INT8U opt,
- INT8U *perr)
- {
- BOOLEAN tasks_waiting;
- OS_EVENT *pevent_return;
- OS_Q *pq;
- #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_Q) {
- *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
- pq = (OS_Q *)pevent->OSEventPtr;
- pq->OSQPtr = OSQFreeList;
- OSQFreeList = pq;
- 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_Q, OS_STAT_PEND_ABORT);
- }
- #if OS_EVENT_NAME_EN > 0u
- pevent->OSEventName = (INT8U *)(void *)"?";
- #endif
- pq = (OS_Q *)pevent->OSEventPtr;
- pq->OSQPtr = OSQFreeList;
- OSQFreeList = pq;
- 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
- #if OS_Q_FLUSH_EN > 0u
- INT8U OSQFlush (OS_EVENT *pevent)
- {
- OS_Q *pq;
- #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 (pevent->OSEventType != OS_EVENT_TYPE_Q) {
- return (OS_ERR_EVENT_TYPE);
- }
- #endif
- OS_ENTER_CRITICAL();
- pq = (OS_Q *)pevent->OSEventPtr;
- pq->OSQIn = pq->OSQStart;
- pq->OSQOut = pq->OSQStart;
- pq->OSQEntries = 0u;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- void *OSQPend (OS_EVENT *pevent,
- INT32U timeout,
- INT8U *perr)
- {
- void *pmsg;
- OS_Q *pq;
- #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 ((void *)0);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (pevent == (OS_EVENT *)0) {
- *perr = OS_ERR_PEVENT_NULL;
- return ((void *)0);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_Q) {
- *perr = OS_ERR_EVENT_TYPE;
- return ((void *)0);
- }
- if (OSIntNesting > 0u) {
- *perr = OS_ERR_PEND_ISR;
- return ((void *)0);
- }
- if (OSLockNesting > 0u) {
- *perr = OS_ERR_PEND_LOCKED;
- return ((void *)0);
- }
- OS_ENTER_CRITICAL();
- pq = (OS_Q *)pevent->OSEventPtr;
- if (pq->OSQEntries > 0u) {
- pmsg = *pq->OSQOut++;
- pq->OSQEntries--;
- if (pq->OSQOut == pq->OSQEnd) {
- pq->OSQOut = pq->OSQStart;
- }
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- return (pmsg);
- }
- OSTCBCur->OSTCBStat |= OS_STAT_Q;
- 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:
- pmsg = OSTCBCur->OSTCBMsg;
- *perr = OS_ERR_NONE;
- break;
- case OS_STAT_PEND_ABORT:
- pmsg = (void *)0;
- *perr = OS_ERR_PEND_ABORT;
- break;
- case OS_STAT_PEND_TO:
- default:
- OS_EventTaskRemove(OSTCBCur, pevent);
- pmsg = (void *)0;
- *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
- OSTCBCur->OSTCBMsg = (void *)0;
- OS_EXIT_CRITICAL();
- return (pmsg);
- }
- #if OS_Q_PEND_ABORT_EN > 0u
- INT8U OSQPendAbort (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_Q) {
- *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_Q, OS_STAT_PEND_ABORT);
- nbr_tasks++;
- }
- break;
- case OS_PEND_OPT_NONE:
- default:
- (void)OS_EventTaskRdy(pevent, (void *)0, OS_STAT_Q, 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
- #if OS_Q_POST_EN > 0u
- INT8U OSQPost (OS_EVENT *pevent,
- void *pmsg)
- {
- OS_Q *pq;
- #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_Q) {
- return (OS_ERR_EVENT_TYPE);
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventGrp != 0u) {
-
- (void)OS_EventTaskRdy(pevent, pmsg, OS_STAT_Q, OS_STAT_PEND_OK);
- OS_EXIT_CRITICAL();
- OS_Sched();
- return (OS_ERR_NONE);
- }
- pq = (OS_Q *)pevent->OSEventPtr;
- if (pq->OSQEntries >= pq->OSQSize) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_Q_FULL);
- }
- *pq->OSQIn++ = pmsg;
- pq->OSQEntries++;
- if (pq->OSQIn == pq->OSQEnd) {
- pq->OSQIn = pq->OSQStart;
- }
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_Q_POST_FRONT_EN > 0u
- INT8U OSQPostFront (OS_EVENT *pevent,
- void *pmsg)
- {
- OS_Q *pq;
- #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_Q) {
- return (OS_ERR_EVENT_TYPE);
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventGrp != 0u) {
-
- (void)OS_EventTaskRdy(pevent, pmsg, OS_STAT_Q, OS_STAT_PEND_OK);
- OS_EXIT_CRITICAL();
- OS_Sched();
- return (OS_ERR_NONE);
- }
- pq = (OS_Q *)pevent->OSEventPtr;
- if (pq->OSQEntries >= pq->OSQSize) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_Q_FULL);
- }
- if (pq->OSQOut == pq->OSQStart) {
- pq->OSQOut = pq->OSQEnd;
- }
- pq->OSQOut--;
- *pq->OSQOut = pmsg;
- pq->OSQEntries++;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_Q_POST_OPT_EN > 0u
- INT8U OSQPostOpt (OS_EVENT *pevent,
- void *pmsg,
- INT8U opt)
- {
- OS_Q *pq;
- #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_Q) {
- return (OS_ERR_EVENT_TYPE);
- }
- OS_ENTER_CRITICAL();
- if (pevent->OSEventGrp != 0x00u) {
- if ((opt & OS_POST_OPT_BROADCAST) != 0x00u) {
- while (pevent->OSEventGrp != 0u) {
- (void)OS_EventTaskRdy(pevent, pmsg, OS_STAT_Q, OS_STAT_PEND_OK);
- }
- } else {
- (void)OS_EventTaskRdy(pevent, pmsg, OS_STAT_Q, OS_STAT_PEND_OK);
- }
- OS_EXIT_CRITICAL();
- if ((opt & OS_POST_OPT_NO_SCHED) == 0u) {
- OS_Sched();
- }
- return (OS_ERR_NONE);
- }
- pq = (OS_Q *)pevent->OSEventPtr;
- if (pq->OSQEntries >= pq->OSQSize) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_Q_FULL);
- }
- if ((opt & OS_POST_OPT_FRONT) != 0x00u) {
- if (pq->OSQOut == pq->OSQStart) {
- pq->OSQOut = pq->OSQEnd;
- }
- pq->OSQOut--;
- *pq->OSQOut = pmsg;
- } else {
- *pq->OSQIn++ = pmsg;
- if (pq->OSQIn == pq->OSQEnd) {
- pq->OSQIn = pq->OSQStart;
- }
- }
- pq->OSQEntries++;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_Q_QUERY_EN > 0u
- INT8U OSQQuery (OS_EVENT *pevent,
- OS_Q_DATA *p_q_data)
- {
- OS_Q *pq;
- 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_q_data == (OS_Q_DATA *)0) {
- return (OS_ERR_PDATA_NULL);
- }
- #endif
- if (pevent->OSEventType != OS_EVENT_TYPE_Q) {
- return (OS_ERR_EVENT_TYPE);
- }
- OS_ENTER_CRITICAL();
- p_q_data->OSEventGrp = pevent->OSEventGrp;
- psrc = &pevent->OSEventTbl[0];
- pdest = &p_q_data->OSEventTbl[0];
- for (i = 0u; i < OS_EVENT_TBL_SIZE; i++) {
- *pdest++ = *psrc++;
- }
- pq = (OS_Q *)pevent->OSEventPtr;
- if (pq->OSQEntries > 0u) {
- p_q_data->OSMsg = *pq->OSQOut;
- } else {
- p_q_data->OSMsg = (void *)0;
- }
- p_q_data->OSNMsgs = pq->OSQEntries;
- p_q_data->OSQSize = pq->OSQSize;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- void OS_QInit (void)
- {
- #if OS_MAX_QS == 1u
- OSQFreeList = &OSQTbl[0];
- OSQFreeList->OSQPtr = (OS_Q *)0;
- #endif
- #if OS_MAX_QS >= 2u
- INT16U ix;
- INT16U ix_next;
- OS_Q *pq1;
- OS_Q *pq2;
- OS_MemClr((INT8U *)&OSQTbl[0], sizeof(OSQTbl));
- for (ix = 0u; ix < (OS_MAX_QS - 1u); ix++) {
- ix_next = ix + 1u;
- pq1 = &OSQTbl[ix];
- pq2 = &OSQTbl[ix_next];
- pq1->OSQPtr = pq2;
- }
- pq1 = &OSQTbl[ix];
- pq1->OSQPtr = (OS_Q *)0;
- OSQFreeList = &OSQTbl[0];
- #endif
- }
- #endif
|