![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
CoOS Demonstrator adapted to mbed Hardware.
Diff: timer.c
- Revision:
- 0:57690853989a
diff -r 000000000000 -r 57690853989a timer.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/timer.c Fri Dec 03 19:45:30 2010 +0000 @@ -0,0 +1,447 @@ +/** + ******************************************************************************* + * @file timer.c + * @version V1.1.3 + * @date 2010.04.26 + * @brief timer management implementation code of CooCox CoOS kernel. + ******************************************************************************* + * @copy + * + * INTERNAL FILE,DON'T PUBLIC. + * + * <h2><center>© COPYRIGHT 2009 CooCox </center></h2> + ******************************************************************************* + */ + + + +/*---------------------------- Include ---------------------------------------*/ +#include <coocox.h> + +/*---------------------------- Variable Define -------------------------------*/ +#if CFG_TMR_EN > 0 + +TmrCtrl TmrTbl[CFG_MAX_TMR]= {{0}};/*!< Table which save timer control block.*/ +P_TmrCtrl TmrList = 0; /*!< The header of the TmrCtrl list. */ +U32 TmrIDVessel = 0; /*!< Timer ID container. */ + + +/** + ******************************************************************************* + * @brief Insert a timer into the timer list + * @param[in] tmrID Specify timer ID which insertted. + * @param[out] None + * @retval E_INVALID_ID Timer ID passed was invalid,insert fail. + * @retval E_OK Insert successful. + * + * @par Description + * @details This function is called to insert a timer into the timer list. + ******************************************************************************* + */ +static void InsertTmrList(OS_TCID tmrID) +{ + P_TmrCtrl pTmr; + S32 deltaTicks; + U32 tmrCnt; + tmrCnt = TmrTbl[tmrID].tmrCnt; /* Get timer time */ + + if(tmrCnt == 0) /* Is timer time==0? */ + { + return; /* Do nothing,return */ + } + + OsSchedLock(); /* Lock schedule */ + if(TmrList == 0) /* Is no item in timer list? */ + { + TmrList = &TmrTbl[tmrID]; /* Yes,set this as first item */ + } + else /* No,find correct place ,and insert inserted timer */ + { + pTmr = TmrList; + deltaTicks = tmrCnt; /* Get timer tick */ + + /* find correct place */ + while(pTmr != 0) + { + deltaTicks -= pTmr->tmrCnt; /* Get ticks with previous item */ + if(deltaTicks < 0) /* Is delta ticks<0? */ + { + /* Yes,get correct place */ + if(pTmr->tmrPrev!= 0)/* Is head item of timer list? */ + { + /* No,insert into */ + pTmr->tmrPrev->tmrNext = &TmrTbl[tmrID]; + TmrTbl[tmrID].tmrPrev = pTmr->tmrPrev; + TmrTbl[tmrID].tmrNext = pTmr; + pTmr->tmrPrev = &TmrTbl[tmrID]; + } + else /* Yes,set task as first item */ + { + TmrTbl[tmrID].tmrNext = TmrList; + TmrList->tmrPrev = &TmrTbl[tmrID]; + TmrList = &TmrTbl[tmrID]; + } + TmrTbl[tmrID].tmrCnt = TmrTbl[tmrID].tmrNext->tmrCnt+deltaTicks; + TmrTbl[tmrID].tmrNext->tmrCnt -= TmrTbl[tmrID].tmrCnt; + break; + } + /* Is last item in list? */ + else if((deltaTicks >= 0) && (pTmr->tmrNext == 0)) + { + /* Yes,insert into */ + TmrTbl[tmrID].tmrPrev = pTmr; + pTmr->tmrNext = &TmrTbl[tmrID]; + TmrTbl[tmrID].tmrCnt = deltaTicks; + break; + } + pTmr = pTmr->tmrNext; /* Get the next item in timer list */ + } + } + OsSchedUnlock(); /* Unlock schedule */ +} + + +/** + ******************************************************************************* + * @brief Remove a timer from the timer list + * @param[in] tmrID Specify ID for a timer which removed form timer list. + * @param[out] None + * @retval None + * + * @par Description + * @details This function is called to remove a timer from the timer list. + ******************************************************************************* + */ +static void RemoveTmrList(OS_TCID tmrID) +{ + P_TmrCtrl pTmr; + + pTmr = &TmrTbl[tmrID]; + + OsSchedLock(); /* Lock schedule */ + + /* Is there only one item in timer list? */ + if((pTmr->tmrPrev == 0) && (pTmr->tmrNext == 0)) + { + TmrList = 0; /* Yes,set timer list as 0 */ + } + else if(pTmr->tmrPrev == 0) /* Is the first item in timer list? */ + { /* Yes,remove timer from list,and reset timer list */ + TmrList = pTmr->tmrNext; + TmrList->tmrPrev = 0; + pTmr->tmrNext->tmrCnt += pTmr->tmrCnt; + pTmr->tmrNext = 0; + } + else if(pTmr->tmrNext == 0) /* Is the last item in timer list? */ + { + /* Yes,remove timer form list */ + pTmr->tmrPrev->tmrNext = 0; + pTmr->tmrPrev = 0; + } + else /* No, remove timer from list */ + { + pTmr->tmrPrev->tmrNext = pTmr->tmrNext; + pTmr->tmrNext->tmrPrev = pTmr->tmrPrev; + pTmr->tmrNext->tmrCnt += pTmr->tmrCnt; + pTmr->tmrNext = 0; + pTmr->tmrPrev = 0; + } + OsSchedUnlock(); /* Unlock schedule */ +} + + +/** + ******************************************************************************* + * @brief Create a timer + * @param[in] tmrType Specify timer's type. + * @param[in] tmrCnt Specify timer initial counter value. + * @param[in] tmrReload Specify timer reload value. + * @param[in] func Specify timer callback function entry. + * @param[out] None + * @retval E_CREATE_FAIL Create timer fail. + * @retval others Create timer successful. + * + * @par Description + * @details This function is called to create a timer. + ******************************************************************************* + */ +OS_TCID CoCreateTmr(U8 tmrType, U32 tmrCnt, U32 tmrReload, vFUNCPtr func) +{ + U8 i; +#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */ + if((tmrType != TMR_TYPE_ONE_SHOT) && (tmrType != TMR_TYPE_PERIODIC)) + { + return E_CREATE_FAIL; + } + if(func == 0) + { + return E_CREATE_FAIL; + } +#endif + OsSchedLock(); /* Lock schedule */ + for(i = 0; i < CFG_MAX_TMR; i++) + { + if((TmrIDVessel & (1 << i)) == 0) /* Is free timer ID? */ + { + TmrIDVessel |= (1<<i); /* Yes,assign ID to this timer */ + OsSchedUnlock(); /* Unlock schedule */ + TmrTbl[i].tmrID = i; /* Initialize timer as user set */ + TmrTbl[i].tmrType = tmrType; + TmrTbl[i].tmrState = TMR_STATE_STOPPED; + TmrTbl[i].tmrCnt = tmrCnt; + TmrTbl[i].tmrReload = tmrReload; + TmrTbl[i].tmrCallBack = func; + TmrTbl[i].tmrPrev = 0; + TmrTbl[i].tmrNext = 0; + return i; /* Return timer ID */ + } + } + OsSchedUnlock(); /* Unlock schedule */ + return E_CREATE_FAIL; /* Error return */ +} + + +/** + ******************************************************************************* + * @brief Start counter + * @param[in] tmrID Specify a timer which startted. + * @param[out] None + * @retval E_INVALID_ID The timer id passed was invalid,can't start timer + * @retval E_OK Insert a timer to timer list and start it successful. + * + * @par Description + * @details This function is called to make a timer start countering. + ******************************************************************************* + */ +StatusType CoStartTmr(OS_TCID tmrID) +{ +#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */ + if(tmrID >= CFG_MAX_TMR) + { + return E_INVALID_ID; + } + if( (TmrIDVessel & (1<<tmrID)) == 0) + { + return E_INVALID_ID; + } +#endif + + if(TmrTbl[tmrID].tmrState == TMR_STATE_RUNNING) /* Is timer running? */ + { + return E_OK; /* Yes,do nothing,return OK */ + } + + /* No,set timer status as TMR_STATE_RUNNING */ + TmrTbl[tmrID].tmrState = TMR_STATE_RUNNING; + InsertTmrList(tmrID); /* Insert this timer into timer list */ + return E_OK; /* Return OK */ +} + + + +/** + ******************************************************************************* + * @brief Stop countering for a spcify timer + * @param[in] tmrID Specify a timer which stopped. + * @param[out] None + * @retval E_INVALID_ID The timer id passed was invalid, stop failure. + * @retval E_OK Stop a timer countering successful. + * + * @par Description + * @details This function is called to stop a timer from counting. + ******************************************************************************* + */ +StatusType CoStopTmr(OS_TCID tmrID) +{ +#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */ + if(tmrID >= CFG_MAX_TMR) + { + return E_INVALID_ID; + } + if((TmrIDVessel & (1<<tmrID)) == 0) + { + return E_INVALID_ID; + } +#endif + + + if(TmrTbl[tmrID].tmrState == TMR_STATE_STOPPED)/* Does timer stop running?*/ + { + return E_OK; /* Yes,do nothing,return OK */ + } + RemoveTmrList(tmrID); /* No,remove this timer from timer list */ + + /* Set timer status as TMR_STATE_STOPPED */ + TmrTbl[tmrID].tmrState = TMR_STATE_STOPPED; + return E_OK; /* Return OK */ +} + + +/** + ******************************************************************************* + * @brief Delete a timer + * @param[in] tmrID Specify a timer which deleted. + * @param[out] None + * @retval E_INVALID_ID The timer id passed was invalid,deleted failure. + * @retval E_OK Delete a timer successful. + * + * @par Description + * @details This function is called to delete a timer which created before. + ******************************************************************************* + */ +StatusType CoDelTmr(OS_TCID tmrID) +{ +#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */ + if(tmrID >= CFG_MAX_TMR) + { + return E_INVALID_ID; + } + if( (TmrIDVessel & (1<<tmrID)) == 0) + { + return E_INVALID_ID; + } +#endif + + if(TmrTbl[tmrID].tmrState == TMR_STATE_RUNNING) /* Is timer running? */ + { + RemoveTmrList(tmrID); /* Yes,remove this timer from timer list*/ + } + TmrIDVessel &=~(1<<tmrID); /* Release resource that this timer hold*/ + return E_OK; /* Return OK */ +} + + +/** + ******************************************************************************* + * @brief Get current counter of specify timer + * @param[in] tmrID Specify timer by ID. + * @param[out] E_INVALID_ID Invalid ID was passed and get counter failure. + * @param[out] E_OK Get current counter successful. + * @retval Current counter of a timer which specify by id. + * + * @par Description + * @details This function is called to obtain current counter of specify timer. + ******************************************************************************* + */ +U32 CoGetCurTmrCnt(OS_TCID tmrID,StatusType* perr) +{ +#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */ + if(tmrID >= CFG_MAX_TMR) + { + *perr = E_INVALID_ID; + return 0; + } + if((TmrIDVessel & (1<<tmrID)) == 0) + { + *perr = E_INVALID_ID; + return 0; + } +#endif + *perr = E_OK; + return TmrTbl[tmrID].tmrCnt; /* Return timer counter */ +} + + +/** + ******************************************************************************* + * @brief Setting for a specify timer + * @param[in] tmrID Specify timer by ID. + * @param[in] tmrCnt Specify timer counter which need to be set. + * @param[in] tmrReload Specify timer reload value which need to be set. + * @param[out] None + * @retval E_INVALID_ID The ID passed was invalid,set fail. + * @retval E_OK Set timer counter successful. + * + * @par Description + * @details This function is called to set timer counter and reload value. + ******************************************************************************* + */ +StatusType CoSetTmrCnt(OS_TCID tmrID,U32 tmrCnt,U32 tmrReload) +{ +#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */ + if(tmrID >= CFG_MAX_TMR) + { + return E_INVALID_ID; + } + if( (TmrIDVessel & (1<<tmrID)) == 0) + { + return E_INVALID_ID; + } +#endif + TmrTbl[tmrID].tmrCnt = tmrCnt; /* Reset timer counter and reload value */ + TmrTbl[tmrID].tmrReload = tmrReload; + + if(TmrTbl[tmrID].tmrState == TMR_STATE_RUNNING) /* Is timer running? */ + { + RemoveTmrList(tmrID); /* Yes,reorder timer in timer list */ + InsertTmrList(tmrID); + } + return E_OK; /* Return OK */ +} + + +/** + ******************************************************************************* + * @brief Timer counter dispose + * @param[in] None + * @param[out] None + * @retval None + * + * @par Description + * @details This function is called to dispose timer counter. + ******************************************************************************* + */ +void TmrDispose(void) +{ + P_TmrCtrl pTmr; + + pTmr = TmrList; /* Get first item of timer list */ + while((pTmr != 0) && (pTmr->tmrCnt == 0) ) + { + if(pTmr->tmrType == TMR_TYPE_ONE_SHOT) /* Is a One-shot timer? */ + { + /* Yes,remove this timer from timer list */ + RemoveTmrList(pTmr->tmrID); + + /* Set timer status as TMR_STATE_STOPPED */ + pTmr->tmrState = TMR_STATE_STOPPED; + (pTmr->tmrCallBack)(); /* Call timer callback function */ + } + else if(pTmr->tmrType == TMR_TYPE_PERIODIC) /* Is a periodic timer? */ + { + /* Yes,remove this timer from timer list */ + RemoveTmrList(pTmr->tmrID); + pTmr->tmrCnt = pTmr->tmrReload; /* Reset timer tick */ + InsertTmrList(pTmr->tmrID); /* Insert timer into timer list */ + (pTmr->tmrCallBack)(); /* Call timer callback function */ + } + pTmr = TmrList; /* Get first item of timer list */ + } +} + + +/** + ******************************************************************************* + * @brief Timer counter dispose in ISR + * @param[in] None + * @param[out] None + * @retval None + * + * @par Description + * @details This function is called to dispose timer counter. + ******************************************************************************* + */ +void isr_TmrDispose(void) +{ + if(OSSchedLock > 1) /* Is schedule lock? */ + { + IsrReq = TRUE; + TimerReq = TRUE; /* Yes,set timer request true */ + } + else + { + TmrDispose(); /* No,call handler */ + } +} + +#endif