一款基于ARM的多自由度人形教育機(jī)器人控制系統(tǒng)的設(shè)計(jì)

　　函數(shù)定義：void ManMoveKeyframeToFrame(void)

　　{uint16 id,h,la1,la2,la3,ra1,ra2,ra3,ll1,ll2,ll3,ll4,ll5,rl1,rl2,rl3,rl4,rl5;uint8 t,k;/*幀號、舵機(jī)時間臨時變量*/

　　for(id=0;id<=ID_Max-1;id++)//把所有的關(guān)鍵動作幀細(xì)分連接起來

　　{t=T_Key[id];/*每一幀的運(yùn)行時間*/

　　for(k=1;k<=t;k++){ if(id==0) { h=(H[id])*(k)/t; … ; rl5=(RL5[id])*(k)/t; }/*將第1幀特殊處理*/

　　else{ h=(H[id]-H[id-1])*(k)/t; … ; rl5=(RL5[id]-RL5[id-1])*(k)/t; }/*細(xì)分時間*/

　　ManMoveFrame(H[id-1]+h,LA1[id-1]+la1,LA2[id-1]+la2, … ,RL5[id-1]+rl5,1);/*驅(qū)動運(yùn)行*/}}}

　　3.6 機(jī)器人程序流程

　　機(jī)器人根據(jù)接收到的遙控命令自行判斷并完成動作，工作流程如圖5所示。因?yàn)槿诵?a class="contentlabel" href="http://www.ex-cimer.com/news/listbylabel/label/機(jī)器人">機(jī)器人使用電池，工作比較耗電，所以在運(yùn)動前要先檢測工作電壓，如果達(dá)到工作要求就接著工作，否則不執(zhí)行動作并報(bào)警，工作電壓不滿足要求會造成機(jī)器人因動力不足而摔倒，接收到結(jié)束命令就停止運(yùn)行，不再響應(yīng)外部所發(fā)來的遙控命令，如果完成一個動作就恢復(fù)到立正站立狀態(tài)^[7]。

　　需要指出的是，在機(jī)器人運(yùn)動時，程序?qū)ζ渫獠康?a class="contentlabel" href="http://www.ex-cimer.com/news/listbylabel/label/伺服器">伺服器控制要進(jìn)行分時分批控制，以減輕處理器功耗壓力，達(dá)到可靠驅(qū)動的目的。

　　4 結(jié)論

　　按照機(jī)器人的運(yùn)動體態(tài)完成運(yùn)動數(shù)據(jù)的設(shè)計(jì)，經(jīng)過測試，該控制系統(tǒng)可以完成包括前滾翻、后滾翻、俯臥撐在內(nèi)的多種體操運(yùn)動。課題組計(jì)劃進(jìn)一步封裝函數(shù)，并設(shè)計(jì)可視化圖形編程界面，以便可以在電腦上更加直觀地生成運(yùn)動數(shù)據(jù)，積木化編程，降低操作難度。

　　參考文獻(xiàn)：
　　[1] 閻世梁, 張華等.高等工程教育中的機(jī)器人教育探索與實(shí)踐[J].實(shí)驗(yàn)室研究與探索.2013(8):149-152
　　[2] 高彥杰.嵌入式溫度測量系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)[J]. 數(shù)字技術(shù)與應(yīng)用.2012(6):147-149
　　[3] 趙瑞林,盧慶林,張順星.教學(xué)型雙足步行機(jī)器人的結(jié)構(gòu)及其控制電路設(shè)計(jì)[J]. 計(jì)算技術(shù)與自動化.2014(2):74
　　[4]付偉,王建華.一種用于仿人型機(jī)器人控制的腳本語言的設(shè)計(jì)與實(shí)現(xiàn)[J].計(jì)算機(jī)應(yīng)用. 2014,32(8):24
　　[5] 劉磊，韓冰，王連弟等.一種雙足行走機(jī)構(gòu)的構(gòu)型設(shè)計(jì)與運(yùn)動學(xué)分析[J]. 天津理工大學(xué)學(xué)報(bào).2014(3):32-35
　　[6] 陳強(qiáng)，羅斌，秦超.仿人型機(jī)器人控制系統(tǒng)設(shè)計(jì)的幾個問題[J]. 自動化技術(shù)與應(yīng)用.2013,32(5) 14
　　[7] 李紅巖,高陽東.基于LPC2131的RF遙控多關(guān)節(jié)蛇形機(jī)器人[J]. 自動化與儀表.2014(6):3-4