/*********************************************************************************************************
**				                               Small RTOS 51
**                                   The Real-Time Kernel For Keil c51
**
**                                  (c) Copyright 2002-2003, chenmingji
**                                           All Rights Reserved
**
**                                                  V1.12.0
**
**
**--------------文件信息--------------------------------------------------------------------------------
**文   件   名: OS_CPU_C.C
**創   建   人: 陳明計
**最后修改日期:  2002年12月2日
**描        述: Small RTOS 51與CPU(既8051系列)相關的C語言代碼
**
**--------------歷史版本信息----------------------------------------------------------------------------
** 創建人: 陳明計
** 版  本: V0.50
** 日　期: 2002年2月22日
** 描　述: 原始版本
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V0.52
** 日　期: 2002年5月9日
** 描　述: 更正for keil c51 移植的堆棧在某種情況下初始值錯誤
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V1.00
** 日　期: 2002年6月20日
** 描　述: 增加配置
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V1.10
** 日　期: 2002年9月1日
** 描　述: 根據新版本要求更改變量定義
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V1.10.4
** 日　期: 2002年10月5日
** 描　述: 統一了一下格式和宏定義風格
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V1.10.5
** 日　期: 2002年10月23日
** 描　述: 修改OSTickISR()使得在允許的情況下，每次進入中斷都調用UserTickTimer()
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V1.11.0
** 日　期: 2002年12月2日
** 描　述: 根據新版本要求增加函數OSIdle和修改函數OSStart；增加注釋
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版  本: V1.12.0
** 日　期: 2002年12月30日
** 描　述: 根據新版本要求修改初始化代碼
**
**--------------當前版本修訂------------------------------------------------------------------------------
** 修改人:
** 日　期:
** 描　述:
**
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/

#define  IN_OS_CPU_C
#include "CONFIG.h"

extern idata uint8 STACK[1];                    /* 堆棧起始位置,在OS_CPU_A定義 */
uint8 idata * data OSTsakStackBotton[OS_MAX_TASKS + 2];/* 任務堆棧底部位置            */

#if EN_SP2 > 0
uint8 idata  Sp2[Sp2Space];                     /* 高級中斷堆棧           */
#endif

#if OS_MAX_TASKS < 9            
uint8 data OSFastSwap = 0xff;                   /* 任務是否可以快速切換 */
#else
uint16 data OSFastSwap = 0xffff;
#endif


/*********************************************************************************************************
** 函數名稱: C_OSCtxSw
** 功能描述: 用C寫的堆棧處理函數,已經用匯編改寫,此函數在移植并非必須
** 輸　入: 無
** 輸　出 : 無
** 全局變量: OSTaskID,OSTsakStackBotton,SP
** 調用模塊: LoadCtx
** 
** 作　者: 陳明計
** 日　期: 2002年2月22日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
/*        void C_OSCtxSw(void) 

{
    uint8 idata *cp1,idata *cp2;
    uint8 i,temp;
    
    cp1 = (uint8 idata *)SP +1;
    temp = (uint8 )OSTsakStackBotton[OSNextTaskID+1];
    cp2 = OSTsakStackBotton[OSTaskID+1];
    if( OSNextTaskID > OSTaskID)
    {
        while(cp2 != (uint8 idata *)temp)
        {
            *cp1++ = *cp2++;
        }
        OSNextTaskID++;
        OSTaskID++;
        temp = OSTsakStackBotton[OSTaskID] - (uint8 idata *)SP-1;
        SP = (uint8 )cp1 - 1;        
        for(i = OSTaskID;i < OSNextTaskID; i++)
        {
            OSTsakStackBotton[i] -= temp;
        }
        OSNextTaskID--;
        OSTaskID = OSNextTaskID;
        LoadCtx();    
    }

    if( OSNextTaskID < OSTaskID)
    {
        cp2--;
        cp1--;
        while(cp2 != (uint8 idata *)temp)
        {
            *cp2-- = *cp1--;
        }
        OSTaskID++;
        temp = OSTsakStackBotton[OSTaskID] - (uint8 idata *)SP-1;
        SP = (uint8 )OSTsakStackBotton[OSNextTaskID+1];
        for(i = OSNextTaskID+1;i < OSTaskID; i++)
        {
            OSTsakStackBotton[i] += temp;
        }
        OSTaskID = OSNextTaskID;        
        SP--;
    }
    LoadCtx();
    LoadCtx();
}
*/

