基于實(shí)時操作系統(tǒng)RTOS和Ｃ語言的開發(fā)，具有良好的可繼承性,，在處理器升級以及更換處理器類型時,，只需要在系統(tǒng)底層做相應(yīng)的移植,，大部分應(yīng)用程序代碼可以不做修改就可以移植過來使用。μC/OS-II是一個完整的,、可移植,、可固化、可裁剪的占先式實(shí)時多任務(wù)內(nèi)核,。μC/OS-II絕大部分代碼采用ANSI的C語言編寫,，包含一部分匯編代碼，使之可供不同架構(gòu)的微處理器使用,。μC/OS-II運(yùn)行穩(wěn)定可靠,，通過了美國航空管理局的認(rèn)證，可以應(yīng)用到汽車,、飛機(jī)等安全性要求嚴(yán)格的場合[1],。

1 MPC5604B硬件資源
1.1 MCU基本參數(shù)
    MPC5604B是飛思卡爾公司基于PowerPC架構(gòu)針對車身控制領(lǐng)域而設(shè)計的新型處理器。該處理器采用e200z0核,，時鐘頻率可達(dá)64 MHz,，內(nèi)核集成有中斷向量控制器和存儲保護(hù)模塊。存儲模塊包括512 KB的程序Flash,、64 KB的數(shù)據(jù)Flash,、48 KB的SRAM，而且都具有錯誤檢查和糾正(ECC)功能,。通信接口包括3路FlexCAN,、4路LINFlex、3路SPI以及1路IIC,。時鐘模塊包括2路eMIOS,。此外，還有36通道的ADC模塊以及啟動輔助模塊[2-3]（BAM）等,。
1.2 e200z0指令模型
    PowerPC架構(gòu)Book E中定義了固定32 bit長度的指令集,，但是一些指令不需要32 bit長度，16 bit長度就可以執(zhí)行同樣的操作,，所以e200z0內(nèi)核采用可變長度編碼（VLE）指令集,。該指令集是32 bit和16 bit指令長度混合指令集，相比于Book E中固定長度指令集,，VLE指令集代碼密度更高,，節(jié)省了存儲空間。
    在匯編代碼形式上,，16 bit VLE指令集在匯編指令前加se前綴,，32 bit VLE指令集在匯編指令前加e前綴。以stw指令為例,，VLE指令和Book E 32 bit指令區(qū)別如表1所示,。

    軟件向量模式下,，外圍設(shè)備的所有中斷最終都只響應(yīng)一個中斷，即偏移為0x0040的外圍設(shè)備中斷(IVOR4),。當(dāng)外圍設(shè)備發(fā)生中斷后,，執(zhí)行IVOR4中斷處理函數(shù)，該函數(shù)讀取INTC_IACKR寄存器確定具體該處理哪一個外圍設(shè)備的中斷函數(shù),。軟件向量模式的好處是所有的外設(shè)中斷只需要寫一個上下文保存和切換函數(shù),，節(jié)省了用戶的代碼編寫量和存儲空間。
    硬件向量模式就是在表2所示的中斷向量表后面距離中斷向量基址寄存器（IVPR）偏移0x800位置再添加了一個外圍設(shè)備中斷向量表,。當(dāng)發(fā)生外設(shè)中斷時,，寄存器直接跳轉(zhuǎn)到相應(yīng)的外設(shè)中斷處理函數(shù)。硬件向量模式其中斷響應(yīng)更迅速,，但每一個中斷處理函數(shù)都需要有單獨(dú)的上下文保存和切換函數(shù),，其代碼量很大。
