CoOS Demonstrator adapted to mbed Hardware.

Dependencies:   mbed

time.c

Committer:
ericebert
Date:
2010-12-03
Revision:
0:57690853989a

File content as of revision 0:57690853989a:

/**
 *******************************************************************************
 * @file       time.c
 * @version    V1.1.3    
 * @date       2010.04.26
 * @brief      time management implementation code of CooCox CoOS kernel.    
 *******************************************************************************
 * @copy
 *
 * INTERNAL FILE,DON'T PUBLIC.
 * 
 * <h2><center>&copy; COPYRIGHT 2009 CooCox </center></h2>
 *******************************************************************************
 */  



/*---------------------------- Include ---------------------------------------*/
#include <coocox.h>

#if CFG_TASK_WAITTING_EN > 0

/*---------------------------- Variable Define -------------------------------*/
P_OSTCB DlyList   = 0;               /*!< Header pointer to the DELAY list.*/


/**
 *******************************************************************************
 * @brief      Insert into DELAY list             
 *   
 * @param[in]  ptcb    Task that want to insert into DELAY list. 
 * @param[in]  ticks   Delay system ticks.     
 * @param[out] None   
 * @retval     None.          
 *
 * @par Description
 * @details    This function is called to insert task into DELAY list.
 *******************************************************************************
 */
void InsertDelayList(P_OSTCB ptcb,U32 ticks)
{
    S32 deltaTicks;
    P_OSTCB dlyNext;
    
    if(ticks == 0)                      /* Is delay tick == 0?                */
        return;                         /* Yes,do nothing,return              */
    if(DlyList == 0)                 /* Is no item in DELAY list?          */
    {
        ptcb->delayTick = ticks;        /* Yes,set this as first item         */
        DlyList         = ptcb;
    }
    else
    {    
        /* No,find correct place ,and insert the task */
        dlyNext    = DlyList; 
        deltaTicks = ticks;             /* Get task delay ticks               */
        
        /* Find correct place */
        while(dlyNext != 0)
        {        
            /* Get delta ticks with previous item */ 
            deltaTicks -= dlyNext->delayTick;  
            if(deltaTicks < 0)          /* Is delta ticks<0?                  */
            {      
                /* Yes,get correct place */
                if(dlyNext->TCBprev != 0)   /* Is head item of DELAY list? */
                {                               
                    dlyNext->TCBprev->TCBnext = ptcb;   /* No,insert into     */ 
                    ptcb->TCBprev             = dlyNext->TCBprev;
                    ptcb->TCBnext             = dlyNext;
                    dlyNext->TCBprev          = ptcb;
                }
                else                    /* Yes,set task as first item         */
                {                               
                    ptcb->TCBnext    = DlyList;
                    DlyList->TCBprev = ptcb;
                    DlyList          = ptcb;
                }
                ptcb->delayTick           = ptcb->TCBnext->delayTick+deltaTicks;
                ptcb->TCBnext->delayTick -= ptcb->delayTick; 
                break;
            }
            /* Is last item in DELAY list? */
            else if((deltaTicks >= 0) && (dlyNext->TCBnext == 0) )
            {                                   
                ptcb->TCBprev    = dlyNext; /* Yes,insert into                */
                dlyNext->TCBnext = ptcb;    
                ptcb->delayTick  = deltaTicks;
                break;
            }
            dlyNext = dlyNext->TCBnext; /* Get the next item in DELAY list    */
        }
    }

    ptcb->state  = TASK_WAITING;        /* Set task status as TASK_WAITING    */
    TaskSchedReq = TRUE;
}


/**
 *******************************************************************************
 * @brief      Remove from the DELAY list              
 * @param[in]  ptcb   Task that want to remove from the DELAY list. 
 * @param[out] None   
 * @retval     None          
 *
 * @par Description
 * @details    This function is called to remove task from the DELAY list.
 *******************************************************************************
 */
