*--stk=(unsigned int)task; /*lr*/

*--stk=(unsigned int)task /*pc*/

*--stk=0; /*r12*/

*--stk=0; /*r11*/

*--stk=0; /*r10*/

*--stk=0; /*r9*/

*--stk=0; /*r8*/

*--stk=0; /*r7*/

*--stk=0; /*r6*/

*--stk=0; /*r5*/

*--stk=0; /*r4*/

*--stk=0; /*r3*/

*--stk=0; /*r2*/

*--stk=0; /*r1*/

*--stk=(unsigned int)pdata; /*r0*/

*--stk=(SVC32MODE0x0); /*cpsr IRQ,

*--stk=(SVC32MODE0x0); /*spsr IRQ,關(guān)閉FIQ*/

return((void*)stk);

}

后5個(gè)函數(shù)是鉤子函數(shù)，可以不加代碼：

void OSTaskCreateHook(OS_TCB *ptcb)

void OSTaksDelHool (OS_TCB *ptcb)

void OSTaskSwHook(void)

void OSTaskStatHook(void)

（3）用匯編語言編寫4個(gè)與處理器相關(guān)的函數(shù)（OS_CPU.ASM）

OSStartHighRdy() ；運(yùn)行優(yōu)先級(jí)最高的就緒任務(wù)

LDR r4，addr_OSTCBCur ；得到當(dāng)前任務(wù)的TCB地址

LDR r5，addr_OSTCBHighRdy ；得到高優(yōu)先級(jí)任務(wù)的TCB地址

LDR r5,addr_OSTCBHighRdy ；得到高優(yōu)先級(jí)任務(wù)的TCB地址

LDR r5,[r5] ;得到堆棧指針

LDR sp,[r5] ；切換到新的堆棧

STR r5,[r4] ;設(shè)置新的當(dāng)前任務(wù)的TCB地址

LDMFD sp!,{r4}

MSR CPSR_cxsf,r4

LDMFD sp!,{r0-r12,lr,pc} ；開始新的任務(wù)

END

OSCtxsw() 任務(wù)級(jí)的任務(wù)切換函數(shù)

STMFD sp!,{lr} ;保存PC指針

STMFD sp!,{lr} ;保存lr指針

STMFD sp！，{r0-r12} ;保存寄存器文件和返回地址

MRS r4,CPSR

STMFD sp!,{r4} ;保存當(dāng)前PSR

MRS r4,SPSR

STMFD sp!,{r4}

;OSPrioCur=OSPrioHighRdy

LDR r4,addr_OSPrioCur

LDR r5,addr_OSPrioHighRdy

LDRB r6,[r5]

STRB r6,[r4]

；得到當(dāng)前任務(wù)的TCB地址

LDR r4,addr_OSTCBCur

LDR r5,[r4]

STR sp,[r5] ;保存棧指針在占先任務(wù)的TCB上

；取得高優(yōu)先級(jí)任務(wù)的TCB地址