2 μC/OS-II調(diào)度原理及軟件實(shí)現(xiàn)
2.1 原理及移植
    μC/OS-II實(shí)時操作系統(tǒng)的工作原理是：最大程度地讓處于就緒狀態(tài)的最高優(yōu)先級任務(wù)處于運(yùn)行狀態(tài),。在μC/OS-II中,，主要通過如下三方面的機(jī)制來實(shí)現(xiàn)實(shí)時性[4]。
    (1)用戶主動調(diào)用API函數(shù),。在用戶當(dāng)前任務(wù)執(zhí)行到一定步驟,，比如已經(jīng)執(zhí)行結(jié)束或者需要暫停掛起當(dāng)前任務(wù)時，調(diào)用系統(tǒng)函數(shù)OSSemPost(),、OSTimeDly()、OSSemPend()等API函數(shù),。在這些函數(shù)里,，通過調(diào)用OS_Sched()函數(shù)，如果檢測到當(dāng)前有更高優(yōu)先級別的任務(wù)處于就緒狀態(tài),，則調(diào)用OS_TASK_SW()函數(shù)切換到更高優(yōu)先級的任務(wù)執(zhí)行,。
    (2)通過系統(tǒng)時鐘(Systick)進(jìn)行調(diào)度。每隔一個系統(tǒng)時鐘間隔進(jìn)行一次任務(wù)就緒狀態(tài)檢測,，如果檢測到有更高優(yōu)先級的任務(wù)處于就緒狀態(tài),，則執(zhí)行任務(wù)切換。系統(tǒng)時鐘間隔選擇要合適,，太長會影響系統(tǒng)實(shí)時性,，太短會造成系統(tǒng)花費(fèi)過多的資源處理定時器中斷。
    (3)通過外部中斷程序觸發(fā)任務(wù)切換,。當(dāng)發(fā)生了外部中斷,，造成系統(tǒng)任務(wù)就緒狀態(tài)的變化、退出中斷處理函數(shù)時,，調(diào)用OSIntExit()函數(shù),。在這個函數(shù)里,，如果檢測到更高優(yōu)先級任務(wù)處于就緒狀態(tài)，則調(diào)用OSIntCtxSw()函數(shù)執(zhí)行任務(wù)的切換,。
    通過上面三種機(jī)制實(shí)現(xiàn)了系統(tǒng)最大程度的實(shí)時性調(diào)度,。系統(tǒng)移植主要的任務(wù)是：結(jié)合具體的硬件平臺，實(shí)現(xiàn)任務(wù)堆棧的建立,，任務(wù)調(diào)度過程中上下文的保存和切換以及系統(tǒng)時鐘的實(shí)現(xiàn),。主要包括OS_CPU.h、OS_CPU_C.c以及OS_CPU_A.s幾個移植文件,。
2.2 實(shí)現(xiàn)OS_TASK_SW()函數(shù)
    OS_TASK_SW()函數(shù)用于實(shí)現(xiàn)任務(wù)級別的任務(wù)切換,。根據(jù)前面介紹的MPC5604B異常向量表，采用位于中斷向量表偏移地址為0x0080（IVOR8）的系統(tǒng)調(diào)用（system call）異常來實(shí)現(xiàn)該函數(shù),，程序如下：
    #define OS_TASK_SW()   asm(“se_sc”);
2.3 實(shí)現(xiàn)OSTaskInit()函數(shù)
    OSTaskInit()函數(shù)在任務(wù)創(chuàng)建時被調(diào)用,，為新創(chuàng)建的任務(wù)在RAM中申請一塊棧區(qū)，并把堆棧指針傳遞給該任務(wù)的控制模塊TCB中,。在程序執(zhí)行中,，需要保存的寄存器有：通用寄存器R0～R30、器件模式寄存器MSR,、連接寄存器LR,、計數(shù)寄存器CTR、存儲/恢復(fù)寄存器對SRR0/SRR1,、整型異常寄存器EXR,。PowerPC架構(gòu)中沒有專門的堆棧指針寄存器，采用通用寄存器R1作為堆棧指針寄存器,。
2.4 任務(wù)上下文保存和恢復(fù)函數(shù)
    μC/OS-II中,，執(zhí)行OSStxSw、OSIntCtxSw,、OSStartHighRdy等任務(wù)切換函數(shù)時,，需要保存任務(wù)上下文prologue或者恢復(fù)任務(wù)上下文epilogue。執(zhí)行這些操作,，要對CPU內(nèi)部寄存器進(jìn)行直接訪問,。C語言不能實(shí)現(xiàn)對這些寄存器的直接訪問，需要通過匯編代碼來執(zhí)行這些與處理器直接相關(guān)的操作,。下面是保存任務(wù)上下文prologue的匯編實(shí)現(xiàn)代碼：
    prologue:       .macro
               e_add2i.r1,，-STACK_FRAME_SIZE
               e_stwu     r1,0(r1)
               e_stw     r0,4(r1)
               ……
               e_stw     r31,4*31(r1)
               mfmsr     r0
               e_stw     r0,    XMSR(r1)
               ……
               mfcr     r0
               e_stw     r0,    152(r1)
               mfmsr     r0
    epilogue函數(shù)執(zhí)行與prologue相反的操作，即把任務(wù)堆棧中存儲的數(shù)據(jù)恢復(fù)到寄存器中,。
