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

　　函數(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;/*幀號、舵機時間臨時變量*/

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

　　{t=T_Key[id];/*每一幀的運行時間*/

　　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; }/*細分時間*/

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

　　3.6 機器人程序流程

　　機器人根據(jù)接收到的遙控命令自行判斷并完成動作，工作流程如圖5所示。因為人形機器人使用電池，工作比較耗電，所以在運動前要先檢測工作電壓，如果達到工作要求就接著工作，否則不執(zhí)行動作并報警，工作電壓不滿足要求會造成機器人因動力不足而摔倒，接收到結(jié)束命令就停止運行，不再響應(yīng)外部所發(fā)來的遙控命令，如果完成一個動作就恢復(fù)到立正站立狀態(tài)^[7]。

　　需要指出的是，在機器人運動時，程序?qū)ζ渫獠康?a class="contentlabel" href="http://m.butianyuan.cn/news/listbylabel/label/伺服器">伺服器控制要進行分時分批控制，以減輕處理器功耗壓力，達到可靠驅(qū)動的目的。

　　4 結(jié)論

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

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