os_cpu_c.c

个人移植的陈明计先生的small_rtos_MSP430版

/*********************************************************************************************************
**				                               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"

#pragma dataseg = DATA16_I
__no_init uint16 * STACK[128];
#pragma dataseg = default

//extern uint8 STACK[1];                          /* 堆栈起始位置,在OS_CPU_A定义 */
uint16 * data OSTaskStackBottom[OS_MAX_TASKS + 2];/* 任务堆栈底部位置            */

#if EN_SP2 > 0
uint8 Sp2[Sp2Space];                            /* 高级中断堆栈           */
#endif

/*********************************************************************************************************
** 函数名称: C_OSCtxSw
** 功能描述: 用C写的堆栈处理函数,已经用汇编改写,此函数在移植并非必须
** 输　入: 无
** 输　出 : 无
** 全局变量: OSTaskID,OSTaskStackBottom,SP
** 调用模块: LoadCtx
** 
** 作　者: 陈明计
** 日　期: 2002年2月22日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
/*        void C_OSCtxSw(void) 

{
    uint16 *cp1, *cp2;
    uint16 temp, i;
    
    cp1 = GetSP();          // cp1保存当前任务堆栈指针
    temp = (uint16)OSTaskStackBottom[OSNextTaskID+1];   // temp保存再下一个栈底
    cp2 = OSTaskStackBottom[OSTaskID+1];    // cp2保存当前任务后一个任务的栈底
    
    if( OSNextTaskID > OSTaskID)
    {
        while( cp2 != (uint16 *)temp )      // 腾出堆栈空间
        {
            *cp1-- = *cp2--;
        }
        temp = GetSP() - OSTaskStackBottom[OSTaskID+1] - 1; // 计算当前堆栈的剩余量,以便更新栈底数组
        i = (uint16)cp1 + 1;
        PutSP((uint16*)i);      // 更新堆栈指针
        for(i = OSTaskID+1;i < OSNextTaskID+1; i++)     // 更新栈底数组
        {
            OSTaskStackBottom[i] += temp;
        }
        OSTaskID = OSNextTaskID;
        LoadCtx();
    }
    if( OSNextTaskID < OSTaskID)
    {
        cp2++;
        while(cp1 != (uint16 *)temp)        // 腾出堆栈空间
        {
            *cp2++ = *cp1++;
        }
        temp = GetSP() - OSTaskStackBottom[OSTaskID+1] - 1;
        i = (uint16)OSTaskStackBottom[OSNextTaskID+1] - 1;
        PutSP((uint16*)i);
        for( i = OSNextTaskID+1;i < OSTaskID+1; i++ )
        {
            OSTaskStackBottom[i] -= temp;
        }
        OSTaskID = OSNextTaskID;
    }
    LoadCtx();
}
*/
/*********************************************************************************************************
** 函数名称: OSIdle
** 功能描述: 优先级最低的任务
** 输　入: 无
** 输　出 : 无
** 全局变量: 无
** 调用模块: 无
** 
** 作　者: 陈明计
** 日　期: 2002年12月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/

        void OSIdle(void)
{
    while(1)
    {
//        PCON = PCON | 0x01;                     /* CPU进入休眠状态 */
        LPM0;
    }
}

/*********************************************************************************************************
** 函数名称: OSStart
** 功能描述: Small RTOS 51初始化函数,调用此函数后多任务开始运行,首先执ID为0的任务
** 输　入: 无
** 输　出 : 无
** 全局变量: OSTaskStackBottom,SP
** 调用模块: 无
** 
** 作　者: 陈明计
** 日　期: 2002年2月22日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陈明计
** 日　期: 2002年12月2日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陈明计
** 日　期: 2002年12月30日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        void OSStart(void)
        
{
    uint16 *cp;
    uint8 i;

    cp = (uint16 *)(&STACK[STACK_RAM_SIZE - 1]);

    OSTaskStackBottom[0] = (uint16 *)(&STACK[STACK_RAM_SIZE - 1]);
    OSTaskStackBottom[OS_MAX_TASKS + 1] = (uint16 *)(&STACK[0]);

    /* 初始化优先级最高的任务堆栈，使返回地址为任务开始地址 */
    *cp-- = ((uint16)(TaskFuction[0])); // 标志
    *cp-- = ((uint16)(TaskFuction[0])); // 真正返回地址
    *cp = (uint16)0x0008;    // SR寄存器
    PutSP((uint16*)cp);

    /* 初始化优先级最低的任务堆栈 */
    cp = (uint16 *)STACK;
    cp++;
    *cp++ = (uint16)0x0F0F, *cp++ = (uint16)0x0E0E, *cp++ = (uint16)0x0D0D, *cp++ = (uint16)0x0C0C;
    *cp++ = (uint16)0x0B0B, *cp++ = (uint16)0x0A0A, *cp++ = (uint16)0x0909, *cp++ = (uint16)0x0808;
    *cp++ = (uint16)0x0707, *cp++ = (uint16)0x0606, *cp++ = (uint16)0x0505, *cp++ = (uint16)0x0404;
    *cp++ = 0x0008;     // SR寄存器
    *cp++ = ((uint16)(OSIdle));
    *cp = ((uint16)(OSIdle));
    OSTaskStackBottom[OS_MAX_TASKS] = cp;

    /* 初始化其它优先级的任务堆栈 */
    for(i = OS_MAX_TASKS - 1; i > 0; i--)
    {
        cp++;
        *cp++ = (uint16)0x0F0F, *cp++ = (uint16)0x0E0E, *cp++ = (uint16)0x0D0D, *cp++ = (uint16)0x0C0C;
        *cp++ = (uint16)0x0B0B, *cp++ = (uint16)0x0A0A, *cp++ = (uint16)0x0909, *cp++ = (uint16)0x0808;
        *cp++ = (uint16)0x0707, *cp++ = (uint16)0x0606, *cp++ = (uint16)0x0505, *cp++ = (uint16)0x0404;
        *cp++ = 0x0008;     // SR寄存器
        *cp++ = ((uint16)(TaskFuction[i]));
        *cp = ((uint16)(TaskFuction[i]));
        OSTaskStackBottom[i] = cp;
    }
    /* 允许中断 */
    Os_Enter_Sum = 1;
    OS_EXIT_CRITICAL();
    /* 函数返回优先级最高的任务 */
    asm("RETI");
}

/*********************************************************************************************************
** 函数名称: OSTickISR
** 功能描述: 系统时钟中断服务函数
** 输　入: 无
** 输　出 : 无
** 全局变量: 无
** 调用模块: OS_IBT_ENTER,(UserTickTimer),OSTimeTick,OSIntExit
** 
** 作　者: 陈明计
** 日　期: 2002年2月22日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陈明计
** 日　期: 2002年10月23日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/

//#pragma vector = OS_TIME_ISR
//        __interrupt void OSTickISR(void)
//
//{
//#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();                                        /* 中断结束处理                                             */
//}