/*********************************************************************************************************
** 函數名稱: OSIdle
** 功能描述: 優先級最低的任務
** 輸　入: 無
** 輸　出 : 無
** 全局變量: 無
** 調用模塊: 無
** 
** 作　者: 陳明計
** 日　期: 2002年12月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/

        void OSIdle(void)
{
    while(1)
    {
        PCON = PCON | 0x01;                     /* CPU進入休眠狀態 */
    }
}

/*********************************************************************************************************
** 函數名稱: OSStart
** 功能描述: Small RTOS 51初始化函數,調用此函數后多任務開始運行,首先執ID為0的任務
** 輸　入: 無
** 輸　出 : 無
** 全局變量: OSTsakStackBotton,SP
** 調用模塊: 無
** 
** 作　者: 陳明計
** 日　期: 2002年2月22日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日　期: 2002年12月2日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日　期: 2002年12月30日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        void OSStart(void)
        
{
    uint8 idata *cp;
    uint8 i;
    
    cp = STACK;
    
    OSTsakStackBotton[0] = STACK;
    OSTsakStackBotton[OS_MAX_TASKS + 1] = (uint8 idata *)(IDATA_RAM_SIZE % 256);
    
    /* 初始化優先級最高的任務堆棧，使返回地址為任務開始地址 */
    *cp++ = ((uint16)(TaskFuction[0])) % 256;
    SP = (uint8) cp;
    *cp = ((uint16)(TaskFuction[0])) / 256;

    /* 初始化優先級最低的任務堆棧 */
    cp = (uint8 idata *)(IDATA_RAM_SIZE - 1) ;
    *cp-- = 0;
    *cp-- =  ((uint16)(OSIdle)) / 256;
    OSTsakStackBotton[OS_MAX_TASKS] = cp;
    *cp-- =  ((uint16)(OSIdle)) % 256;
    
    /* 初始化其它優先級的任務堆棧 */
    for(i = OS_MAX_TASKS - 1; i > 0; i--)
    {
        *cp-- = 0;
        *cp-- =  ((uint16)(TaskFuction[i])) / 256;
        OSTsakStackBotton[i] = cp;
        *cp-- =  ((uint16)(TaskFuction[i])) % 256;
    }
    /* 允許中斷 */
    Os_Enter_Sum = 1;
    OS_EXIT_CRITICAL();
    /* 函數返回優先級最高的任務 */
}

/*********************************************************************************************************
** 函數名稱: OSTickISR
** 功能描述: 系統時鐘中斷服務函數
** 輸　入: 無
** 輸　出 : 無
** 全局變量: 無
** 調用模塊: OS_IBT_ENTER,(UserTickTimer),OSTimeTick,OSIntExit
** 
** 作　者: 陳明計
** 日　期: 2002年2月22日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日　期: 2002年10月23日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#if EN_OS_INT_ENTER >0 
#pragma disable                                        /* 除非最高優先級中斷，否則，必須加上這一句                 */
#endif
        void OSTickISR(void) interrupt OS_TIME_ISR

{
#if TICK_TIMER_SHARING >1 
    static uint8 TickSum = 0;
#endif

#if EN_USER_TICK_TIMER > 0 
    UserTickTimer();                                    /* 用戶函數                                                 */
#endif

#if TICK_TIMER_SHARING >1 
    TickSum = (TickSum + 1) % TICK_TIMER_SHARING;
    if (TickSum != 0)
    {
        return;
    }
#endif

#if EN_OS_INT_ENTER > 0 
    OS_INT_ENTER();                                     /* 中斷開始處理                                    */
#endif
    

#if EN_TIMER_SHARING > 0
    OSTimeTick();                                       /* 調用系統時鐘處理函數                            */
#else
    OSIntSendSignal(TIME_ISR_TASK_ID);                  /* 喚醒ID為TIME_ISR_TASK_ID的任務                 */
#endif
    
    OSIntExit();                                        /* 中斷結束處理                                             */
}