自己写单片机操做体系3-使命创建和调度

OS_STK* InitStkBuff(VOID_FUN_PTR task,OS_STK* pstk)
{
pstk–;
*pstk = (U16)(((U32)task) >> 8);存要履行的函数
pstk–;
*pstk = 0xFFFF;//IY存y寄存器
(pstk)–;
*pstk = 0x1111;//IX存x寄存器
pstk–;
*pstk = 0xAA;//A;存A
((U8*)pstk)–;A和B都是8位的在寄存器中是一同放在一个16位中的、
*pstk = 0xBB;//B存B
((U8*)pstk)–;//在中止中需求多保存一次page页，所以需求留一个空间出来
return pstk;
}
void CreatTask(VOID_FUN_PTR task,OS_STK *pStk,U8 stkSize,U8 osPior)
{
OsTaskObjTbl[osPior].Task = task;
OsTaskObjTbl[osPior].TaskSp = pStk;
OsTaskObjTbl[osPior].stkSize = stkSize;
OsTaskObjTbl[osPior].taskDly = 0;
OsTaskObjTbl[osPior].taskState = TASK_STATE_READY;
OsTaskObjTbl[osPior].nextTask = IdelTask;
OsTaskObjTbl[osPior].TaskSp = InitStkBuff(task,pStk);将修改后的sp给到使命的sp中
}
使命调度函数

void Os_Schel(void)
{
U8 i;
OldTask = HeadTask;
for(i = 0;i < TASK_SIZE;i++)
{
if(OsTaskObjTbl[i].taskState == TASK_STATE_READY) 直接检查使命的状况，是否现已安排妥当
{
HeadTask = &OsTaskObjTbl[i];
break;
}
}

OS_TASK_SW();发动软件中止进入中止调度
}
__interrupt VectorNumber_Vswi void OSCtxSw(void) //4为SWI中止
{
DisableInterrupts; //关中止
//PTP = 0xAA;
asm{
ldaa $30 //保存页面寄存器，单片机16位最大的flash只能是64k。可是128k需求经过页面寄存器切换
psha
STS Sp_bf将当时的sp赋值给sp_bf
}
OldTask->TaskSp = Sp_bf;保存sp-bf
Sp_bf = HeadTask->TaskSp; 取出sp的地址。
asm{
LDS Sp_bf将sp-bf给SP
pula
staa $30 将页面寄存器康复
}
EnableInterrupts; //开中止
}
这样一个使命就调度出来了、