2.5 系統(tǒng)時鐘函數(shù)OSTickISR
    OSTickISR()函數(shù)是系統(tǒng)時鐘處理函數(shù),，主要目的是讓MCU每隔一定的時間去執(zhí)行OSTimeTick()函數(shù)。MPC5604B所采用的e200z0內(nèi)核沒有專門的系統(tǒng)時鐘（Systick）模塊，因此選擇外設(shè)中的周期時鐘通道0(PIT0)作為系統(tǒng)時鐘基準(zhǔn),。處理函數(shù)只需要完成如下兩項(xiàng)任務(wù)：調(diào)用OSTimeTick()函數(shù)和清除通道中斷標(biāo)志即可,。實(shí)現(xiàn)代碼如下：
    void Pit1ISR(void) {
      OSTimeTick ();
      PIT.CH[1].TFLG.B.TIF = 1;
    }
    這里中斷控制器(INTC)采用軟件向量模式。下面介紹如何配置軟件向量工作模式的PIT0中斷,。
    (1)在鏈接命令文件（lcf）中申請一塊區(qū)域存儲中斷向量表,，鏈接腳本如下：
    MEMORY
    { ……
    interrupts_flash: org = 0x00010000, len = 0x00010000
    ……}
    GROUP :
    { ……
    .ivor_branch_table(VLECODE)LOAD(ADDR(interrupts_flash)) : {}
    ……  } > interrupts_flash
    (2)將OSExtIntISR函數(shù)添加到中斷向量表中,代碼如下：
    .extern OSExtIntISR
    ……
    .section .ivor_branch_table, text_vle
    ……
    .align SIXTEEN_BYTES
    IVOR4trap:  e_b      OSExtIntISR
    ……
    OSExtIntISR函數(shù)中，通過讀取INTC_IACKR寄存器,，查詢當(dāng)前具體是哪一個外設(shè)處理函數(shù)需要被執(zhí)行,。而相應(yīng)的外設(shè)函數(shù)指針存放在一個數(shù)組中，初始化中斷時,，要把該數(shù)組賦值給INTC_IACKR寄存器,，代碼如下：
    INTC.IACKR.R=(uint32_t)&IntcVectorTable[0];
    uint32_t IntcVectorTable[] = {
    (uint32_t)&dummy……
    (uint32_t)&Pit1ISR,
    ……}
外設(shè)處理函數(shù)在數(shù)組中的位置根據(jù)其中斷編號決定。
    以上介紹的是與MPC5604B處理器直接相關(guān)的代碼,，其他移植部分代碼都有成熟的代碼可以參考,，這里不作介紹。
3 任務(wù)調(diào)度算法硬件指令優(yōu)化
3.1 μC/OS-II最高優(yōu)先級就緒任務(wù)查詢原理

    μC/OS-II操作系統(tǒng)最初是針對8 bit機(jī)寫的,，采用了一個全局字節(jié)變量OSRdyGrp和全局字節(jié)數(shù)組OSRdyTbl[8]實(shí)現(xiàn)了對64個任務(wù)就緒狀態(tài)的管理,。OSRdyTbl[8]數(shù)組共64 bit，表示64個優(yōu)先級的任務(wù)的就緒狀態(tài),，如果為1,，則表示該優(yōu)先級的任務(wù)已經(jīng)就緒。這64個任務(wù),，從0～63分成8組,，OSRdyGrp字節(jié)的每一位，就代表OSRdyTbl[8]哪一組中有任務(wù)處于就緒狀態(tài),。優(yōu)先級就緒表如圖1所示,。
    操作系統(tǒng)查詢最高優(yōu)先級就緒任務(wù)的步驟是：先查詢OSRdyGrp字節(jié)中為1的最低位。例如,，如果OSRdyGrp字節(jié)為0x1C(00011100B)，則處于就緒狀態(tài)的優(yōu)先級最高的組的索引值為Y=2,；然后查詢OSRdyTbl[2]中字節(jié)為1的最低位,，這里假設(shè)OSRdyTbl[2]為0x12(00010010B)，則該組中優(yōu)先級最高的位索引值為X=1.從而可以計算出優(yōu)先級Prio=Y<<3+X=17,。
    根據(jù)前面的描述,，處于就緒狀態(tài)的任務(wù)中最高優(yōu)先級查詢的軟件算法代碼如下：
    INT8U   y;
    y = OSUnMapTbl[OSRdyGrp];
    OSPrioHighRdy=(INT8U)((y << 3)+OSUnMapTbl
[OSRdyTbl[y]]); [1]
    OSUnMapTbl是一個常數(shù)表格，該表格的作用是查詢索引OSRdyTbl[y]對應(yīng)的字節(jié)為1的所有位中的最低位所在位置,。例如,，如果OSRdyTbl[y]=12，則OSUnMapTbl[12]=2,。這種查表法通過空間換時間,，避免了軟件逐位判斷的時間開銷,。
