12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343 |
- #define MICRIUM_SOURCE
- #ifndef OS_MASTER_FILE
- #include <ucos_ii.h>
- #endif
- #if OS_TASK_CHANGE_PRIO_EN > 0u
- INT8U OSTaskChangePrio (INT8U oldprio,
- INT8U newprio)
- {
- #if (OS_EVENT_EN)
- OS_EVENT *pevent;
- #if (OS_EVENT_MULTI_EN > 0u)
- OS_EVENT **pevents;
- #endif
- #endif
- OS_TCB *ptcb;
- INT8U y_new;
- INT8U x_new;
- INT8U y_old;
- OS_PRIO bity_new;
- OS_PRIO bitx_new;
- OS_PRIO bity_old;
- OS_PRIO bitx_old;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (oldprio >= OS_LOWEST_PRIO) {
- if (oldprio != OS_PRIO_SELF) {
- return (OS_ERR_PRIO_INVALID);
- }
- }
- if (newprio >= OS_LOWEST_PRIO) {
- return (OS_ERR_PRIO_INVALID);
- }
- #endif
- OS_ENTER_CRITICAL();
- if (OSTCBPrioTbl[newprio] != (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_PRIO_EXIST);
- }
- if (oldprio == OS_PRIO_SELF) {
- oldprio = OSTCBCur->OSTCBPrio;
- }
- ptcb = OSTCBPrioTbl[oldprio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_PRIO);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- #if OS_LOWEST_PRIO <= 63u
- y_new = (INT8U)(newprio >> 3u);
- x_new = (INT8U)(newprio & 0x07u);
- #else
- y_new = (INT8U)((INT8U)(newprio >> 4u) & 0x0Fu);
- x_new = (INT8U)(newprio & 0x0Fu);
- #endif
- bity_new = (OS_PRIO)(1uL << y_new);
- bitx_new = (OS_PRIO)(1uL << x_new);
- OSTCBPrioTbl[oldprio] = (OS_TCB *)0;
- OSTCBPrioTbl[newprio] = ptcb;
- y_old = ptcb->OSTCBY;
- bity_old = ptcb->OSTCBBitY;
- bitx_old = ptcb->OSTCBBitX;
- if ((OSRdyTbl[y_old] & bitx_old) != 0u) {
- OSRdyTbl[y_old] &= (OS_PRIO)~bitx_old;
- if (OSRdyTbl[y_old] == 0u) {
- OSRdyGrp &= (OS_PRIO)~bity_old;
- }
- OSRdyGrp |= bity_new;
- OSRdyTbl[y_new] |= bitx_new;
- }
- #if (OS_EVENT_EN)
- pevent = ptcb->OSTCBEventPtr;
- if (pevent != (OS_EVENT *)0) {
- pevent->OSEventTbl[y_old] &= (OS_PRIO)~bitx_old;
- if (pevent->OSEventTbl[y_old] == 0u) {
- pevent->OSEventGrp &= (OS_PRIO)~bity_old;
- }
- pevent->OSEventGrp |= bity_new;
- pevent->OSEventTbl[y_new] |= bitx_new;
- }
- #if (OS_EVENT_MULTI_EN > 0u)
- if (ptcb->OSTCBEventMultiPtr != (OS_EVENT **)0) {
- pevents = ptcb->OSTCBEventMultiPtr;
- pevent = *pevents;
- while (pevent != (OS_EVENT *)0) {
- pevent->OSEventTbl[y_old] &= (OS_PRIO)~bitx_old;
- if (pevent->OSEventTbl[y_old] == 0u) {
- pevent->OSEventGrp &= (OS_PRIO)~bity_old;
- }
- pevent->OSEventGrp |= bity_new;
- pevent->OSEventTbl[y_new] |= bitx_new;
- pevents++;
- pevent = *pevents;
- }
- }
- #endif
- #endif
- ptcb->OSTCBPrio = newprio;
- ptcb->OSTCBY = y_new;
- ptcb->OSTCBX = x_new;
- ptcb->OSTCBBitY = bity_new;
- ptcb->OSTCBBitX = bitx_new;
- OS_EXIT_CRITICAL();
- if (OSRunning == OS_TRUE) {
- OS_Sched();
- }
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_TASK_CREATE_EN > 0u
- INT8U OSTaskCreate (void (*task)(void *p_arg),
- void *p_arg,
- OS_STK *ptos,
- INT8U prio)
- {
- OS_STK *psp;
- INT8U err;
- #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_ERR_ILLEGAL_CREATE_RUN_TIME);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio > OS_LOWEST_PRIO) {
- return (OS_ERR_PRIO_INVALID);
- }
- #endif
- OS_ENTER_CRITICAL();
- if (OSIntNesting > 0u) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_CREATE_ISR);
- }
- if (OSTCBPrioTbl[prio] == (OS_TCB *)0) {
- OSTCBPrioTbl[prio] = OS_TCB_RESERVED;
-
- OS_EXIT_CRITICAL();
- psp = OSTaskStkInit(task, p_arg, ptos, 0u);
- err = OS_TCBInit(prio, psp, (OS_STK *)0, 0u, 0u, (void *)0, 0u);
- if (err == OS_ERR_NONE) {
- if (OSRunning == OS_TRUE) {
- OS_Sched();
- }
- } else {
- OS_ENTER_CRITICAL();
- OSTCBPrioTbl[prio] = (OS_TCB *)0;
- OS_EXIT_CRITICAL();
- }
- return (err);
- }
- OS_EXIT_CRITICAL();
- return (OS_ERR_PRIO_EXIST);
- }
- #endif
- #if OS_TASK_CREATE_EXT_EN > 0u
- INT8U OSTaskCreateExt (void (*task)(void *p_arg),
- void *p_arg,
- OS_STK *ptos,
- INT8U prio,
- INT16U id,
- OS_STK *pbos,
- INT32U stk_size,
- void *pext,
- INT16U opt)
- {
- OS_STK *psp;
- INT8U err;
- #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_ERR_ILLEGAL_CREATE_RUN_TIME);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio > OS_LOWEST_PRIO) {
- return (OS_ERR_PRIO_INVALID);
- }
- #endif
- OS_ENTER_CRITICAL();
- if (OSIntNesting > 0u) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_CREATE_ISR);
- }
- if (OSTCBPrioTbl[prio] == (OS_TCB *)0) {
- OSTCBPrioTbl[prio] = OS_TCB_RESERVED;
-
- OS_EXIT_CRITICAL();
- #if (OS_TASK_STAT_STK_CHK_EN > 0u)
- OS_TaskStkClr(pbos, stk_size, opt);
- #endif
- psp = OSTaskStkInit(task, p_arg, ptos, opt);
- err = OS_TCBInit(prio, psp, pbos, id, stk_size, pext, opt);
- if (err == OS_ERR_NONE) {
- if (OSRunning == OS_TRUE) {
- OS_Sched();
- }
- } else {
- OS_ENTER_CRITICAL();
- OSTCBPrioTbl[prio] = (OS_TCB *)0;
- OS_EXIT_CRITICAL();
- }
- return (err);
- }
- OS_EXIT_CRITICAL();
- return (OS_ERR_PRIO_EXIST);
- }
- #endif
- #if OS_TASK_DEL_EN > 0u
- INT8U OSTaskDel (INT8U prio)
- {
- #if (OS_FLAG_EN > 0u) && (OS_MAX_FLAGS > 0u)
- OS_FLAG_NODE *pnode;
- #endif
- OS_TCB *ptcb;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- if (OSIntNesting > 0u) {
- return (OS_ERR_TASK_DEL_ISR);
- }
- if (prio == OS_TASK_IDLE_PRIO) {
- return (OS_ERR_TASK_DEL_IDLE);
- }
- #if OS_ARG_CHK_EN > 0u
- if (prio >= OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- return (OS_ERR_PRIO_INVALID);
- }
- }
- #endif
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- prio = OSTCBCur->OSTCBPrio;
- }
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_DEL);
- }
- OSRdyTbl[ptcb->OSTCBY] &= (OS_PRIO)~ptcb->OSTCBBitX;
- if (OSRdyTbl[ptcb->OSTCBY] == 0u) {
- OSRdyGrp &= (OS_PRIO)~ptcb->OSTCBBitY;
- }
- #if (OS_EVENT_EN)
- if (ptcb->OSTCBEventPtr != (OS_EVENT *)0) {
- OS_EventTaskRemove(ptcb, ptcb->OSTCBEventPtr);
- }
- #if (OS_EVENT_MULTI_EN > 0u)
- if (ptcb->OSTCBEventMultiPtr != (OS_EVENT **)0) {
- OS_EventTaskRemoveMulti(ptcb, ptcb->OSTCBEventMultiPtr);
- }
- #endif
- #endif
- #if (OS_FLAG_EN > 0u) && (OS_MAX_FLAGS > 0u)
- pnode = ptcb->OSTCBFlagNode;
- if (pnode != (OS_FLAG_NODE *)0) {
- OS_FlagUnlink(pnode);
- }
- #endif
- ptcb->OSTCBDly = 0u;
- ptcb->OSTCBStat = OS_STAT_RDY;
- ptcb->OSTCBStatPend = OS_STAT_PEND_OK;
- if (OSLockNesting < 255u) {
- OSLockNesting++;
- }
- OS_EXIT_CRITICAL();
- OS_Dummy();
- OS_ENTER_CRITICAL();
- if (OSLockNesting > 0u) {
- OSLockNesting--;
- }
- OSTaskDelHook(ptcb);
- #if OS_TASK_CREATE_EXT_EN > 0u
- #if defined(OS_TLS_TBL_SIZE) && (OS_TLS_TBL_SIZE > 0u)
- OS_TLS_TaskDel(ptcb);
- #endif
- #endif
- OSTaskCtr--;
- OSTCBPrioTbl[prio] = (OS_TCB *)0;
- if (ptcb->OSTCBPrev == (OS_TCB *)0) {
- ptcb->OSTCBNext->OSTCBPrev = (OS_TCB *)0;
- OSTCBList = ptcb->OSTCBNext;
- } else {
- ptcb->OSTCBPrev->OSTCBNext = ptcb->OSTCBNext;
- ptcb->OSTCBNext->OSTCBPrev = ptcb->OSTCBPrev;
- }
- ptcb->OSTCBNext = OSTCBFreeList;
- OSTCBFreeList = ptcb;
- #if OS_TASK_NAME_EN > 0u
- ptcb->OSTCBTaskName = (INT8U *)(void *)"?";
- #endif
- OS_EXIT_CRITICAL();
- if (OSRunning == OS_TRUE) {
- OS_Sched();
- }
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_TASK_DEL_EN > 0u
- INT8U OSTaskDelReq (INT8U prio)
- {
- INT8U stat;
- OS_TCB *ptcb;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- if (prio == OS_TASK_IDLE_PRIO) {
- return (OS_ERR_TASK_DEL_IDLE);
- }
- #if OS_ARG_CHK_EN > 0u
- if (prio >= OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- return (OS_ERR_PRIO_INVALID);
- }
- }
- #endif
- if (prio == OS_PRIO_SELF) {
- OS_ENTER_CRITICAL();
- stat = OSTCBCur->OSTCBDelReq;
- OS_EXIT_CRITICAL();
- return (stat);
- }
- OS_ENTER_CRITICAL();
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_DEL);
- }
- ptcb->OSTCBDelReq = OS_ERR_TASK_DEL_REQ;
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_TASK_NAME_EN > 0u
- INT8U OSTaskNameGet (INT8U prio,
- INT8U **pname,
- INT8U *perr)
- {
- OS_TCB *ptcb;
- INT8U len;
- #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 (prio > OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- *perr = OS_ERR_PRIO_INVALID;
- return (0u);
- }
- }
- if (pname == (INT8U **)0) {
- *perr = OS_ERR_PNAME_NULL;
- return (0u);
- }
- #endif
- if (OSIntNesting > 0u) {
- *perr = OS_ERR_NAME_GET_ISR;
- return (0u);
- }
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- prio = OSTCBCur->OSTCBPrio;
- }
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_TASK_NOT_EXIST;
- return (0u);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_TASK_NOT_EXIST;
- return (0u);
- }
- *pname = ptcb->OSTCBTaskName;
- len = OS_StrLen(*pname);
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- return (len);
- }
- #endif
- #if OS_TASK_NAME_EN > 0u
- void OSTaskNameSet (INT8U prio,
- INT8U *pname,
- INT8U *perr)
- {
- OS_TCB *ptcb;
- #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 (prio > OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- *perr = OS_ERR_PRIO_INVALID;
- return;
- }
- }
- if (pname == (INT8U *)0) {
- *perr = OS_ERR_PNAME_NULL;
- return;
- }
- #endif
- if (OSIntNesting > 0u) {
- *perr = OS_ERR_NAME_SET_ISR;
- return;
- }
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- prio = OSTCBCur->OSTCBPrio;
- }
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_TASK_NOT_EXIST;
- return;
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_TASK_NOT_EXIST;
- return;
- }
- ptcb->OSTCBTaskName = pname;
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- }
- #endif
- #if OS_TASK_SUSPEND_EN > 0u
- INT8U OSTaskResume (INT8U prio)
- {
- OS_TCB *ptcb;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio >= OS_LOWEST_PRIO) {
- return (OS_ERR_PRIO_INVALID);
- }
- #endif
- OS_ENTER_CRITICAL();
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_RESUME_PRIO);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- if ((ptcb->OSTCBStat & OS_STAT_SUSPEND) != OS_STAT_RDY) {
- ptcb->OSTCBStat &= (INT8U)~(INT8U)OS_STAT_SUSPEND;
- if ((ptcb->OSTCBStat & OS_STAT_PEND_ANY) == OS_STAT_RDY) {
- if (ptcb->OSTCBDly == 0u) {
- OSRdyGrp |= ptcb->OSTCBBitY;
- OSRdyTbl[ptcb->OSTCBY] |= ptcb->OSTCBBitX;
- OS_EXIT_CRITICAL();
- if (OSRunning == OS_TRUE) {
- OS_Sched();
- }
- } else {
- OS_EXIT_CRITICAL();
- }
- } else {
- OS_EXIT_CRITICAL();
- }
- return (OS_ERR_NONE);
- }
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_SUSPENDED);
- }
- #endif
- #if (OS_TASK_STAT_STK_CHK_EN > 0u) && (OS_TASK_CREATE_EXT_EN > 0u)
- INT8U OSTaskStkChk (INT8U prio,
- OS_STK_DATA *p_stk_data)
- {
- OS_TCB *ptcb;
- OS_STK *pchk;
- INT32U nfree;
- INT32U size;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio > OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- return (OS_ERR_PRIO_INVALID);
- }
- }
- if (p_stk_data == (OS_STK_DATA *)0) {
- return (OS_ERR_PDATA_NULL);
- }
- #endif
- p_stk_data->OSFree = 0u;
- p_stk_data->OSUsed = 0u;
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- prio = OSTCBCur->OSTCBPrio;
- }
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- if ((ptcb->OSTCBOpt & OS_TASK_OPT_STK_CHK) == 0u) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_OPT);
- }
- nfree = 0u;
- size = ptcb->OSTCBStkSize;
- pchk = ptcb->OSTCBStkBottom;
- OS_EXIT_CRITICAL();
- #if OS_STK_GROWTH == 1u
- while (*pchk++ == (OS_STK)0) {
- nfree++;
- }
- #else
- while (*pchk-- == (OS_STK)0) {
- nfree++;
- }
- #endif
- p_stk_data->OSFree = nfree;
- p_stk_data->OSUsed = size - nfree;
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_TASK_SUSPEND_EN > 0u
- INT8U OSTaskSuspend (INT8U prio)
- {
- BOOLEAN self;
- OS_TCB *ptcb;
- INT8U y;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio == OS_TASK_IDLE_PRIO) {
- return (OS_ERR_TASK_SUSPEND_IDLE);
- }
- if (prio >= OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- return (OS_ERR_PRIO_INVALID);
- }
- }
- #endif
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- prio = OSTCBCur->OSTCBPrio;
- self = OS_TRUE;
- } else if (prio == OSTCBCur->OSTCBPrio) {
- self = OS_TRUE;
- } else {
- self = OS_FALSE;
- }
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_SUSPEND_PRIO);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
- y = ptcb->OSTCBY;
- OSRdyTbl[y] &= (OS_PRIO)~ptcb->OSTCBBitX;
- if (OSRdyTbl[y] == 0u) {
- OSRdyGrp &= (OS_PRIO)~ptcb->OSTCBBitY;
- }
- ptcb->OSTCBStat |= OS_STAT_SUSPEND;
- OS_EXIT_CRITICAL();
- if (self == OS_TRUE) {
- OS_Sched();
- }
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_TASK_QUERY_EN > 0u
- INT8U OSTaskQuery (INT8U prio,
- OS_TCB *p_task_data)
- {
- OS_TCB *ptcb;
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio > OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- return (OS_ERR_PRIO_INVALID);
- }
- }
- if (p_task_data == (OS_TCB *)0) {
- return (OS_ERR_PDATA_NULL);
- }
- #endif
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- prio = OSTCBCur->OSTCBPrio;
- }
- ptcb = OSTCBPrioTbl[prio];
- if (ptcb == (OS_TCB *)0) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_PRIO);
- }
- if (ptcb == OS_TCB_RESERVED) {
- OS_EXIT_CRITICAL();
- return (OS_ERR_TASK_NOT_EXIST);
- }
-
- OS_MemCopy((INT8U *)p_task_data, (INT8U *)ptcb, sizeof(OS_TCB));
- OS_EXIT_CRITICAL();
- return (OS_ERR_NONE);
- }
- #endif
- #if OS_TASK_REG_TBL_SIZE > 0u
- INT32U OSTaskRegGet (INT8U prio,
- INT8U id,
- INT8U *perr)
- {
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- INT32U value;
- OS_TCB *ptcb;
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return (0u);
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio >= OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- *perr = OS_ERR_PRIO_INVALID;
- return (0u);
- }
- }
- if (id >= OS_TASK_REG_TBL_SIZE) {
- *perr = OS_ERR_ID_INVALID;
- return (0u);
- }
- #endif
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- ptcb = OSTCBCur;
- } else {
- ptcb = OSTCBPrioTbl[prio];
- }
- value = ptcb->OSTCBRegTbl[id];
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- return (value);
- }
- #endif
- #if OS_TASK_REG_TBL_SIZE > 0u
- INT8U OSTaskRegGetID (INT8U *perr)
- {
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- INT8U id;
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return ((INT8U)OS_TASK_REG_TBL_SIZE);
- }
- #endif
- OS_ENTER_CRITICAL();
- if (OSTaskRegNextAvailID >= OS_TASK_REG_TBL_SIZE) {
- *perr = OS_ERR_NO_MORE_ID_AVAIL;
- OS_EXIT_CRITICAL();
- return ((INT8U)OS_TASK_REG_TBL_SIZE);
- }
-
- id = OSTaskRegNextAvailID;
- OSTaskRegNextAvailID++;
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- return (id);
- }
- #endif
- #if OS_TASK_REG_TBL_SIZE > 0u
- void OSTaskRegSet (INT8U prio,
- INT8U id,
- INT32U value,
- INT8U *perr)
- {
- #if OS_CRITICAL_METHOD == 3u
- OS_CPU_SR cpu_sr = 0u;
- #endif
- OS_TCB *ptcb;
- #ifdef OS_SAFETY_CRITICAL
- if (perr == (INT8U *)0) {
- OS_SAFETY_CRITICAL_EXCEPTION();
- return;
- }
- #endif
- #if OS_ARG_CHK_EN > 0u
- if (prio >= OS_LOWEST_PRIO) {
- if (prio != OS_PRIO_SELF) {
- *perr = OS_ERR_PRIO_INVALID;
- return;
- }
- }
- if (id >= OS_TASK_REG_TBL_SIZE) {
- *perr = OS_ERR_ID_INVALID;
- return;
- }
- #endif
- OS_ENTER_CRITICAL();
- if (prio == OS_PRIO_SELF) {
- ptcb = OSTCBCur;
- } else {
- ptcb = OSTCBPrioTbl[prio];
- }
- ptcb->OSTCBRegTbl[id] = value;
- OS_EXIT_CRITICAL();
- *perr = OS_ERR_NONE;
- }
- #endif
- void OS_TaskReturn (void)
- {
- OSTaskReturnHook(OSTCBCur);
- #if OS_TASK_DEL_EN > 0u
- (void)OSTaskDel(OS_PRIO_SELF);
- #else
- for (;;) {
- OSTimeDly(OS_TICKS_PER_SEC);
- }
- #endif
- }
- #if (OS_TASK_STAT_STK_CHK_EN > 0u) && (OS_TASK_CREATE_EXT_EN > 0u)
- void OS_TaskStkClr (OS_STK *pbos,
- INT32U size,
- INT16U opt)
- {
- if ((opt & OS_TASK_OPT_STK_CHK) != 0x0000u) {
- if ((opt & OS_TASK_OPT_STK_CLR) != 0x0000u) {
- #if OS_STK_GROWTH == 1u
- while (size > 0u) {
- size--;
- *pbos++ = (OS_STK)0;
- }
- #else
- while (size > 0u) {
- size--;
- *pbos-- = (OS_STK)0;
- }
- #endif
- }
- }
- }
- #endif
|