void RemoveDelayList(P_OSTCB ptcb)
{
    
    /* Is there only one item in the DELAY list?   */
    if((ptcb->TCBprev == 0) && ( ptcb->TCBnext == 0))
    {
        DlyList = 0;                    /* Yes,set DELAY list as 0         */
    }
    else if(ptcb->TCBprev == 0)      /* Is the first item in DELAY list?   */
    {   
        /* Yes,remove task from the DELAY list,and reset the list             */
        DlyList                      = ptcb->TCBnext;
        ptcb->TCBnext->delayTick += ptcb->delayTick;
        ptcb->TCBnext->TCBprev    = 0;    
        ptcb->TCBnext             = 0;
        
    }
    else if(ptcb->TCBnext == 0)      /* Is the last item in DELAY list?    */
    {                                    
        ptcb->TCBprev->TCBnext = 0;  /* Yes,remove task form DELAY list    */
        ptcb->TCBprev          = 0;    
    }
    else                                /* No, remove task from DELAY list    */
    {                                    
        ptcb->TCBprev->TCBnext    = ptcb->TCBnext;    
        ptcb->TCBnext->TCBprev    = ptcb->TCBprev;    
        ptcb->TCBnext->delayTick += ptcb->delayTick;
        ptcb->TCBnext               = 0;
        ptcb->TCBprev             = 0;
    }
    ptcb->delayTick = INVALID_VALUE;  /* Set task delay tick value as invalid */        
}

/**
 *******************************************************************************
 * @brief      Get current ticks             
 * @param[in]  None     
 * @param[out] None   
 * @retval     Return current system tick counter.          
 *
 * @par Description
 * @details    This function is called to obtain current system tick counter.
 *******************************************************************************
 */
U64 CoGetOSTime(void)
{
    return OSTickCnt;                   /* Get system time(tick)              */
}


/**
 *******************************************************************************
 * @brief      Delay current task for specify ticks number      
 * @param[in]  ticks    Specify system tick number which will delay.             
 * @param[out] None  
 * @retval     E_CALL   Error call in ISR.
 * @retval     E_OK     The current task was insert to DELAY list successful,it
 *                      will delay specify time.         
 * @par Description
 * @details    This function delay specify ticks for current task.
 *
 * @note       This function be called in ISR,do nothing and return immediately.
 *******************************************************************************    
 */
StatusType CoTickDelay(U32 ticks)
{
    if(OSIntNesting >0)                    /* Is call in ISR?                    */
    {
        return E_CALL;                  /* Yes,error return                   */
    }
    
    if(ticks == INVALID_VALUE)          /* Is tick==INVALID_VALUE?            */
    {
        return E_INVALID_PARAMETER;     /* Yes,error return                   */
    }    
    if(ticks == 0)                      /* Is tick==0?                        */
    {
        return E_OK;                    /* Yes,do nothing ,return OK          */
    }
    if(OSSchedLock != 0)                /* Is OS lock?                        */
    {
        return E_OS_IN_LOCK;            /* Yes,error return                   */
    }    
    OsSchedLock();                      /* Lock schedule                      */
    InsertDelayList(TCBRunning,ticks);    /* Insert task in DELAY list          */
    OsSchedUnlock();                /* Unlock schedule,and call task schedule */
    return E_OK;                        /* Return OK                          */
}


/**
 *******************************************************************************
 * @brief      Reset task delay ticks     
 * @param[in]  ptcb    Task that want to insert into DELAY list.
 * @param[in]  ticks   Specify system tick number which will delay .             
 * @param[out] None  
 * @retval     E_CALL               Error call in ISR.
 * @retval     E_INVALID_ID         Invalid task id.
 * @retval     E_NOT_IN_DELAY_LIST  Task not in delay list.
 * @retval     E_OK                 The current task was inserted to DELAY list 
 *                                  successful,it will delay for specify time.         
 * @par Description
 * @details    This function delay specify ticks for current task.
 *******************************************************************************     
 */
StatusType CoResetTaskDelayTick(OS_TID taskID,U32 ticks)
{
    P_OSTCB ptcb;
    

#if CFG_PAR_CHECKOUT_EN >0              /* Check validity of parameter        */
    if(taskID >= CFG_MAX_USER_TASKS + SYS_TASK_NUM)
    {
        return E_INVALID_ID;
    }
#endif

    ptcb = &TCBTbl[taskID];
#if CFG_PAR_CHECKOUT_EN >0 
    if(ptcb->stkPtr == 0)
    {
        return E_INVALID_ID;
    }
#endif

    if(ptcb->delayTick == INVALID_VALUE)  /* Is tick==INVALID_VALUE?          */
    {
        return E_NOT_IN_DELAY_LIST;       /* Yes,error return                 */
    }
    OsSchedLock();                        /* Lock schedule                    */
    RemoveDelayList(ptcb);                /* Remove task from the DELAY list  */
    
    if(ticks == 0)                        /* Is delay tick==0?                */
    {
        InsertToTCBRdyList(ptcb);         /* Insert task into the DELAY list  */
    }
    else
    {                                    
        InsertDelayList(ptcb,ticks);      /* No,insert task into DELAY list   */
    }
    OsSchedUnlock();                /* Unlock schedule,and call task schedule */
    return E_OK;                          /* Return OK                        */
}