3.2 基于MPC5604B硬件指令的優(yōu)化
    在PowerPC e200z0內(nèi)核指令中，有一條指令cntlzw(Count Leading Zeros Word)：其前導(dǎo)0計數(shù)指令,，該指令在32 bit e200z0內(nèi)核處理器中用于查詢一個32 bit數(shù)從高位開始的0的數(shù)量,。比如內(nèi)核寄存r5中存儲了0x02000000的值，執(zhí)行指令(cntlzw r3,，r5)后,，r3中得到的數(shù)值為6，這與操作系統(tǒng)任務(wù)調(diào)度過程中查詢最高優(yōu)先級就緒任務(wù)的軟件算法要實(shí)現(xiàn)的目的是一致的,。
    以上介紹的軟件調(diào)度算法,，其實(shí)就是查詢OSRdyTbl[8]數(shù)組共64 bit中為1的最低位的位置。在e200z0內(nèi)核運(yùn)算中,，可以把就緒表拆成兩個32 bit數(shù),，通過執(zhí)行一次或者兩次cntlzw指令就能確定就緒的最高優(yōu)先級任務(wù)所在的位置。
    為了保證操作系統(tǒng)的實(shí)時性,，&mu;C/OS-II操作系統(tǒng)會頻繁地進(jìn)行查詢就緒任務(wù)狀態(tài)表,。每一次硬件中斷，用戶調(diào)用的任務(wù)調(diào)度API函數(shù)以及系統(tǒng)時鐘Tick函數(shù)都會執(zhí)行就緒狀態(tài)表查詢函數(shù),。如果采用硬件指令替換軟件調(diào)度算法,，將大大提升系統(tǒng)任務(wù)調(diào)度的性能。
3.3 硬件指令的優(yōu)化實(shí)現(xiàn)
    所謂任務(wù)調(diào)度函數(shù)硬件優(yōu)化就是采用cntlzw硬件指令取代軟件算法的任務(wù)調(diào)度查詢函數(shù),。要實(shí)現(xiàn)該優(yōu)化過程,，需要完成下面兩個步驟。
3.3.1 重寫函數(shù)OS_SchedNew
    MPC5604B所采用的是e200z0內(nèi)核為32 bit指令長度,，要查詢64 bit的長度,，需要分成2次。先查詢低位32 bit,，如果查詢到有就緒位置位,，則把結(jié)果賦值給全局變量OSRdyTbl并退出函數(shù)；如果低32 bit沒有查詢到就緒位,，則用同樣方法查詢高32 bit長度,，并把查詢結(jié)果加上32后賦給OSRdyTbl。具體的實(shí)現(xiàn)代碼如下：
    static asm void OS_SchedNew(void)
    {  e_lis r9,OSRdyTbl@ha
       ori r9, r9,OSRdyTbl@l
       e_lwz r8,0(r9)
       cntlzw r8,r8
       e_cmpi 0,0,r8,32
       se_bne  __HighWord
       e_lwz  r8,4(r9)
       cntlzw r8,r8
       e_addi r8,r8,32
       __HighWord:
       e_stb r8,OSPrioHighRdy
       se_blr    }
    在操作系統(tǒng)中,，函數(shù)OS_EventTaskRdy也用到了就緒最高優(yōu)先級任務(wù)查詢,。按照上面的代碼，把prio= (INT8U)((y<<3)+x)語句用相應(yīng)的匯編指令替換掉即可,，這里不再贅述,。
    相比于軟件調(diào)度算法代碼，經(jīng)過優(yōu)化的調(diào)度函數(shù)指令執(zhí)行時間縮短一半以上，主要省掉了查詢調(diào)度表OSUnMapTbl[256],。此外,，對于處理能力比較強(qiáng)的32 bit機(jī)，如果需要擴(kuò)充&mu;C/OS-II最大任務(wù)數(shù)量(如1 024個任務(wù)數(shù)量),，則采用硬件指令cntlzw處理任務(wù)調(diào)度將比較容易完成這個操作,。而&mu;C/OS-II最初的任務(wù)系統(tǒng)是針對8 bit機(jī)寫的，直接采用軟件算法擴(kuò)充到支持1 024個任務(wù)數(shù)會比較麻煩,，并要消耗更多的資源,。