/**
 *******************************************************************************
 * @brief      Delay current task for detail time       
 * @param[in]  hour      Specify the number of hours.
 * @param[in]  minute    Specify the number of minutes.
 * @param[in]  sec       Specify the number of seconds.
 * @param[in]  millsec   Specify the number of millseconds.     
 * @param[out] None  
 * @retval     E_CALL               Error call in ISR.
 * @retval     E_INVALID_PARAMETER  Parameter passed was invalid,delay fail.
 * @retval     E_OK                 The current task was inserted to DELAY list
 *                                  successful,it will delay for specify time.                             
 * @par Description
 * @details    This function delay specify time for current task.     
 *
 * @note       If this function called in ISR,do nothing and return immediately.
 *******************************************************************************
 */
#if CFG_TIME_DELAY_EN >0
StatusType  CoTimeDelay(U8 hour,U8 minute,U8 sec,U16 millsec)
{
    U32    ticks;
#if CFG_PAR_CHECKOUT_EN >0              /* Check validity of parameter        */
    if(OSIntNesting > 0)
    {
        return E_CALL;
    }
    if((minute > 59)||(sec > 59)||(millsec > 999))
        return E_INVALID_PARAMETER;
#endif
    if(OSSchedLock != 0)                /* Is OS lock?                        */
    {
        return E_OS_IN_LOCK;            /* Yes,error return                   */
    }    
    
    /* Get tick counter from time */
    ticks = ((hour*3600) + (minute*60) + (sec)) * (CFG_SYSTICK_FREQ)\
            + (millsec*CFG_SYSTICK_FREQ + 500)/1000;
    
    CoTickDelay(ticks);                 /* Call tick delay                    */
    return E_OK;                        /* Return OK                          */
}
#endif




/**
 *******************************************************************************
 * @brief      Dispose time delay     
 * @param[in]  None     
 * @param[out] None 
 * @retval     None 
 *
 * @par Description
 * @details    This function is called to dispose time delay of all task.  
 *******************************************************************************
 */
void TimeDispose(void)
{  
    P_OSTCB    dlyList;
    
    dlyList = DlyList;                  /* Get first item of DELAY list       */
    while((dlyList != 0) && (dlyList->delayTick == 0) )
    {    
    
#if CFG_EVENT_EN > 0
        if(dlyList->eventID != INVALID_ID) /* Is task in event waiting list?  */
        {                                   
            RemoveEventWaittingList(dlyList); /* Yes,remove task from list    */    
        }
#endif

#if CFG_FLAG_EN  > 0
        if(dlyList->pnode != 0)          /* Is task in flag waiting list?  */
        {
            RemoveLinkNode((P_FLAG_NODE)dlyList->pnode); /* Yes,remove task from list      */    
        }
#endif
        dlyList->delayTick = INVALID_VALUE; /* Set delay tick value as invalid*/
        DlyList = dlyList->TCBnext; /* Get next item as the head of DELAY list*/
        dlyList->TCBnext   = 0;           

        InsertToTCBRdyList(dlyList);        /* Insert task into READY list    */
        
        dlyList = DlyList;                /* Get the first item of DELAY list */
        if(dlyList != 0)                 /* Is DELAY list as 0?         */
        {
            dlyList->TCBprev = 0;        /* No,initialize the first item   */
        }
    }
}


/**
 *******************************************************************************
 * @brief      Dispose time delay in ISR      
 * @param[in]  None     
 * @param[out] None 
 * @retval     None 
 *
 * @par Description
 * @details    This function is called in systick interrupt to dispose time delay   
 *             of all task.
 *******************************************************************************
 */
void isr_TimeDispose(void)
{
    if(OSSchedLock > 1)                 /* Is schedule lock?                  */
    {
        IsrReq = TRUE;
        TimeReq = TRUE;                 /* Yes,set time request true          */
    }
    else
    {
        TimeDispose();                  /* No,call handler                    */
    }
}


#endif