3.3.2 修改任務(wù)控制塊初始化OS_TCBInit
    OS_TCBInit函數(shù)中有以下代碼：
    ptcb->OSTCBBitY=(INT8U)(1<<ptcb->OSTCBY);
    ptcb->OSTCBBitX=(INT8U)(1<<(ptcb->OSTCBX));
    該段代碼用于創(chuàng)建任務(wù)時，需要計算該任務(wù)優(yōu)先級掩碼,。但是,，該段代碼計算出來的掩碼卻不適用于前面替換的硬件指令(cntlzw)調(diào)度函數(shù)。其原因分析如下：
    設(shè)優(yōu)先級就緒表OSRdyTbl[0..3]當(dāng)前的值為{0x00,，
0x02,，0x00，0x22},，則執(zhí)行了e_lwz r8,，0(r9)指令后，r8寄存器中32 bit數(shù)值為0x00020022,。采用cntlz r8,，r8計算前導(dǎo)零值為14。而實(shí)際上此時OSRdyTbl代表的就緒最高優(yōu)先級值為9,，差別在于對0x02這個值的解析,。按照cntlzw對0x02(00000010B)的解析，其前導(dǎo)零數(shù)量為6,，則所計算出的優(yōu)先級為8+6=14,；而根據(jù)前面的掩碼計算公式可知，0x02(00000010B)表示第1組中第1位(均從0開始計算)所代表的優(yōu)先級為8&times;1+1=9,。
    因此,，為了適應(yīng)硬件指令cntlzw，需要修改掩碼計算方法,。采用了cntlzw指令后,，狀態(tài)就緒組變量OSRdyGrp以及管理該變量的掩碼OSTCBBitY已經(jīng)沒有用處，因此,，只需要將函數(shù)修改為：
    ptcb->OSTCBBitX=(INT8U)(1<<((7-ptcb->OSTCBX))。
    同理,，涉及到修改x掩碼位的所有函數(shù)(OSMutexPend,、OSMutex_RdyAtPrio、OSTaskChangePrio)都要做同樣的調(diào)整。調(diào)整過后,，系統(tǒng)就可以正常運(yùn)行了,。
    本文詳細(xì)介紹了基于MPC5604B的&mu;C/OS-II操作系統(tǒng)的移植程序以及操作系統(tǒng)最高優(yōu)先級就緒任務(wù)查詢算法的硬件指令優(yōu)化。在移植過程中,，首先要分析硬件系統(tǒng)資源,，使用鏈接命令文件(lcf)分配代碼和數(shù)據(jù)段；然后要熟練掌握e200z0核匯編指令,，實(shí)現(xiàn)操作系統(tǒng)堆棧維護(hù),、中斷上下文保存、時鐘tick,、任務(wù)切換等底層函數(shù)的編寫,；最后在系統(tǒng)移植過程中，要善于發(fā)現(xiàn)和利用處理器一些特殊的指令,，實(shí)現(xiàn)軟件算法的硬件優(yōu)化,，以提高程序的執(zhí)行效率。
參考文獻(xiàn)
[1] (美)LABROSSE J J,，著．嵌入式實(shí)時操作系統(tǒng)&mu;C/OS-II (第2版)[M]．邵貝貝,，譯．北京：北京航空航天大學(xué)出版社，2003.
[2] SOJA R,，BANNOURA M,，著.MPC5553/5554微處理器揭秘[M].龔光華，宮輝,，安鵬,，譯.北京：北京航空航天大學(xué)出版社，2010.
[3] Freescale Semiconductor,，Inc.MPC5604B/C microcontroller reference manual[Z]．2011.
[4] 孫旭祥.淺析實(shí)時操作系統(tǒng)的任務(wù)調(diào)度[J].信息對抗,，2005(6)：37-39.