購(gòu)買(mǎi)設(shè)計(jì)請(qǐng)充值后下載，，資源目錄下的文件所見(jiàn)即所得，都可以點(diǎn)開(kāi)預(yù)覽，，資料完整，充值下載可得到資源目錄里的所有文件。。。【注】：dwg后綴為CAD圖紙，doc,docx為WORD文檔，原稿無(wú)水印，可編輯。。。具體請(qǐng)見(jiàn)文件預(yù)覽，有不明白之處，可咨詢QQ:12401814
1介紹 2
2凸顯當(dāng)?shù)貓D像區(qū)域檢測(cè) 3
3場(chǎng)景識(shí)別和定位 5
4基于模糊邏輯的比賽策略 6
5實(shí)驗(yàn),分析 9
6總結(jié) 10
參考 11
基于視覺(jué)的場(chǎng)景識(shí)別為煤礦救災(zāi)機(jī)器人定位
文摘:提出了一種新的場(chǎng)景識(shí)別系統(tǒng)提出了基于模糊邏輯的和隱馬爾可夫模型(HMM),可以應(yīng)用在煤礦救災(zāi)機(jī)器人定位在緊急情況下。該系統(tǒng)使用單眼相機(jī)獲取全方位的圖像我的環(huán)境中機(jī)器人定位。采用center-surround差分方法,突出地方形象地區(qū)從圖像中提取天然地標(biāo)。這些指標(biāo)的組織利用HMM代表在現(xiàn)場(chǎng)機(jī)器人、模糊邏輯策略是用來(lái)比賽現(xiàn)場(chǎng),具有里程碑意義的。通過(guò)這種方法,定位問(wèn)題,這是現(xiàn)場(chǎng)識(shí)別問(wèn)題的系統(tǒng),可以轉(zhuǎn)化為評(píng)價(jià)問(wèn)題,嗯。這些技能的貢獻(xiàn)的系統(tǒng)有能力應(yīng)付變化的規(guī)模、二維旋轉(zhuǎn)和觀點(diǎn)。實(shí)驗(yàn)結(jié)果也證實(shí)了系統(tǒng)具有較高的識(shí)別和定位比靜態(tài)和動(dòng)態(tài)兩種情況下我的環(huán)境。
關(guān)鍵詞:機(jī)器人位置;場(chǎng)景識(shí)別;突出形象;匹配策略、模糊邏輯、隱馬爾可夫模型
1介紹
搜索和救援災(zāi)區(qū)的領(lǐng)域里機(jī)器人是一個(gè)新興的、富有挑戰(zhàn)性的課題。救援機(jī)器人進(jìn)入礦山開(kāi)發(fā)過(guò)程中緊急逃生路線定位可能對(duì)那些困在里面和確定它是否對(duì)人畜安全進(jìn)入與否。本地化是一個(gè)基本問(wèn)題這一領(lǐng)域。定位方法基于相機(jī)可主要分為幾何、拓?fù)浠蚧旌系摹Ｒ云溆行院涂尚行?場(chǎng)景識(shí)別已成為一個(gè)重要的技術(shù)拓?fù)潢P(guān)系的定位
目前多數(shù)場(chǎng)景識(shí)別方法為基礎(chǔ)的在全球的圖像特征,有兩種截然不同的階段:培訓(xùn)的離線和在線匹配。
在訓(xùn)練階段,機(jī)器人收集圖像它工作的環(huán)境中處理圖像特征提取全球代表場(chǎng)景。一些方法被用來(lái)分析的data-set圖像和一些基本特征發(fā)現(xiàn),如主成分分析法(PCA)。然而,主成分分析法(PCA)
不是有效的區(qū)分類(lèi)別的特征。另一種方法使用外觀特征包括顏色、紋理和邊緣密度代表圖像。例如,周劉哲用多維直方圖來(lái)描述全球外觀特征。該方法簡(jiǎn)單易行,但敏感的規(guī)模和光照變化。事實(shí)上,各種各樣的國(guó)際形象特點(diǎn)是遭受環(huán)境的變化。
LOWE[5]的篩選方法,提出了一種使用相似性描述符所形成的特點(diǎn)。不變?cè)谂d趣點(diǎn)的規(guī)模和方向來(lái)獲得特征。具有不變特征圖像縮放,平移、旋轉(zhuǎn)和部分不變光照變化。但篩選可能產(chǎn)生1 000或更多的興趣點(diǎn),這可能減慢處理器戲劇性的。
在匹配階段,最近的鄰居策略(NN)廣泛應(yīng)用于它的設(shè)施和清晰度[6]。但它無(wú)法捕捉的貢獻(xiàn)
個(gè)人特征為場(chǎng)景識(shí)別。在實(shí)驗(yàn)中,這個(gè)神經(jīng)網(wǎng)絡(luò)還不足以很好的表達(dá)相似兩種模式之間。此外,所選特征不能代表現(xiàn)場(chǎng)徹底根據(jù)嗎先進(jìn)的模式識(shí)別,使識(shí)別不可靠[7]。
在一個(gè)復(fù)雜的礦山環(huán)境。在這個(gè)系統(tǒng)中,我們通過(guò)提取顯著提高變性地方形象地區(qū)創(chuàng)建取代整個(gè)圖像處理與大的變化,規(guī)模、二維旋轉(zhuǎn)和觀點(diǎn)。興趣點(diǎn)的數(shù)量是有效降低,使加工容易。模糊識(shí)別戰(zhàn)略是為了認(rèn)識(shí)論及的地方神經(jīng)網(wǎng)絡(luò)的,可以增強(qiáng)的貢獻(xiàn)個(gè)人特征為場(chǎng)景識(shí)別。因?yàn)樗牟糠中畔⒒謴?fù)能力,隱馬爾可夫模型采用組織這些地標(biāo),可以捕捉結(jié)構(gòu)或他們之間的關(guān)系。所以場(chǎng)景識(shí)別可以轉(zhuǎn)化為評(píng)價(jià)問(wèn)題,嗯,這使得識(shí)別的魯棒性。
2凸顯當(dāng)?shù)貓D像區(qū)域檢測(cè)
研究表明,生物視覺(jué)系統(tǒng)生物(像果蠅)經(jīng)常注重一定的特殊的地區(qū),在現(xiàn)場(chǎng)行為的相關(guān)性或地方形象線索,同時(shí)觀察環(huán)境[8]。這些區(qū)域可以被看作是自然的創(chuàng)建有效地表示并區(qū)分不同環(huán)境。靈感來(lái)自于那些,我們用center-surround差分方法對(duì)檢測(cè)顯著地區(qū)在多尺度圖像空間。opponencies的顏色和紋理計(jì)算到創(chuàng)造凸極地圖。
輸入表格內(nèi)提供靜態(tài)彩色圖像命名為G0期。多尺度圖像空間G1?輪流以G4(1:1 到 1?：?64)是由方程式。(1)和(2)。
Gn0 = w *Gn?1 (1)
Gn0 n∈Gn= Subsampled[1,4] (2)
在w是一個(gè)Gaussion低通濾波器,和“*”表示卷積實(shí)現(xiàn)。讓中心是{ G1,G2 }和環(huán)境都{ G3,輪流以G4 }的定義這些材料的特性是opponency尺度之間的差異中心和環(huán)境之間通過(guò)引入“Θ”,這意味著環(huán)境插值和嗎然后減去中心像素。
計(jì)算opponencies呈現(xiàn)出希望的顏色,它是有必要把RGB空間分成RGBY空間為強(qiáng)調(diào)opponencies紅/綠和藍(lán)/黃[9]?？臻g計(jì)算
R=r?(g+b)/2
G=g?(r+b)/2
B=b?(r+g)/2
Y=(r+g)/2?|r?g|/2?b
所以,opponencies計(jì)算出的顏色
RG(c, s)=|(R(c)?G(c)) Θ (G(s)?R(s))|
BY(c, s)=|(B(c)?Y(c)) Θ (Y(s)?B(s))|
其中c∈Centers, s∈Surroundings. RG(c, s) 屬于紅和綠的對(duì)立; BY(c, s) 屬于藍(lán)和黃的對(duì)立 計(jì)算紋理opponencies,第十二濾波器因?yàn)槠淠芰x擇獲得局部最優(yōu)無(wú)論是在時(shí)間域和頻率域。研究人類(lèi)心理物理和視覺(jué)生理表明,它更像人類(lèi)的注意力機(jī)制[10]。
Gabor定理被定義為h(x, y)=g(x, y)e2πj(ux+vy). 因?yàn)榈谑^(guò)濾是極性的對(duì)稱的頻率領(lǐng)域,方向?yàn)??π能覆蓋所用的頻率空間，一般情況下有4個(gè)過(guò)程其方向?yàn)?°, 45°,90° 和 135°紋理4方向計(jì)算為
Tθ(x, y)=|Gn(x, y)*hθ(x, y)|
我們可以完成紋理方向的反方向?yàn)?
T(c, s, θ)=|Tcθ(x, y) Θ Tsθ(x, y)|
其中 c∈Centers, s∈Surroundings, θ∈{0°, 45°, 90°,135°}.
vThen所有opponencies結(jié)合根據(jù)方程式。(3)?(5)創(chuàng)造凸極圖s,定義規(guī)范操作的N(),可以發(fā)現(xiàn),在文獻(xiàn)[9]。
在重量w1及w2為此所指示的意義的顏色和紋理。我們也設(shè)計(jì)算法采用最小均方算法學(xué)習(xí)w1及參與離線。圖1(b)顯示凸極具有里程碑意義的地區(qū)獲得的位置更輕更凸現(xiàn)出來(lái)。
隨訪中,sub-image為中心的顯著位置在年代作為這個(gè)具有里程碑意義的地區(qū)。大小的這個(gè)具有里程碑意義的地區(qū)可以自適應(yīng)地確定依據(jù)的變化梯度方向的地方圖像[11]。
移動(dòng)機(jī)器人導(dǎo)航要求自然地標(biāo)應(yīng)及時(shí)發(fā)現(xiàn)當(dāng)環(huán)境穩(wěn)定在某種程度上改變。重復(fù)性驗(yàn)證在具有里程碑意義的檢測(cè)我們的方法,我們已經(jīng)做了很多實(shí)驗(yàn)對(duì)這種情況的規(guī)模、二維旋轉(zhuǎn)和觀點(diǎn)變化等。圖2顯示門(mén)查它的凸極變化時(shí)的觀點(diǎn)。更多的詳細(xì)分析和研究結(jié)果存在旋轉(zhuǎn)和比例可以被發(fā)現(xiàn)在我們以前的作品[12]。
3場(chǎng)景識(shí)別和定位
不同于其他場(chǎng)景識(shí)別系統(tǒng),我們的系統(tǒng)不需要訓(xùn)練離線。換句話說(shuō),我們的場(chǎng)景不是預(yù)先分類(lèi)。當(dāng)機(jī)器人徘徊,場(chǎng)景捕獲間隔固定的時(shí)間是用來(lái)建造它的頂點(diǎn)的拓?fù)涞貓D,代表了機(jī)器人定位的地方。雖然這個(gè)地圖的幾何布局都被定位系統(tǒng),它是有用的可視化和調(diào)試[13]嗎有利于路徑規(guī)劃。所以定位手段搜索最佳匹配的當(dāng)前場(chǎng)景在地圖上。在本文隱馬爾可夫模型是用來(lái)組織從當(dāng)前場(chǎng)景中提取的地標(biāo)和創(chuàng)造頂點(diǎn)的拓?fù)涞貓D,其局部信息恢復(fù)能力。
類(lèi)似的全景視覺(jué)系統(tǒng),機(jī)器人看起來(lái)讓omni-images周?chē)?從每一個(gè)形象,突出局部區(qū)域檢測(cè),構(gòu)成了一個(gè)序列,命名為具有里程碑意義的序列的順序是一樣的圖像序列。然后一個(gè)隱馬爾可夫模型創(chuàng)建基于這個(gè)具有里程碑意義的序列包括k突出地方形象地區(qū),這是作為描述機(jī)器人的地方位于。在我們的系統(tǒng)EVI-D70相機(jī)有±170°的視野?？紤]到重疊效果,我們樣品的環(huán)境每45°到8圖像。 讓8圖像作為隱藏狀態(tài)Si(1≤i≤8),創(chuàng)造了HMM可以說(shuō)明圖。參數(shù)對(duì),aij和bjk,實(shí)現(xiàn)了學(xué)習(xí)、使用Baulm-Welch算法[14]。 的門(mén)檻收斂設(shè)置為0.001。至于拓?fù)涞貓D的邊緣,我們將它隨著距離的兩個(gè)頂點(diǎn)之間的信息。這距離可以根據(jù)odometry計(jì)算閱讀資料。
位自身拓?fù)涞貓D,機(jī)器人必須用“眼睛”的環(huán)境和提取具有里程碑意義的序列,那么搜索在地圖上最好的匹配的頂點(diǎn)(現(xiàn)場(chǎng)。不同于傳統(tǒng)概率定位[15],在我們的系統(tǒng)定位問(wèn)題可以轉(zhuǎn)化為評(píng)價(jià)的問(wèn)題嗯。頂點(diǎn)以最大的評(píng)價(jià)值,必須大于一個(gè)閾值,作為嗎最佳匹配的頂點(diǎn),表明最機(jī)器人可能的地方。
為評(píng)估,首先我們必須準(zhǔn)備一份觀察序列順序如下。
根據(jù)相似性計(jì)算我們?cè)O(shè)計(jì)了一種新的基于模糊邏輯的比賽策略,可以發(fā)現(xiàn)在接下來(lái)的部分里。一旦觀察序列生成、評(píng)價(jià)過(guò)程計(jì)算出一個(gè)后概率值P(VT)根據(jù)Eqn。(6),在那里是一套隱藏狀態(tài)嗎序列和r指數(shù)一個(gè)特殊的隱藏狀態(tài)序列[3]。詳細(xì)分析和算法發(fā)現(xiàn)在文獻(xiàn)[4]。
4基于模糊邏輯的比賽策略
一個(gè)重要的問(wèn)題在圖像匹配問(wèn)題選擇最有效的特征,或描述代表了原始圖像。由于機(jī)器人運(yùn)動(dòng),那些提取具有里程碑意義的地區(qū)將會(huì)改變像素水平。所以,描述符或特征選擇應(yīng)不變?cè)谀撤N程度上根據(jù)變化的規(guī)模、旋轉(zhuǎn)和觀點(diǎn)等。在本文中,我們利用4一般特點(diǎn),采用社區(qū)簡(jiǎn)述如下。GO:梯度方向。已經(jīng)證明照明和旋轉(zhuǎn)的變化可能有更少影響[5]。
ASM和ENT:二階矩和角熵,這是兩個(gè)紋理描述符。
H亨利:色調(diào),用于描述基本信息的圖像。
另一個(gè)關(guān)鍵的問(wèn)題是要選擇一個(gè)比賽良好的匹配策略和算法。通常最近的鄰居策略(NN)是用來(lái)衡量相似兩種模式之間。但是我們發(fā)現(xiàn)了實(shí)驗(yàn)表明,神經(jīng)網(wǎng)絡(luò)不能充分地展現(xiàn)個(gè)人描述符或特征的貢獻(xiàn)相似性度量。圖中所示,輸入圖像圖(a)來(lái)自不同的看法圖(b)。但是Figs.4之間的距離(a)和(b)計(jì)算Jefferey差異大于圖(c)。
為了解決這個(gè)問(wèn)題,我們?cè)O(shè)計(jì)一個(gè)新的比賽給出了一種基于模糊邏輯的微妙的表現(xiàn)每個(gè)特征的變化。該算法描述下面。
使用Jefferey圖計(jì)算相似度的差異:(a)輸入形象;(b)具有里程碑意義的數(shù)據(jù)庫(kù)的索引是6和Jefferey分歧d = 7.305 2;(c)具有里程碑意義的數(shù)據(jù)庫(kù)的索引14及其Jefferey分歧d = 4.662
1) 首先所有特征fuzzifyid如下。
在這些方程N(yùn)k代表的數(shù)量象素灰度k、Npixels像素的總數(shù)的形象,Nm_GO的像素?cái)?shù)與角度學(xué)位 m 在{ GOij },Nm_H在{}。Aij代表灰色價(jià)值的像素,μk的平均程度由于通過(guò)模糊分類(lèi)灰色水平鉀、μm k角程度相當(dāng)于256個(gè)和m等于360。
2)相似性地標(biāo)是計(jì)算機(jī)使用的個(gè)人特征,分別。這關(guān)于古今特征相似度在模糊設(shè)置{ASM,ENT、GO、H }被定義為
然后我們比較地方形象和每個(gè)人都在數(shù)據(jù)庫(kù)。拒絕和rmean記錄。3)所有的相似程度的各具特色,融為一體獲得一個(gè)判斷,可由Eqn形式化(7)。
依據(jù)權(quán)重確定根據(jù)rmean?拒絕各具特色的。經(jīng)分類(lèi),然后王是指定的0.4、0.3、0.2、0.1,分別按順序在數(shù)據(jù)庫(kù)中,這個(gè)具有里程碑意義的融合相似度高于其他任何作為最好的比賽。這個(gè)比賽結(jié)果的Figs.4(b)和(c)證明了圖。顯示,該方法能測(cè)量?jī)煞N模式之間相似度的有效。
5實(shí)驗(yàn),分析
定位系統(tǒng)已經(jīng)得到了落實(shí)在一個(gè)移動(dòng)機(jī)器人,它建立在我們的實(shí)驗(yàn)室。視覺(jué)系統(tǒng)由CCD相機(jī)和一個(gè)frame-grabber下腔靜脈- 4200。 圖像的分辨率設(shè)置為400×320和采樣頻率將10幀/ s。計(jì)算機(jī)系統(tǒng)由1兆赫處理器和512米的記憶,這是所攜帶的機(jī)器人。目前該機(jī)器人工作的室內(nèi)環(huán)境。同樣的場(chǎng)景圖像區(qū)域和區(qū)分有效。表1顯示靜態(tài)識(shí)別結(jié)果環(huán)境包括5 laneways和筒倉(cāng)。十個(gè)場(chǎng)景精選每個(gè)環(huán)境和 HMMs創(chuàng)造了每一個(gè)場(chǎng)景中。收集20的場(chǎng)景當(dāng)機(jī)器人進(jìn)入各個(gè)環(huán)境后比賽60 HMMs以上。
在表格上,“真相”意味著情景局部場(chǎng)比賽對(duì)場(chǎng)景的評(píng)價(jià)價(jià)值是30%比HMM第二高評(píng)價(jià))?！安淮_定性”意味著評(píng)價(jià)HMM的價(jià)值大于第二高的評(píng)價(jià)在10%以下?！板e(cuò)誤匹配”意味著情景本地化的比賽,錯(cuò)誤的場(chǎng)景。在桌子上,比錯(cuò)誤匹配是0。但這是不可能的場(chǎng)景本地化無(wú)法匹配任何場(chǎng)景和新序列為依據(jù)被創(chuàng)造出來(lái)。此外,“比真理“關(guān)于筒倉(cāng)低,因?yàn)轱@著的球桿是減少這類(lèi)環(huán)境。
在這個(gè)時(shí)期的自動(dòng)探索,同樣的場(chǎng)景可以結(jié)合。這個(gè)過(guò)程可以概括為:
當(dāng)定位成功,當(dāng)前的地標(biāo)序列添加到隨之而來(lái)的觀察序列匹配的頂點(diǎn)un-repeatedly照他們的定位(包括角度的圖像從當(dāng)?shù)丶巴怀龅暮较驒C(jī)器人來(lái))。學(xué)習(xí)參數(shù)的HMM再一次。方法相比,使用外觀整幅圖像的特點(diǎn)(方法2，M2),我們的系統(tǒng)(M1)使用當(dāng)?shù)氐娘@著區(qū)域的定位及地圖,這使得它有更多的寬容的規(guī)模、觀點(diǎn)機(jī)器人的運(yùn)動(dòng)引起的變化,性價(jià)比高識(shí)別和更少的金額數(shù)拓?fù)涞貓D。所以,我們的系統(tǒng)具有較好的性能在動(dòng)態(tài)環(huán)境下。這些表2中可以看出。Laneways 1、2、4、5運(yùn)行有些礦工的地方在工作,這拼圖機(jī)器人。
6總結(jié)
1)局部圖像特征明顯,提取取代整個(gè)圖像參與識(shí)別,提高公差的變化在規(guī)模、2 D旋轉(zhuǎn)和觀點(diǎn)的環(huán)境形象。
2)模糊邏輯是用來(lái)認(rèn)識(shí)當(dāng)?shù)氐男蜗?并強(qiáng)調(diào)個(gè)體特征的貢獻(xiàn)識(shí)別,提高了可靠性的地標(biāo)建筑。
3)HMM用于捕獲結(jié)構(gòu)或那些當(dāng)?shù)氐膱D像之間的關(guān)系,把場(chǎng)景識(shí)別問(wèn)題轉(zhuǎn)化為評(píng)價(jià)的問(wèn)題HMM。
4)從以上實(shí)驗(yàn)結(jié)果表明該煤礦救災(zāi)機(jī)器人場(chǎng)景識(shí)別系統(tǒng)具有較高比率的識(shí)別和定位。
參考
[1] QIAN Shan-hua, GE Shi-rong, WANG Yong-sheng, LIU Chang-qing.
Research status of the disaster rescue robot and its applications to the
mine rescue [J]. Robot, 2006, 28(3): 350?354.
[2] ULRICH I, NOURBAKHSH I. Appearance based place recognition
for topological localization [C]// KHATIB Q. Proc of the IEEE
International Conference on Robotics and Automation. San Francisco,
2000: 1023?1029.
[3] ARTAC M, JOGAN M, LEONARDIS A. Mobile robot localization
using an incremental eigenspace model [C]// DUBEY R V. Proc of
the IEEE International Conference on Robotics and Automation.
Washington, 2002: 1025?1030.
[4] ZHOU C, WEI Y C, TAN T N. Mobile robot self-localization based
on global visual appearance features [C]// LUO R C. Proc of the
IEEE International Conference on Robotics and Automation. Taipei,
2003: 1271?1276.
[5] LOWE D. Object recognition from local scale invariant features [C]//
BOYER K L. Proc of the International Conference on Computer
Vision. Greece, 1999: 1150?1157.
[6] CHEN Yong-sheng, HUNG Yi-ping, YEN Ting-fang, FUH Chioushan.
Fast and versatile algorithm for nearest neighbor search based
on a lower bound tree [J]. Pattern Recognition, 2007, 40(2):
360?375.
[7] RAPTIS S N, TZAFESTAS S G. Fuzzy-probabilistic object
recognition based on edge and texture descriptors fusion [C]// JENG
Mu-de. IEEE International Conference on Systems, Man, and
Cybernetics. Nashville, USA. 2000: 1621?1626.
[8] HEISENBERG M, WOLF R. Studies of brain function [M]. Berlin,
Germany: Springer-Verlag Press, 1984.
[9] EDUARDO T, TORRAS C. Detection of nature landmarks through
multiscale opponent features [C]// LOOG M. Proc of International
Conference on Pattern Recognition. Barcelona, 2000: 3988?3991.
[10] SHENG W, XIA B. Texture segmentation method based on Gabor
ring filtering [J]. Infrared and Laser Engineering, 2003, 32(5):
484?488.
[11] MIKOLAJCZYK K, SCHMID C. Scale and affine invariant interest
point detectors [J]. International Journal of Computer Vision, 2004,
60(1): 63?86.
[12] WANG L, CAI Z X. Saliency based natural landmarks detection
under unknown environments [J]. Pattern Recognition and Artificial
Intelligence, 2006, 1(1): 52?56.
[13] GUILHERME N D, AVINASH C K. Vision for mobile robot
navigation: A survey [J]. IEEE Transaction on Pattern Analysis and
Machine Intelligence, 2002, 24(2): 1?31.
[14] DUDA R, HART P, STORK D. Pattern classification [M]. 2nd ed.
Beijing: China Machine Press, 2004.
[15] VALE A, RIBEIRO M I. A probabilistic approach for the localization
of mobile robots in topological maps [C]// KOVACIC Z. Proc of the
10th Mediterranean Conference on Control and Automation. Lisbon,
Portugal, 2002: 1244?1249.
河南理工大學(xué)萬(wàn)方科技學(xué)院
本科畢業(yè)設(shè)計(jì)（論文）中期檢查表
指導(dǎo)教師： 職 稱 ：
所在院（系）： 教研室（研究室）：
題 目
四連桿履帶式搜救機(jī)器人
學(xué)生姓名
專業(yè)班級(jí)
學(xué)號(hào)
一、選題質(zhì)量：（主要從以下四個(gè)方面填寫(xiě)：1、選題是否符合專業(yè)培養(yǎng)目標(biāo)，能否體現(xiàn)綜合訓(xùn)練要求；2、題目難易程度；3、題目工作量；4、題目與生產(chǎn)、科研、經(jīng)濟(jì)、社會(huì)、文化及實(shí)驗(yàn)室建設(shè)等實(shí)際的結(jié)合程度）
所選課題以機(jī)器人在廢墟中運(yùn)動(dòng)方式開(kāi)題，通過(guò)對(duì)運(yùn)動(dòng)結(jié)構(gòu)設(shè)計(jì)，尺寸確定，剛
度扭轉(zhuǎn)力矩的確定，驅(qū)動(dòng)力矩的選擇，貫通大學(xué)各個(gè)年級(jí)所學(xué)知識(shí)，將理論與實(shí)際結(jié)
合將自己所學(xué)到的知識(shí)升華。題目難度適中。具有非常大的發(fā)揮空間和巧活多樣的設(shè)
計(jì)思路，對(duì)于本科機(jī)設(shè)專業(yè)的學(xué)生來(lái)說(shuō)，主要是進(jìn)行四連桿履帶式搜救機(jī)器人的結(jié)構(gòu)
設(shè)計(jì)與越障能力分析，這主要是針對(duì)機(jī)械設(shè)計(jì)學(xué)生的要求，其機(jī)器人涉及各個(gè)學(xué)科且
聯(lián)系密切。四連桿履帶式搜救機(jī)器人的結(jié)構(gòu)設(shè)計(jì)主要是機(jī)器人的外形尺寸設(shè)計(jì)，內(nèi)部
零部件安置方式以及外部翻越行動(dòng)方式，此機(jī)器人采用四連桿履帶式，主要由機(jī)架對(duì)稱分布的履帶變形模塊組成。機(jī)架兩側(cè)是基于平行四邊形結(jié)構(gòu)的履帶變形模塊,主要由四連桿變形機(jī)構(gòu)，主驅(qū)動(dòng)輪，被動(dòng)輪及繞在履帶輪上的履帶組成，其中四連桿變形機(jī)構(gòu)由連桿，主動(dòng)曲柄，被動(dòng)曲柄組成，用于提供驅(qū)動(dòng)力，并且可以繞機(jī)架旋轉(zhuǎn)，實(shí)現(xiàn)履帶變形，在越障時(shí)給機(jī)器人提供額外的輔助運(yùn)動(dòng)。選題完全符合專業(yè)培養(yǎng)目標(biāo)，屬于機(jī)械設(shè)計(jì)的一種,對(duì)即將畢業(yè)的學(xué)生的再學(xué)習(xí)有著較好的指引作用, 不僅僅局限在機(jī)械基礎(chǔ)知識(shí)上更涉及了有關(guān)材料學(xué)、力學(xué)等多學(xué)科知識(shí)，使我們對(duì)交叉學(xué)科有了一定的涉足，綜合訓(xùn)練的要求也得到充分的體現(xiàn)。
二、開(kāi)題報(bào)告完成情況：
前期論文完成
從越障能力出發(fā)，進(jìn)行運(yùn)動(dòng)形式的分析，確定理想的運(yùn)動(dòng)方式，進(jìn)行結(jié)構(gòu)設(shè)計(jì)，查
閱資料，對(duì)運(yùn)動(dòng)結(jié)構(gòu)優(yōu)勢(shì)進(jìn)行分析，進(jìn)行設(shè)計(jì)工作，并在關(guān)鍵問(wèn)題有所突破，資料
整理工作已經(jīng)完成。
三、階段性成果：
1、本次設(shè)計(jì)的開(kāi)題報(bào)告已經(jīng)完成，總體布置方案和主要結(jié)構(gòu)參數(shù)已確定，并完成一些標(biāo)準(zhǔn)件的選型及和大多數(shù)零部件的設(shè)計(jì)計(jì)算工作。
2、部分零件圖的繪制已經(jīng)基本完成，設(shè)計(jì)說(shuō)明書(shū)已經(jīng)開(kāi)始整理。
3、英文翻譯工作已經(jīng)基本完成，現(xiàn)在正對(duì)一些結(jié)構(gòu)設(shè)計(jì)進(jìn)行校核。
四、存在主要問(wèn)題：
由于專業(yè)基礎(chǔ)知識(shí)學(xué)習(xí)不夠深入，設(shè)計(jì)經(jīng)驗(yàn)欠缺，參考資料收集有限，設(shè)計(jì)主題思路把握不夠，簡(jiǎn)單問(wèn)題解決不夠靈活；設(shè)計(jì)中結(jié)構(gòu)較復(fù)雜，機(jī)器人越障能力分析有一定的難度，
數(shù)據(jù)分析與變形草圖的繪制綜合分析機(jī)器人順利越過(guò)90度障礙物能力。同時(shí)機(jī)器人內(nèi)部
結(jié)構(gòu)中的電動(dòng)機(jī)，減速器，齒輪設(shè)計(jì)等細(xì)節(jié)問(wèn)題的要求以及內(nèi)部結(jié)構(gòu)安排方式，如何使得
安排即合理又正確等問(wèn)題需要進(jìn)一步解決。
五、指導(dǎo)教師對(duì)學(xué)生在畢業(yè)實(shí)習(xí)中，勞動(dòng)、學(xué)習(xí)紀(jì)律及畢業(yè)設(shè)計(jì)（論文）進(jìn)展等方面的評(píng)語(yǔ)
指導(dǎo)教師： （簽名）
年 月 日
3
萬(wàn)方科技學(xué)院機(jī)械與動(dòng)力工程系
畢業(yè)實(shí)習(xí)報(bào)告
指導(dǎo)教師：
姓 名：
班 級(jí)：
學(xué) 號(hào)：
打開(kāi)Google搜索引擎，輸入“礦難”兩個(gè)字，1,740,000例相關(guān)網(wǎng)頁(yè)，耗時(shí)0.23秒，而輸入“平安”兩個(gè)字，1,130,000例相關(guān)網(wǎng)頁(yè)，耗時(shí)0.22秒。礦難頻發(fā)，篇篇報(bào)道皆觸目驚心。往年的統(tǒng)計(jì)數(shù)據(jù)顯示，礦難中死去的礦工多達(dá)萬(wàn)人，就是在去年，也有7000人死于礦難！許多事實(shí)表明，大部分礦難其實(shí)是可以避免的，就拿常見(jiàn)的瓦斯爆炸來(lái)說(shuō)，按我國(guó)目前的防治能力和技術(shù)水平，只要把防范措施落實(shí)到位，瓦斯爆炸事故應(yīng)該有能力避免。實(shí)際經(jīng)驗(yàn)表明,超過(guò)48 小時(shí)后被困在廢墟中的幸存者存活的概率變得越來(lái)越低[1 ] 。由于災(zāi)難現(xiàn)場(chǎng)情況復(fù)雜,在救援人員自身安全得不到保證的情況下是很難進(jìn)入現(xiàn)場(chǎng)開(kāi)展救援工作的,此外,廢墟中形成的狹小空間使搜救人員甚至搜救犬也無(wú)法進(jìn)入。災(zāi)難搜救機(jī)器人可以很好地解決上述問(wèn)題。機(jī)器人可以在災(zāi)難發(fā)生后第一時(shí)間進(jìn)入災(zāi)難現(xiàn)場(chǎng)尋找幸存者,對(duì)被困人員提供基本的醫(yī)療救助服務(wù),進(jìn)入救援人員無(wú)法進(jìn)入的現(xiàn)場(chǎng)搜集有關(guān)信息并反饋給救援指揮中心等。近年來(lái),為了滿足救援工作的需要,國(guó)內(nèi)外很多研究機(jī)構(gòu)開(kāi)展了大量的研究工作,可在災(zāi)難現(xiàn)場(chǎng)廢墟中狹小空間內(nèi)搜尋的各類(lèi)機(jī)器人如可變形多態(tài)機(jī)器人、蛇形機(jī)器人等相繼被開(kāi)發(fā)出來(lái)。本文在介紹國(guó)內(nèi)外災(zāi)難搜救機(jī)器人最新研究成果及近年來(lái)災(zāi)難現(xiàn)場(chǎng)的實(shí)際使用情況的基礎(chǔ)上,根據(jù)現(xiàn)場(chǎng)使用的經(jīng)驗(yàn)教訓(xùn)提出了災(zāi)難救援機(jī)器人需要解決的一些關(guān)鍵技術(shù)問(wèn)題指出了災(zāi)難救援機(jī)器人的發(fā)展趨勢(shì)。
國(guó)內(nèi)外研究現(xiàn)狀
近十年來(lái),尤其是“911”事件之后,美國(guó)、日本等西方發(fā)達(dá)國(guó)家在地震、火災(zāi)等救援機(jī)器人的研究方面做了大量的工作,研究出了各種可用于災(zāi)難現(xiàn)場(chǎng)救援的機(jī)器人。以牽引和運(yùn)動(dòng)方式的不同搜救機(jī)器人主要可分為以下幾類(lèi):
2. 1 履帶式搜救機(jī)器人
履帶式機(jī)器人是為了滿足軍事偵察、拆除危險(xiǎn)物等作業(yè)的需要,在傳統(tǒng)的輪式移動(dòng)機(jī)器人的基礎(chǔ)上發(fā)展起來(lái)的。圖1 給出了目前國(guó)際上幾家著名機(jī)器人公司的典型產(chǎn)品,他們主要是為了滿足軍事需要而開(kāi)發(fā)的,體積普遍偏大,不太適合在倒塌的建筑物廢墟中狹小空間內(nèi)搜尋幸存者
2. 2 可變形(多態(tài)) 搜救機(jī)器人
為了能進(jìn)入狹小空間展開(kāi)搜救工作,要求機(jī)器人的體積要盡可能小,但體積小了搜索視野就會(huì)受到限制,為了解決這一矛盾,近年來(lái)在傳統(tǒng)牽引式搜救機(jī)器人平臺(tái)基礎(chǔ)上,研制出了形態(tài)可變的履帶式多態(tài)搜救機(jī)器人。圖2 為美國(guó)iRobot 公司生產(chǎn)的PackBot 系列機(jī)器人, PackBot 機(jī)器人有一對(duì)鰭形前肢,這對(duì)鰭形前肢可以幫助在崎嶇的地面上導(dǎo)航,也可以升高感知平臺(tái)以便更好地觀察。圖3 為加拿大Inuktun 公司MicroVGTV 多態(tài)搜救機(jī)器人,他可以根據(jù)搜索通道的大小及搜尋范圍的遠(yuǎn)近靈活地調(diào)整形狀和尺寸。
圖1 履帶式搜救機(jī)器人
圖2 美國(guó)iRobot 公司PackBot 多態(tài)搜救機(jī)器人
圖3 加拿大Inuktun 公司MicroVGTV 多態(tài)搜救機(jī)器人
2. 3 仿生搜救機(jī)器人
雖然履帶式可變形多態(tài)機(jī)器人可根據(jù)搜索空間的大小改變其形狀和尺寸,但受驅(qū)動(dòng)方式的限制,其體積不可能做得很小。為了滿足對(duì)更狹小空間搜索的需要,人們根據(jù)生態(tài)學(xué)原理研制出了各種體積更小的仿生機(jī)器人,其中蛇形機(jī)器人就是其中很重要的一類(lèi)。圖4 (a) 為CMU 研制的安裝在移動(dòng)平臺(tái)上的蛇形機(jī)器人,圖4 (b) 為日本大阪大學(xué)研制的蛇形機(jī)器人。我國(guó)中國(guó)科學(xué)院沈陽(yáng)自動(dòng)化研究所,國(guó)防科技大學(xué),北京航空航天大學(xué)等單位也都相繼研制出了類(lèi)似的蛇形機(jī)器人系統(tǒng)。圖4 (c) 為美國(guó)加州大學(xué)伯克利分校研制的身高不足3 cm 的蒼蠅搜救機(jī)器人。隨著技術(shù)的不斷成熟,相信蛇形、蠅形等仿生機(jī)器人會(huì)在災(zāi)難搜救工作中發(fā)揮越來(lái)越大的不可替代的特殊作用。
3. 1 搜救機(jī)器人在
“911”事件救援中的應(yīng)用
2001 年“911”事件發(fā)生后,美國(guó)國(guó)內(nèi)主要機(jī)器人生產(chǎn)公司和研究機(jī)構(gòu)都組織參加了紐約世貿(mào)大廈現(xiàn)場(chǎng)的搜救工作,他們是南佛羅里達(dá)大學(xué)機(jī)器人輔助搜尋與救援研究中心,MIT 的iRobot 公司,美國(guó)海軍的SPAWAR 研究中心,以及具有五十多年歷史的Foster - Miller 公司等。據(jù)時(shí)代周刊報(bào)道[3 ] :在最初的十天當(dāng)中,救援機(jī)器人在搜救犬、人工無(wú)法抵達(dá)的狹小或危險(xiǎn)區(qū)域找到十余具遇難者的遺體,與現(xiàn)場(chǎng)搜救工作人員找到的數(shù)量基本相同,但所花的時(shí)間卻不到現(xiàn)場(chǎng)救援人員花費(fèi)時(shí)間的一半。這次救援行動(dòng)被稱為美國(guó)歷史上救援機(jī)器人的第一次實(shí)戰(zhàn)演練,使用了當(dāng)時(shí)已經(jīng)商業(yè)化但主要是為軍事偵察、危險(xiǎn)物拆除而設(shè)計(jì)的履帶式移動(dòng)機(jī)器人。雖然取得了一定的成績(jī),但災(zāi)難現(xiàn)場(chǎng)實(shí)際使用情況表明,目前所研制的搜救機(jī)器人仍然存在不少需要解決的關(guān)鍵技術(shù)問(wèn)題。主要表現(xiàn)在機(jī)器人的移動(dòng)性、通訊問(wèn)題、智能圖像處理軟件以及人機(jī)交互能力等方面。機(jī)器人體積偏大,無(wú)法進(jìn)入狹小空間進(jìn)行搜救;廢墟上的高溫使機(jī)器人履帶軟化而無(wú)法正常行進(jìn)[2 ] ;統(tǒng)計(jì)表明,無(wú)線通訊方式的機(jī)器人有大約25 %左右的時(shí)間由于通訊問(wèn)題而無(wú)法正常工作;圖像智能識(shí)別能力不足,救援人員絕大部分時(shí)間(超過(guò)80 %) 都在用于對(duì)機(jī)器人發(fā)回圖像的分析、辨別上[4 ] ;人機(jī)交互能力差,機(jī)器人操縱困難等。
3. 2 搜救機(jī)器人在西弗吉尼亞礦難救援中的應(yīng)用
2006 年年初,美國(guó)西弗吉尼亞Sago 煤礦發(fā)生礦難,造成12 名礦工死亡。事故發(fā)生后,救援人員使用GPS 測(cè)定被困礦工的方位,然后從地面上鉆了3 個(gè)深孔,以便給井下輸送氧氣,同時(shí)期望對(duì)井下的狀況進(jìn)行檢測(cè)。救援人員分別放入空氣探測(cè)儀和攝像頭,但均無(wú)功而返。為了從水平方向?qū)虑闆r進(jìn)行探測(cè),美國(guó)勞工部礦業(yè)安全與衛(wèi)生局通過(guò)深孔向井下派出了一個(gè)救援機(jī)器人,但最終因機(jī)器人中途行進(jìn)過(guò)程中陷入泥潭而受阻。
搜救機(jī)器人關(guān)鍵技術(shù)問(wèn)題及發(fā)展趨勢(shì)
災(zāi)難搜救機(jī)器人是一個(gè)新興的研究領(lǐng)域,其使用環(huán)境的特殊性對(duì)機(jī)器人硬件和軟件兩方面都提出了更高的要求,目前在該領(lǐng)域仍存在很多需要不斷探索的技術(shù)難題。
4. 1 硬 件
4. 1. 1 移動(dòng)性/ 機(jī)械機(jī)構(gòu)
移動(dòng)性是搜救機(jī)器人完成搜救工作的決定因素,“911”事件后紐約世貿(mào)大廈現(xiàn)場(chǎng)的搜救工作以及西弗吉尼亞Sago 煤礦的礦難救援工作都很好地證明了這一點(diǎn)。機(jī)器人移動(dòng)平臺(tái)應(yīng)該能夠在惡劣廢墟環(huán)境中靈活地穿梭于狹小的空間之中,能夠翻越障礙,爬樓梯,穿越泥濘的道路等,且機(jī)器人的移動(dòng)不應(yīng)對(duì)周?chē)环€(wěn)定結(jié)構(gòu)產(chǎn)生影響,以免發(fā)生二次坍塌或爆炸等。此外,機(jī)器人還應(yīng)該具備適應(yīng)惡劣環(huán)境的能力,具有防水、耐高溫等能力。早期為軍用目的而設(shè)計(jì)的輪履式機(jī)器人由于體積偏大而不太適合搜救工作。目前,各種履帶式多態(tài)可變形小型機(jī)器人已經(jīng)研制出來(lái), 并已商業(yè)化。近年來(lái), 特別是2000 年以來(lái),以蛇形機(jī)器人為代表的仿生機(jī)器人正在成為新的研究熱點(diǎn),且已經(jīng)取得不少突破性研究成果。
4. 1. 2 傳感檢測(cè)裝置
搜救機(jī)器人的主要工作就是通過(guò)傳感器實(shí)現(xiàn)自身的導(dǎo)航、環(huán)境信息的獲取以及幸存人員的搜尋。由于災(zāi)難現(xiàn)場(chǎng)環(huán)境的復(fù)雜性及不確定性,傳統(tǒng)在室內(nèi)結(jié)構(gòu)化環(huán)境中已較成熟的導(dǎo)航算法無(wú)法滿足救援工作的要求,傳統(tǒng)的聲納、激光測(cè)距儀等在充滿煙霧和灰塵的環(huán)境中也很難取得理想的效果。目前搜救機(jī)器人主要采用人工控制方式來(lái)實(shí)現(xiàn)機(jī)器人的導(dǎo)航。災(zāi)難現(xiàn)場(chǎng)環(huán)境信息是確定最佳救援
方案,確保救援人員自身安全的關(guān)鍵,常見(jiàn)的環(huán)境參數(shù)主要有有害氣體含量、空氣質(zhì)量、是否有火災(zāi)發(fā)生等。被困人員的搜尋是搜救機(jī)器人的最主要任務(wù)。目前通常通過(guò)對(duì)視頻圖像的監(jiān)測(cè)來(lái)識(shí)別是否有被困人員,但由于被困人員身上被灰塵所覆蓋,使其被隱藏于周?chē)沫h(huán)境中,傳統(tǒng)的彩色圖像分割和區(qū)域檢測(cè)方法通常會(huì)失效。移動(dòng)對(duì)象檢測(cè)及紋理識(shí)別等也是常用的檢測(cè)方法。近來(lái)熱成像照相技術(shù)在幸存者檢測(cè)方面取得了不錯(cuò)的研究成果。發(fā)現(xiàn)被困人員后需要迅速判斷其是否還活著,生命體征檢測(cè)裝置的研制近年來(lái)成為了研究的熱點(diǎn)。南佛羅里達(dá)大學(xué)Murphy 教授領(lǐng)導(dǎo)的機(jī)器人團(tuán)隊(duì)已開(kāi)發(fā)出了多個(gè)非介入式生命體征檢測(cè)傳感器[10 ] ,用于判斷被困人員的生存狀況。
4. 1. 3 人機(jī)通訊方式
目前機(jī)器人與操作者之間常用的通信方式有無(wú)線和電纜兩種方式。電纜方式可以通過(guò)線纜方便地為機(jī)器人提供能量,穩(wěn)定可靠地實(shí)現(xiàn)機(jī)器人和操作者之間的信息傳送,且當(dāng)機(jī)器人遇阻時(shí)通過(guò)拖拽使機(jī)器人重新投入工作。但電纜方式也存在一定的問(wèn)題,隨著機(jī)器人搜尋范圍的深入,線纜很容易發(fā)生纏繞而影響機(jī)器人的移動(dòng)性。研制收放靈活的電纜卷繞裝置是解決目前有線通信方式機(jī)器人通訊問(wèn)題的關(guān)鍵。
無(wú)線通訊方式的穩(wěn)定性較難保證,即使在穿透性能最佳的頻段,也會(huì)由于帶寬及各種干擾的影響使得通訊無(wú)法正常進(jìn)行。“911”事件的救援工作證明,無(wú)線方式的機(jī)器人大約有25 %以上的時(shí)間無(wú)法正常通訊。穩(wěn)定可靠的通訊方式是當(dāng)前救援機(jī)器人領(lǐng)域需要很好解決的關(guān)鍵問(wèn)題之一。
4. 2 軟 件
4. 2. 1 人機(jī)交互和用戶界面在災(zāi)難現(xiàn)場(chǎng),搜救機(jī)器人的操作者精神高度緊張且需要長(zhǎng)時(shí)間連續(xù)高負(fù)荷工作,因此良好的人機(jī)交互系統(tǒng)是提高搜救效率、減輕救援人員工作強(qiáng)度的保證。人機(jī)交互是通過(guò)良好的用戶接口來(lái)實(shí)現(xiàn)的,因此,該接口必須為操作者提供豐富的信息,從而使操作者能夠做出最佳判斷來(lái)對(duì)機(jī)器人進(jìn)行控制,通過(guò)該人機(jī)接口,操作者能很容易地判斷機(jī)器人的位置、狀態(tài)等,能夠靈活地對(duì)機(jī)器人本身以及其所攜帶的有關(guān)裝置如攝像頭、照明裝置等進(jìn)行控制。為了設(shè)計(jì)出友好的人機(jī)交互接口,設(shè)計(jì)人員必須對(duì)搜救過(guò)程中救援人員對(duì)機(jī)器人的使用情況進(jìn)行充分的了解。南佛羅里達(dá)大學(xué)Murphy 教授領(lǐng)導(dǎo)的機(jī)器人團(tuán)隊(duì)在此方面已做了大量的調(diào)研工作。
4. 2. 2 傳感器融合
由于救援現(xiàn)場(chǎng)環(huán)境的復(fù)雜性,對(duì)傳統(tǒng)的室內(nèi)結(jié)構(gòu)化環(huán)境下傳感器數(shù)據(jù)的處理算法不能滿足搜救工作的需要。如通過(guò)視頻圖像對(duì)幸存者的檢測(cè),由于灰塵、煙霧等的影響使得識(shí)別變得非常困難,通過(guò)檢測(cè)到聲音的方向辨別幸存者的方位,也由于現(xiàn)場(chǎng)噪音的影響而變得很困難。因此,為了完成搜索并發(fā)現(xiàn)幸存者,必須通過(guò)多種傳感器數(shù)據(jù)的融合,研究更加有效的識(shí)別算法。
4. 2. 3 機(jī)器人搜救隊(duì)
由于災(zāi)難現(xiàn)場(chǎng)環(huán)境的復(fù)雜性,需要各種不同的搜救機(jī)器人參與救援工作,如MCU 研制的通過(guò)具有較強(qiáng)越障能力的輪式機(jī)器人攜帶蛇行機(jī)器人來(lái)完成救援工作的機(jī)器人。為了縮減搜索遍歷時(shí)間,組建機(jī)器人搜救隊(duì)是行之有效的辦法,各機(jī)器人之間相互協(xié)調(diào)來(lái)快速完成搜索工作。目前有不少研究機(jī)構(gòu)在開(kāi)展多機(jī)器人未知環(huán)境探索算法的研究工作,并已經(jīng)有基于結(jié)構(gòu)化未知環(huán)境搜索的系統(tǒng)問(wèn)世[12 ] ,但要真正用于實(shí)際救援環(huán)境還有很多工作要做。
4. 2. 4 傳統(tǒng)移動(dòng)機(jī)器人技術(shù)的局限性
移動(dòng)機(jī)器人在室內(nèi)結(jié)構(gòu)化環(huán)境下的導(dǎo)航、定位、路徑規(guī)劃、地圖建立以及未知環(huán)境探索等技術(shù)經(jīng)過(guò)長(zhǎng)期的研究已經(jīng)基本成熟,但要用于災(zāi)難現(xiàn)場(chǎng)的非結(jié)構(gòu)化復(fù)雜未知環(huán)境的探索還需要進(jìn)行更深入的研究。目前搜救機(jī)器人的控制方式主要以手工操作為主,不追求機(jī)器人的完全自治。但為了提高救援水平,縮短搜索時(shí)間,完全自主的搜救機(jī)器人,尤其是自主機(jī)器人搜救隊(duì)將是發(fā)展的方向。
隨著現(xiàn)代科學(xué)技術(shù)的發(fā)展，特別是電子信息技術(shù)的突飛猛進(jìn)，機(jī)器人作為人類(lèi)的新型生產(chǎn)工
具，在減輕勞動(dòng)強(qiáng)度，提高生產(chǎn)率，改變?nèi)说纳a(chǎn)模式，把人從危險(xiǎn)、惡劣、繁重的工作環(huán)境中解放出來(lái)等方面，顯示出了極大的優(yōu)越性。機(jī)器人在地面的移動(dòng)方式有多種：車(chē)輪式、履帶式、輪履結(jié)合式和步行式等。步行移動(dòng)方式模仿人類(lèi)或動(dòng)物的行走機(jī)理，用腿腳走路，對(duì)環(huán)境的適應(yīng)性好，智能程度相對(duì)也較高。但是步行移動(dòng)方式的結(jié)構(gòu)和控制比較復(fù)雜，相對(duì)于比賽用機(jī)器人來(lái)說(shuō)速度慢，所以一般不選用。下面對(duì)車(chē)輪式、履帶式和輪履結(jié)合式三種移動(dòng)方式做一些說(shuō)明。
1 輪式結(jié)構(gòu)的分析
利用車(chē)輪移動(dòng)是最常見(jiàn)的一種地面行進(jìn)方式。輪式驅(qū)動(dòng)機(jī)構(gòu)移動(dòng)方式的優(yōu)點(diǎn)是：
速穩(wěn)定，能量利用率高，機(jī)構(gòu)和控制簡(jiǎn)單，而且現(xiàn)有技術(shù)比較成熟。它的缺點(diǎn)是：對(duì)路面要求較高，適用于平整的硬質(zhì)道路，不能很好的適應(yīng)場(chǎng)地。輪式移動(dòng)機(jī)構(gòu)可以達(dá)到較高的運(yùn)動(dòng)速度，在相對(duì)平坦的地面上，輪式移動(dòng)具有相當(dāng)?shù)膬?yōu)勢(shì)，控制也相對(duì)簡(jiǎn)單。輪式移動(dòng)機(jī)構(gòu)由于應(yīng)用廣泛，是目前研究最為透徹的移動(dòng)機(jī)構(gòu)之一。傳統(tǒng)的輪式移動(dòng)機(jī)構(gòu)有三輪、四輪、六輪的結(jié)構(gòu)形式，日本還曾研究出五輪移動(dòng)機(jī)構(gòu)。但輪式移動(dòng)機(jī)構(gòu)的缺點(diǎn)也是很明顯的。由于與地面接觸面積小，在爬坡時(shí)容易出現(xiàn)打滑現(xiàn)象。要想解決打滑需要加裝減速箱或用動(dòng)力制動(dòng)的方法實(shí)現(xiàn)動(dòng)態(tài)調(diào)整過(guò)程。但其通過(guò)性和越障能力受到限制，在攀爬樓梯時(shí)一般要求前輪半徑要大于樓梯高度，底盤(pán)最低點(diǎn)距地面高度限制了地面通過(guò)性。為適應(yīng)復(fù)雜地形甚至于爬樓梯的要求，必須加大輪子直徑，導(dǎo)致底盤(pán)結(jié)構(gòu)體積龐大，重量增加。
從理論上講，三點(diǎn)決定一個(gè)平面，因此車(chē)輪式移動(dòng)載體的平穩(wěn)運(yùn)動(dòng)最少需要3個(gè)輪子支撐?，F(xiàn)在大多數(shù)機(jī)器人用的是3輪或4輪移動(dòng)方式，在某些特殊情況下也有用5輪以上的，但這種情況下機(jī)器人的結(jié)構(gòu)和控制會(huì)更加的復(fù)雜，這對(duì)我們技術(shù)有限的大學(xué)生機(jī)器人隊(duì)伍來(lái)數(shù)是不太適用的。因此我們會(huì)選擇3輪或4輪的移動(dòng)方式，下面對(duì)此進(jìn)行討論。
（1）3輪移動(dòng)配置和操舵方式
典型3輪移動(dòng)機(jī)器人通常采用1個(gè)中心前輪和2個(gè)后輪的車(chē)輪布置。3個(gè)車(chē)輪配置與功能
的不同組合有可以將3輪機(jī)器人分為如圖1所示的若干類(lèi)型
圖1（a）所示的組合是前輪1為萬(wàn)向腳輪或球形輪，后輪2和后輪3為獨(dú)立驅(qū)動(dòng)輪，利
用它們的轉(zhuǎn)速差實(shí)現(xiàn)轉(zhuǎn)向。這種組合的特點(diǎn)是機(jī)構(gòu)組合容易，而且當(dāng)兩個(gè)驅(qū)動(dòng)輪以相同速
度、相反方向轉(zhuǎn)動(dòng)時(shí)車(chē)體能繞兩個(gè)驅(qū)動(dòng)輪連線的中點(diǎn)自轉(zhuǎn)，但自傳中心與車(chē)體中心不一致。
圖1（b）所示的組合是操縱舵機(jī)機(jī)構(gòu)和驅(qū)動(dòng)機(jī)構(gòu)集中在前輪1上，兩個(gè)后輪之起支撐從動(dòng)作用。與圖1（c）相比，該機(jī)構(gòu)也能繞兩后輪連線的中點(diǎn)自轉(zhuǎn)，但其前輪驅(qū)動(dòng)集中，結(jié)構(gòu)比較復(fù)雜。
圖1（c）所示的組合是前輪1為操舵輪，后輪2和后輪3中的一個(gè)為驅(qū)動(dòng)輪，另一個(gè)為從動(dòng)輪。這種車(chē)輪機(jī)構(gòu)的特點(diǎn)是結(jié)構(gòu)簡(jiǎn)單，組成容易，但單邊驅(qū)動(dòng)的驅(qū)動(dòng)性差，穩(wěn)定性不好，不能自傳。
圖1（d）的車(chē)輪組合將圖1（c）的單輪驅(qū)動(dòng)該為雙后輪差動(dòng)驅(qū)動(dòng)，提高了驅(qū)動(dòng)性，但
加了一個(gè)差動(dòng)齒輪裝置，結(jié)構(gòu)更加復(fù)雜，也增加了質(zhì)量。
（2） 4輪移動(dòng)配置和操舵方式
3輪式機(jī)器人車(chē)體配置雖然結(jié)構(gòu)簡(jiǎn)單，但穩(wěn)定性差，遇到?jīng)_撞或地面不平時(shí)容易傾
倒。與3輪機(jī)構(gòu)相比4輪移動(dòng)方式的穩(wěn)定性更好。
4輪移動(dòng)機(jī)構(gòu)的典型配置形式如圖2所示。圖2（a）的組合是前后輪為萬(wàn)向腳輪或球形輪，左右兩輪為獨(dú)立驅(qū)動(dòng)輪。與圖1（a）的3輪車(chē)體相比，其自轉(zhuǎn)中心與車(chē)體中心重合，當(dāng)兩個(gè)驅(qū)動(dòng)輪以相反速度方向轉(zhuǎn)動(dòng)時(shí)，車(chē)體能繞自身的中心自轉(zhuǎn)，所以便于在狹窄場(chǎng)所改變方向。這種車(chē)輪布置方式在靈活性和穩(wěn)定性上都是比較好的，在比賽中也有采用這種方式的。但它的缺點(diǎn)是前后輔助腳輪有時(shí)不能同時(shí)著地支撐，在高速啟動(dòng)和剎車(chē)時(shí)車(chē)體會(huì)產(chǎn)生俯仰和前沖，為了克服啟動(dòng)和剎車(chē)時(shí)的俯仰和前沖，應(yīng)當(dāng)盡量將車(chē)體的中心配置在兩個(gè)驅(qū)動(dòng)輪連線的近旁，減少慣性的影響。
圖2（b）是常見(jiàn)的所謂汽車(chē)車(chē)輪配置方式。它與圖1（d）所示的3輪車(chē)驅(qū)動(dòng)方式類(lèi)似，只是將前面一個(gè)操舵輪改為兩個(gè)輪，提高力車(chē)體的穩(wěn)定性。兩個(gè)操舵輪需要同一個(gè)操舵機(jī)構(gòu)來(lái)協(xié)調(diào)轉(zhuǎn)向，此外為了減少后輪的摩擦損耗，配備了差動(dòng)齒輪裝置，增加了機(jī)構(gòu)的復(fù)雜性。
綜上所述，為了既要滿足車(chē)體穩(wěn)定性，又要使得車(chē)體具有較
靈活的機(jī)動(dòng)性能，同時(shí)還要使得車(chē)體結(jié)構(gòu)盡量簡(jiǎn)單而且還有比較容
易控制，我們采用圖3所示的車(chē)輪配置方式，這種車(chē)輪的布局方式也是在借鑒了2009年機(jī)器人車(chē)輪的分布形式再結(jié)合今年的實(shí)際情而最終確定的，前面兩個(gè)萬(wàn)向輪起到了以下三個(gè)作用：1）支撐作用；2）導(dǎo)向作用；3）自動(dòng)調(diào)整機(jī)器人的平穩(wěn)。采用四個(gè)車(chē)輪可以更好的保持機(jī)器人的穩(wěn)定性，為了保證機(jī)器人能夠四個(gè)輪能夠同時(shí)著地，我們給兩個(gè)導(dǎo)向輪增加了一個(gè)彈簧裝置，這樣機(jī)器人在遇到路面不平的時(shí)候能夠很好的依靠彈簧的彈力進(jìn)行自我調(diào)整。
2 履帶式結(jié)構(gòu)的分析
履帶式結(jié)構(gòu)實(shí)際上是一種自己為自己鋪路的輪式結(jié)構(gòu)。它是將環(huán)狀的循環(huán)軌道履帶卷
繞在若干滾輪外，是車(chē)輪不直接與地面接觸。最常見(jiàn)的履帶移動(dòng)車(chē)是在車(chē)體的兩側(cè)各設(shè)有一對(duì)履帶驅(qū)動(dòng)裝置的雙履帶結(jié)構(gòu)。也有為了適應(yīng)復(fù)雜的路況而采用多履帶的。在比賽中由于路面不是很復(fù)雜，所以制作起來(lái)比較簡(jiǎn)單，就是將履帶卷繞在兩個(gè)以上的車(chē)輪上，其中一個(gè)車(chē)輪用來(lái)做驅(qū)動(dòng)輪，其余的車(chē)輪作張緊輪或?qū)蜉?。?qū)動(dòng)輪通常靠自身的齒與履帶內(nèi)側(cè)的齒形嚙合來(lái)驅(qū)動(dòng)。典型的履帶移動(dòng)機(jī)構(gòu)由驅(qū)動(dòng)輪、導(dǎo)向輪、托帶輪、履帶、履帶架等部分組成。履帶移動(dòng)機(jī)構(gòu)適合在復(fù)雜路面上行駛，它是輪式移動(dòng)機(jī)構(gòu)的拓展，履帶本身起著給車(chē)輪連續(xù)鋪路的作用。
履帶的優(yōu)點(diǎn)是著地面積比車(chē)輪式大，所以著地壓強(qiáng)?。涣硗馀c地面粘著力較強(qiáng)，能吸收較小的凹凸不平，攀爬能力強(qiáng)，適用于有突變的地面，能夠原地旋轉(zhuǎn)，重心低，穩(wěn)定。因此，履帶式適合于各種場(chǎng)地。
履帶車(chē)輛和輪式車(chē)輛的特性有所不同。主要的不同在轉(zhuǎn)向特性上。履帶車(chē)輛的轉(zhuǎn)向通過(guò)兩側(cè)履帶的差速進(jìn)行轉(zhuǎn)向。履帶式轉(zhuǎn)彎不如車(chē)輪式靈活。在要改變方向時(shí)，須要將某一側(cè)的履帶驅(qū)動(dòng)系統(tǒng)減速或制動(dòng)來(lái)實(shí)現(xiàn)轉(zhuǎn)彎，或者反向驅(qū)動(dòng)車(chē)體的原地自傳。這都會(huì)使履帶與地面產(chǎn)生相對(duì)橫向滑動(dòng)，加大了機(jī)器人電機(jī)的能耗。在負(fù)重大的情況下可使電機(jī)溫度迅速升高影響電機(jī)的使用和壽命。履帶車(chē)的受力比較復(fù)雜，作用力可能是靜態(tài)的也有可能是動(dòng)態(tài)的。車(chē)輛以常速運(yùn)動(dòng)時(shí)，靜態(tài)力作用。加速運(yùn)動(dòng)時(shí)，受動(dòng)態(tài)力作用。車(chē)輛轉(zhuǎn)彎時(shí)，將產(chǎn)生離心力，推動(dòng)車(chē)輛橫向移動(dòng)，動(dòng)態(tài)力總是作用在車(chē)輛質(zhì)心處。
3 輪履結(jié)合式的分析
機(jī)器人行走系統(tǒng)是完成移動(dòng)動(dòng)作的直接保證，設(shè)計(jì)的優(yōu)劣直接影響機(jī)器人性能發(fā)揮，尤其對(duì)機(jī)器人運(yùn)動(dòng)可靠性有很大要求。為克服普通履帶式移動(dòng)機(jī)構(gòu)的缺點(diǎn)，主要通過(guò)改變履帶的形狀和結(jié)構(gòu)來(lái)實(shí)現(xiàn)，卡特比勒（Catepillar）式、形狀可變履帶、位置可變履帶、履帶式加裝前后擺等結(jié)構(gòu)形式相繼出現(xiàn)，并應(yīng)用于各種機(jī)器人的移動(dòng)機(jī)構(gòu)。近年來(lái)各種增強(qiáng)的非金屬?gòu)?fù)合材料應(yīng)用于履帶，大大減輕了履帶式移動(dòng)機(jī)構(gòu)笨重的缺點(diǎn)，改善了其整體性能，對(duì)復(fù)雜環(huán)境，履帶式移動(dòng)機(jī)構(gòu)具有較強(qiáng)的地形適應(yīng)性。
本文將介紹一種輪履結(jié)合式的結(jié)構(gòu)。出于對(duì)重量和經(jīng)濟(jì)性的考慮，可選用標(biāo)準(zhǔn)同步帶代替履帶作為行走系統(tǒng)的主要部件。同步帶有梯形齒和弧齒兩種齒形，均有標(biāo)準(zhǔn)可選。我們用的是8M圓弧齒同步帶輪作為履帶。
履帶旁邊的輪比履帶高出五毫米，在平地上行走時(shí)履帶不著地只起到傳動(dòng)的作用，只有輪在著地，所以此時(shí)機(jī)器人具有輪式的特性，當(dāng)機(jī)器人要越障或過(guò)坡時(shí)履帶也著地，此時(shí)機(jī)器人又具有履帶式的特性。通過(guò)實(shí)驗(yàn)發(fā)現(xiàn)此種結(jié)構(gòu)明顯改變了履帶與地面的摩擦力，行走同樣的距離電機(jī)不再發(fā)熱，減輕了電機(jī)的負(fù)擔(dān)，延長(zhǎng)了電機(jī)的使用壽命，電機(jī)工作時(shí)間是履帶式的一半。
輪履復(fù)合式移動(dòng)平臺(tái)克服單一移動(dòng)平臺(tái)的缺陷，具有以上兩種移動(dòng)平臺(tái)的優(yōu)點(diǎn)。其缺點(diǎn)是結(jié)構(gòu)設(shè)計(jì)復(fù)雜，控制及運(yùn)動(dòng)規(guī)劃要求高。
4 驅(qū)動(dòng)方式的選擇
底盤(pán)的驅(qū)動(dòng)部分就相當(dāng)于人的兩條腿，機(jī)器人的移動(dòng)都是靠此部分來(lái)實(shí)現(xiàn)的，所以，這部分是機(jī)器人裝置中很重要的一部分。驅(qū)動(dòng)方面是各個(gè)高校都正在執(zhí)著鉆研的一個(gè)問(wèn)題，驅(qū)動(dòng)的合理與否直接關(guān)系到機(jī)器人在場(chǎng)地上能否從啟動(dòng)區(qū)準(zhǔn)確到達(dá)目的地，這種決定性的作用在機(jī)器人運(yùn)行過(guò)程中體現(xiàn)的最為明顯，每年都有許多所學(xué)校的機(jī)器人在場(chǎng)地上跑離白線，這不僅僅是控制技術(shù)方面的問(wèn)題，在機(jī)械方面往往由于輪子安裝精度達(dá)不到要求帶來(lái)許多控制上無(wú)法克服的約束。良好的機(jī)械產(chǎn)品能有效地保護(hù)電機(jī)，延長(zhǎng)電機(jī)的使用壽命，這從經(jīng)濟(jì)的角度來(lái)講是完全有必要的，而且能使電機(jī)的功率發(fā)揮到極致，傳動(dòng)效率高。同是也避免了給操作員帶來(lái)不必要的麻煩?？梢?jiàn)驅(qū)動(dòng)方面的設(shè)計(jì)安裝在機(jī)器人總的設(shè)計(jì)制作過(guò)程中占有相當(dāng)重要的地位。
為了便于確定這部分的驅(qū)動(dòng)系統(tǒng)，首先先介紹一下2007年某校機(jī)器人驅(qū)動(dòng)部分的傳動(dòng)系統(tǒng)。07年參賽機(jī)器人的傳動(dòng)系統(tǒng)有以下部分組成；直流電機(jī)、電機(jī)座、軸承、軸承座、聯(lián)軸器、軸和車(chē)輪。電機(jī)通過(guò)聯(lián)軸器并且在軸承的輔助作用下來(lái)帶動(dòng)車(chē)輪的旋轉(zhuǎn)運(yùn)動(dòng)。這套傳動(dòng)系統(tǒng)從總體上來(lái)說(shuō)還是不錯(cuò)的，但是在制作與安裝過(guò)程中遇到許多的問(wèn)題，最主要的就是同軸度問(wèn)題，它包括電機(jī)軸、軸承、軸承座、聯(lián)軸器、軸及車(chē)輪的同軸度問(wèn)題，還包括兩個(gè)車(chē)輪同軸度的問(wèn)題。若前者同軸度較低就會(huì)造成聯(lián)軸器的扭斷，因?yàn)槁?lián)軸器是一種彈性聯(lián)軸器，當(dāng)扭矩較大時(shí)就會(huì)扭斷，當(dāng)然這也是對(duì)電機(jī)的一種保護(hù)。在實(shí)際中聯(lián)軸器的扭斷給機(jī)械上的維護(hù)帶來(lái)很大的麻煩。后者同軸度較低則會(huì)使得機(jī)器人在行走直線時(shí)發(fā)生走偏的現(xiàn)象。所以在參照了2007年機(jī)器人驅(qū)動(dòng)系統(tǒng)的基礎(chǔ)上，我們決定改變這種傳動(dòng)方式。
而齒輪傳動(dòng)不僅能夠獲得較大的傳動(dòng)比，提高機(jī)器人的速度，而且還使得機(jī)器人的結(jié)構(gòu)更加的緊湊。一級(jí)齒輪傳動(dòng)的效率可以達(dá)到99%，這對(duì)電能的利用率很高。齒輪傳動(dòng)將同軸度的問(wèn)題解決的很好，首先大齒輪安裝在電機(jī)軸上，小齒輪、軸承、軸承座和車(chē)輪安裝在同一根軸上，然后大齒輪和小齒輪進(jìn)行嚙合，由于安裝在同一根軸上，所以同軸度很高，這樣單邊的同軸度問(wèn)題得到了解決。再來(lái)看兩個(gè)車(chē)輪是如何保證同軸度的，為了更好的保證兩輪的同軸度，我們將兩輪安裝在通一根梁上，這樣兩輪就能夠很好的保證同軸度，而且還能夠使得這個(gè)驅(qū)動(dòng)系統(tǒng)模塊化。如圖8所示，兩個(gè)電機(jī)交錯(cuò)排列既保證了電機(jī)的安裝又使得結(jié)構(gòu)更加緊湊，而且質(zhì)量分布也比較均勻，在機(jī)械維護(hù)方面也更加的方便。
除了前面提到的傳動(dòng)方式，還可以采用同步帶傳動(dòng)。兩車(chē)輪通過(guò)一根軸相聯(lián)接，在電機(jī)和車(chē)輪上分別裝有同步帶輪，兩同步帶輪靠同步帶聯(lián)接，同步帶中心距不變，同步帶的張緊是靠張緊輪來(lái)實(shí)現(xiàn)的，同步帶傳動(dòng)中設(shè)置有張緊輪，采用同步帶傳動(dòng)時(shí)必須提供預(yù)緊，否則，會(huì)出現(xiàn)跳齒現(xiàn)象，不利于實(shí)現(xiàn)機(jī)構(gòu)的同步運(yùn)動(dòng)。這種傳動(dòng)方式也解決了同軸度問(wèn)題，而且由于同步帶有彈性，對(duì)電機(jī)有很好的保護(hù)。采用同步帶傳動(dòng)的好處在于：1)、機(jī)器人的啟動(dòng)為軟啟動(dòng)，沖擊小、噪聲小、運(yùn)行平穩(wěn)，電機(jī)損耗??；2)、安裝精度要求低，容易調(diào)試。隨著計(jì)算機(jī)技術(shù)和控制技術(shù)發(fā)展的，運(yùn)動(dòng)規(guī)劃技術(shù)的日漸成熟，復(fù)合式移動(dòng)平臺(tái)因其優(yōu)越的越障性能和運(yùn)動(dòng)速度，將會(huì)越來(lái)越受到各院校同學(xué)的高度重視，各種新穎的移動(dòng)平臺(tái)將層出不窮。
步足式仿生機(jī)器人是機(jī)器人研究領(lǐng)域最先研究的對(duì)象之一, 近十幾年, 隨著計(jì)算機(jī)等硬件設(shè)備的發(fā)展和設(shè)計(jì)領(lǐng)域的創(chuàng)新, 各國(guó)對(duì)足式機(jī)器人的研究明顯增多。文獻(xiàn)1 對(duì)腿式機(jī)器人的發(fā)展?fàn)顩r作了較為全面的概述, 美、日、德等國(guó)先后有許多典型的足式試驗(yàn)機(jī)器人先后問(wèn)世, 比較著名的是日本東京工業(yè)大學(xué)的泰坦VIII 型, 德國(guó)的四足機(jī)器人BISAM, 上海交通大學(xué)的四足機(jī)器人JTUWM- III 等。
地面移動(dòng)機(jī)器人按照行走方式的不同可以分為輪/ 履式腿式和蠕動(dòng)式。其中蠕動(dòng)式機(jī)器人主要在細(xì)微管道中應(yīng)用, 在其它領(lǐng)域則廣泛應(yīng)用輪/ 履式機(jī)器人和腿式機(jī)器人。輪/ 履式機(jī)器人由于其結(jié)構(gòu)簡(jiǎn)單、容易控制, 并且輪/ 履驅(qū)動(dòng)方式技術(shù)成熟, 一直是機(jī)器人研究的主要方向。但隨著人們的需求和技術(shù)的發(fā)展, 輪/ 履式機(jī)器人的局限性日益體現(xiàn)了出來(lái):應(yīng)付地形勘測(cè)、災(zāi)害救援等復(fù)雜地形上的任務(wù)輪式機(jī)器人已力不從心, 腿式機(jī)器人就成為新的研究重點(diǎn)。與輪/ 履式機(jī)器人相比, 腿式機(jī)器人有著很大的優(yōu)勢(shì):⑴腿式機(jī)器人的行進(jìn)軌跡是離散的點(diǎn), 這使它在執(zhí)行任務(wù)時(shí)有著很強(qiáng)的通過(guò)力和機(jī)動(dòng)性; ⑵腿式機(jī)器人的腿部結(jié)構(gòu)使它可以有效的自主隔振, 從而保護(hù)其身上的元器件和重要儀器不受損壞; ⑶輪/ 履式機(jī)器人的前進(jìn)所需的牽引力受重力影響, 從而使它不可能完成在垂直于地面的平面上工作, 而腿式機(jī)器人只要稍加改進(jìn), 例如安裝吸附裝置就可以做到鉛錘方向的移動(dòng)。
四腿機(jī)器人的運(yùn)動(dòng)規(guī)劃
3.1 單腿運(yùn)動(dòng)的分解
機(jī)器人的每條腿都安裝了兩部伺服馬達(dá), 上方的馬達(dá)與機(jī)身鉸接, 通過(guò)馬達(dá)的轉(zhuǎn)動(dòng)實(shí)現(xiàn)腿部相對(duì)機(jī)身的前/ 后扭轉(zhuǎn); 下方的馬達(dá)則與腿部連桿機(jī)構(gòu)鉸接, 馬達(dá)的往復(fù)擺動(dòng)帶動(dòng)連桿機(jī)構(gòu), 實(shí)現(xiàn)步足的上/ 下起落。
3.2 四腿復(fù)合運(yùn)動(dòng)規(guī)劃
四腿機(jī)器人的運(yùn)動(dòng)方式分為兩種, 即靜態(tài)步行方式(三腿支撐一腿行進(jìn))和動(dòng)態(tài)步行方式(步行過(guò)程任意時(shí)刻均少于三條腿同時(shí)處于支撐狀態(tài)的步行方式)。
本文研究的機(jī)器人為了滿足不同的性能要求而采用了不同的步行方式:
當(dāng)要求保證機(jī)器人在行進(jìn)中保持靜態(tài)穩(wěn)定, 或要求行走在崎嶇不平的路面, 此時(shí)采用靜態(tài)步行法。在運(yùn)動(dòng)的任一時(shí)刻至少有三條腿與地面接觸支撐機(jī)體, 且機(jī)體的中心必須落在三足支撐點(diǎn)構(gòu)成的三角形區(qū)域內(nèi)。然后按1342 的順序抬起和落地,實(shí)現(xiàn)行走。雖然靜態(tài)步行法較穩(wěn)定, 但需要四條腿輪流擺動(dòng)一次才能完成一個(gè)運(yùn)動(dòng)周期, 因此步行速度緩慢。如若要求快速行進(jìn)則采用動(dòng)態(tài)步行方式, 即處于對(duì)角線上的兩條腿動(dòng)作完全一致。行進(jìn)過(guò)程中對(duì)角線上的兩條擺動(dòng)腿1、3 抬起向前擺動(dòng), 此時(shí)由于1、3 腿的前擺, 使機(jī)體重心前移不在支撐腿對(duì)角線上, 支撐腿2、4 同時(shí)向后擺動(dòng), 使機(jī)體前移, 重心恢復(fù)到1、3 腿的對(duì)角線中點(diǎn)上, 然后落下1、3 腿, 從而使機(jī)體保持平穩(wěn)狀態(tài)。
四條腿在一周期的循環(huán)過(guò)程中, 機(jī)體始終相對(duì)地面作勻速運(yùn)動(dòng)(假設(shè)只考慮勻速運(yùn)動(dòng))。腿部的運(yùn)動(dòng)分兩個(gè)過(guò)程:1.支撐腿在支撐過(guò)程中, 機(jī)體向前移動(dòng), 足尖相對(duì)機(jī)體向后運(yùn)動(dòng); 2.在抬跨過(guò)程中, 足尖的運(yùn)動(dòng)是由隨機(jī)體的向前運(yùn)動(dòng)和足尖相對(duì)機(jī)體向前抬跨運(yùn)動(dòng)的合成,
在抬腿過(guò)程中為了減小地面對(duì)腿的沖擊, 使機(jī)體能夠穩(wěn)定行進(jìn), 足尖的加速度曲線應(yīng)該是比較平滑的, 故應(yīng)采用正弦運(yùn)動(dòng)曲線。機(jī)器人控制芯片為Microchip 公司生產(chǎn)的PIC16C57C 單片機(jī), 本文采用PBASIC 程序開(kāi)發(fā)機(jī)器人控制算法, 程序順序解釋執(zhí)行, 無(wú)法實(shí)現(xiàn)多線程, 從而將機(jī)器人腿部的復(fù)合運(yùn)動(dòng)分解為多個(gè)短時(shí)間段內(nèi)的擺動(dòng)、起落運(yùn)動(dòng)的順序組合。即在擺動(dòng)運(yùn)動(dòng)中按正弦運(yùn)動(dòng)方式運(yùn)動(dòng)到預(yù)期位置后停止不動(dòng), 然后再執(zhí)行步足的起/ 落運(yùn)動(dòng), 二者交替執(zhí)行。由于每個(gè)動(dòng)作的執(zhí)行過(guò)程被逐段細(xì)分, 從宏觀上仍然保持了復(fù)合運(yùn)動(dòng)的連續(xù)性, 這樣既能實(shí)現(xiàn)機(jī)體的穩(wěn)定行進(jìn)也保證了機(jī)器人運(yùn)動(dòng)的效率。
總體結(jié)構(gòu)設(shè)計(jì)
多足步行機(jī)器人的機(jī)械系統(tǒng)要涉及到幾個(gè)方面的內(nèi)容：腿模塊、腿-機(jī)體-腿模塊的結(jié)構(gòu)形式，各關(guān)節(jié)的合理布置、關(guān)節(jié)轉(zhuǎn)角、腿節(jié)長(zhǎng)度、腿在軀體上的安裝型式以及腿數(shù)目等。
2.1 腿模塊結(jié)構(gòu)
腿機(jī)構(gòu)對(duì)于提高機(jī)器人各傳動(dòng)系統(tǒng)的傳動(dòng)精度、提高各腿的運(yùn)動(dòng)靈活性、簡(jiǎn)化整機(jī)的結(jié)構(gòu)設(shè)計(jì)、降低成本和提高步行機(jī)的行走能力有重要影響。
（1）自由度選擇：
腿機(jī)構(gòu)的可控自由度越多，它的靈活性越好，但每一個(gè)可控自由度要配備一套驅(qū)動(dòng)系統(tǒng)和一套傳動(dòng)機(jī)構(gòu)，所以每增加一個(gè)自由度其重量相應(yīng)要增加許多。因此，步行機(jī)器人腿機(jī)構(gòu)的自由度在滿足運(yùn)動(dòng)條件前提下，越少越好，這里選定每條腿有三個(gè)空間自由度。
（2）腿機(jī)構(gòu)形式：
目前典型的腿機(jī)構(gòu)形式有：縮放式腿機(jī)構(gòu)；關(guān)節(jié)式腿機(jī)構(gòu)；緩沖型腿機(jī)構(gòu)；基于氣動(dòng)人工肌肉的腿機(jī)構(gòu)等?？紤]到關(guān)節(jié)式腿機(jī)構(gòu)結(jié)構(gòu)簡(jiǎn)單，緊湊且運(yùn)動(dòng)靈活，這里采用關(guān)節(jié)式連桿機(jī)構(gòu)作為機(jī)器人的腿機(jī)構(gòu)形式，且采用液壓缸作為驅(qū)動(dòng)，確定步行機(jī)器人單腿模塊的機(jī)構(gòu)原理圖，如圖1 所示。
圖1 步行機(jī)器人單腿模塊機(jī)構(gòu)原理圖
2.2 腿數(shù)目確定
目前研制的多足步行機(jī)器人，不但要求能夠穩(wěn)定行走，而且腿機(jī)構(gòu)還可作為機(jī)械臂執(zhí)行操作任務(wù)。當(dāng)執(zhí)行裝置執(zhí)行操作任務(wù)時(shí)，就要求步行機(jī)器人機(jī)體還應(yīng)是執(zhí)行裝置剛性好、靜態(tài)穩(wěn)定的基礎(chǔ)。要保證步行機(jī)器人機(jī)體靜態(tài)穩(wěn)定，則步行機(jī)器人應(yīng)具有三條或三條以上的腿。從實(shí)現(xiàn)靜態(tài)穩(wěn)定步態(tài)的可能性出發(fā)，步行機(jī)器人必須有四條或四條以上的腿。靜態(tài)穩(wěn)定步態(tài)的穩(wěn)定裕量隨著腿數(shù)的增加而增加，不過(guò)當(dāng)腿數(shù)增加到七條以上時(shí)，穩(wěn)定裕量的變化反而趨于平坦。步行機(jī)器人采用液壓驅(qū)動(dòng)，每條腿上每個(gè)自由度由一個(gè)液壓缸/馬達(dá)驅(qū)動(dòng)，這樣每條腿上就有三套驅(qū)動(dòng)系統(tǒng)，而腿的數(shù)目越多，驅(qū)動(dòng)系統(tǒng)就越多，則整機(jī)的自重就會(huì)增大，相應(yīng)地步行機(jī)的承載能力就會(huì)下降。為減少驅(qū)動(dòng)系統(tǒng)的數(shù)量，增大步行機(jī)構(gòu)的承載能力，因此，選用四足步行機(jī)器人作為研制對(duì)象。
2.3 腿安裝型式確定
步行機(jī)器人腿模塊在機(jī)體上的安裝型式主要有兩類(lèi)：把腿安裝在機(jī)體側(cè)面的仿昆蟲(chóng)類(lèi)（或仿爬行動(dòng)物類(lèi)，如海蟹等）；另一種是把腿安裝在機(jī)體底部的仿哺乳動(dòng)物類(lèi)（如虎等）。研制的四足步行機(jī)器人腿機(jī)構(gòu)不僅具有行走功能，而且還要求能夠作為液壓操作臂，完成操作作業(yè)，在結(jié)構(gòu)上更容易實(shí)現(xiàn)仿爬行動(dòng)物類(lèi)腿機(jī)構(gòu)，其布置型式優(yōu)點(diǎn)就顯現(xiàn)了出來(lái)。
2.4 總體結(jié)構(gòu)確定
機(jī)器人的總體結(jié)構(gòu)是由機(jī)體（軀體）、腿部件兩部分組成。機(jī)體的作用是將多個(gè)腿部件和控制部件有機(jī)地連接在一起，并且承受一定的負(fù)載。腿部件的作用是支撐整個(gè)機(jī)體，并完成機(jī)器人步行運(yùn)動(dòng)。采用液壓驅(qū)動(dòng)的關(guān)節(jié)式腿機(jī)構(gòu)，且各腿模塊采用仿昆蟲(chóng)類(lèi)方式進(jìn)行布置，機(jī)器人整體機(jī)構(gòu)模型，如圖2 所示。
圖2 液壓驅(qū)動(dòng)四足步行機(jī)器人機(jī)構(gòu)模型圖
3 機(jī)械結(jié)構(gòu)參數(shù)設(shè)計(jì)
3.1 腿節(jié)長(zhǎng)度優(yōu)化
如圖1 所示。L1、L2、L3—單腿的髖關(guān)節(jié)腿節(jié)，大、小腿節(jié)長(zhǎng)度，α—髖關(guān)節(jié)轉(zhuǎn)角，β—大腿關(guān)節(jié)轉(zhuǎn)角，γ—小腿關(guān)節(jié)轉(zhuǎn)角。四足步行機(jī)器人腿節(jié)較多（包括髖關(guān)節(jié)、大腿關(guān)節(jié)和小腿關(guān)節(jié)），使得步行機(jī)器人在運(yùn)動(dòng)時(shí)具有較好的靈活性。各腿節(jié)之間的長(zhǎng)度關(guān)系對(duì)腿部的靈活性以及機(jī)器人的整體性能有較大影響，因此，
如何在單腿總長(zhǎng)一定的情況下實(shí)現(xiàn)各腿節(jié)長(zhǎng)度的優(yōu)化分配是非常重要的。
3.1.1 各腿節(jié)長(zhǎng)度對(duì)步行機(jī)器人運(yùn)動(dòng)速度的影響
當(dāng)腿機(jī)構(gòu)運(yùn)動(dòng)到某一位置時(shí)，足端點(diǎn)C 的運(yùn)動(dòng)軌跡方程：
（1）
其中：
（2）
（3）
由式（1）~（3）得到：
（4）
yc
即為足行程或腿跨距R。
上式分別對(duì)Li （ i=1，2，3）求導(dǎo)可得：
（5）
由式（5）可見(jiàn)，步行機(jī)器人的腿跨距R 對(duì)桿長(zhǎng)L1
最敏感，進(jìn)而對(duì)步行機(jī)器人的運(yùn)動(dòng)速度影響最大，因此，在單腿總長(zhǎng)L 一定的情況下，希望L1 取值越大越好，此時(shí)在步行機(jī)器人步調(diào)（單位時(shí)間內(nèi)腿擺動(dòng)的次數(shù)）一定的情況下，速度越快。
3.1.2 各腿節(jié)長(zhǎng)度對(duì)步行機(jī)器人越障能力的影響
H0
圖3 步行機(jī)器人越障示意圖
如圖3 所示，步行機(jī)器人的最大越障高度為：H0=L2+L3-h （6）可見(jiàn)，在單腿總長(zhǎng)L 一定的情況下，L2+L3 越大，則機(jī)器人越障高度越大，即越障能力越強(qiáng)，此時(shí)L1最小。
3.1.3 腿節(jié)長(zhǎng)度對(duì)步行機(jī)器人足端運(yùn)動(dòng)空間的影響
對(duì)腿部三連桿機(jī)構(gòu)足端的平面運(yùn)動(dòng)空間進(jìn)行分析，如圖4 所示。
圖4 四足步行機(jī)器人足端運(yùn)動(dòng)空間
設(shè)髖關(guān)節(jié)連桿L1—OiA 長(zhǎng)度，大腿桿L2—AB0長(zhǎng)；小腿桿L3—B0C0長(zhǎng)；φ1，φ2—大、小腿關(guān)節(jié)處的轉(zhuǎn)角范圍，如圖4 所示。可得如下幾何關(guān)系：
S扇形B0C0D0=S扇形B1C1D1
，S扇形B0D0G0=S扇形B1D1G1
，
S扇形B0C0E0=S扇形B1C1E1
，S扇形B0G0F0=S扇形B1G1F1
，
如圖4 所示，中陰影部分即為四足步行機(jī)器人腿機(jī)構(gòu)足端在平面內(nèi)的運(yùn)動(dòng)區(qū)域，該區(qū)域面積越大，則足端的可選立足點(diǎn)越多，即腿運(yùn)動(dòng)越靈活。
令，，則，代入上式，
SE0E1F1F0= " （7）
令（8）
=0 （9）
求解可得：
（10）
即當(dāng)
時(shí)，足端工作空間面積最大。
3.1.4 腿節(jié)比例對(duì)機(jī)器人運(yùn)動(dòng)靈活性的影響
機(jī)體的靈活性評(píng)價(jià)指標(biāo)可用文獻(xiàn)[6]提出的靈活度概念作為評(píng)價(jià)指標(biāo)。機(jī)體位姿可用#X，Y，Z，α，β，γ $6個(gè)參數(shù)表示，其分別為機(jī)體坐標(biāo)系相對(duì)于地面坐標(biāo)系XYZ 三軸直線位移和角位移。由于多鏈并聯(lián)機(jī)構(gòu)的限制，步行機(jī)器人在某一位姿時(shí)機(jī)體位姿參數(shù)單獨(dú)變化，將各有一定的變化范圍，
設(shè)
令靈活度
式中：L— 單腿的長(zhǎng)度。由于，且一般情況（超出不計(jì)），所以FB 是一個(gè)%0，1 &之間的無(wú)量綱參數(shù)。靈活度是結(jié)構(gòu)參數(shù)和所處位姿的函數(shù)，它反映了多足步行機(jī)的整體靈活性。綜上所述，在對(duì)步行機(jī)器人運(yùn)動(dòng)速度、越障能力、運(yùn)動(dòng)空間以及腿部和機(jī)體靈活性進(jìn)行分析后，并參照仿生機(jī)械蟹的比例，并考慮到舵機(jī)、連接鉸鏈的安裝，確定腿部各關(guān)節(jié)比例為：
K1:K2:K3=0.15:0.425:0.425（12）
單腿總長(zhǎng)為L(zhǎng) = 400mm， 各腿節(jié)長(zhǎng)度為：L1 = 60mm，L2= 170mm，L3= 170mm3.2
機(jī)器人機(jī)體設(shè)計(jì)
對(duì)四足步行機(jī)器人機(jī)體進(jìn)行有效的優(yōu)化設(shè)計(jì)，在保證機(jī)體剛度和強(qiáng)度的條件下使得機(jī)體質(zhì)量最輕，對(duì)于提高步行機(jī)器人的載重能力以及運(yùn)動(dòng)效率具有重要意義。
3.2.1 α 角度規(guī)劃與機(jī)體結(jié)構(gòu)之間的關(guān)系
α 角度即為腿部髖關(guān)節(jié)的擺動(dòng)角度。一方面，如果α 過(guò)小，則會(huì)影響步行機(jī)器人的行走步長(zhǎng)λ（指在一個(gè)完整腿循環(huán)中機(jī)體移動(dòng)的水平距離），從而影響步行機(jī)器人的行走速度；另一方面，如果擺動(dòng)角度λ 過(guò)大，有可能在擺動(dòng)過(guò)程中前后兩腿發(fā)生干涉。為了不發(fā)生干涉，則需要將機(jī)體加長(zhǎng)，如果加上所承載重物以及液壓油源的振動(dòng)，極有可能會(huì)激發(fā)機(jī)構(gòu)的某種模態(tài)，產(chǎn)生共振，進(jìn)而影響機(jī)構(gòu)的穩(wěn)定性。為了使機(jī)體能夠承受一定的負(fù)載且不發(fā)生變形及穩(wěn)定性等原因需要進(jìn)一步將機(jī)體的厚度增大，而此時(shí)又進(jìn)一步的增大了機(jī)體的重量即支撐腿的負(fù)載，則又需增大液壓缸/馬達(dá)的輸出力矩，進(jìn)一步增大了整個(gè)結(jié)構(gòu)的尺寸，與結(jié)構(gòu)設(shè)計(jì)的緊湊性相矛盾，可見(jiàn)，λ 角度大小對(duì)機(jī)體的結(jié)構(gòu)設(shè)計(jì)具有重要影響。3.2.2 步行機(jī)構(gòu)穩(wěn)定性與機(jī)體結(jié)構(gòu)之間的關(guān)系機(jī)體設(shè)計(jì)的合理與否對(duì)步行機(jī)器人整體運(yùn)動(dòng)穩(wěn)定性有著重要影響，當(dāng)機(jī)體長(zhǎng)寬比例設(shè)計(jì)不合理時(shí)，重心發(fā)生偏移，會(huì)導(dǎo)致機(jī)體發(fā)生傾翻現(xiàn)象。根據(jù)經(jīng)驗(yàn)值，初步確定機(jī)體長(zhǎng)寬比例為：0.75。
移動(dòng)機(jī)器人包括輪式（如4 輪式、2 輪式、全方向式、履帶式）、足式（如6 足、4 足、2 足）、混合式（輪子和足）、特殊式（如吸附式、軌道式、蛇式）等類(lèi)型。其中輪式移動(dòng)機(jī)器人由于自重輕、承載能力強(qiáng)、運(yùn)動(dòng)控制相對(duì)簡(jiǎn)單、移動(dòng)靈活、速度快等優(yōu)點(diǎn)，廣泛應(yīng)用于工業(yè)、醫(yī)療、反恐防暴、家庭服務(wù)以及空間探測(cè)等領(lǐng)域。輪式機(jī)器人要求其移動(dòng)機(jī)構(gòu)能夠靈活運(yùn)動(dòng)，以適應(yīng)環(huán)境要求。全方位移動(dòng)機(jī)器人在平面上能作任意方向移動(dòng)， 運(yùn)動(dòng)靈活。常見(jiàn)的全方位輪有Mecanum 輪、Swedish 輪以及由其他普通車(chē)輪的組合。該機(jī)器人的底盤(pán)由2 組驅(qū)動(dòng)輪和4 個(gè)隨動(dòng)輪組成，如圖2 所示，機(jī)器人本體通過(guò)6 塊安裝板和底盤(pán)聯(lián)結(jié)。每組驅(qū)動(dòng)輪固聯(lián)，2 個(gè)伺服電機(jī)分別實(shí)現(xiàn)直線驅(qū)動(dòng)和轉(zhuǎn)向功能。隨動(dòng)輪為萬(wàn)向偏心輪（見(jiàn)圖4），
當(dāng)?shù)V井發(fā)生爆炸和坍塌、地震災(zāi)害降臨、房屋倒塌時(shí)，救援人員往往無(wú)法及時(shí)深入到廢墟內(nèi)對(duì)受困人員進(jìn)行搜索和施救。考古挖掘工作中也經(jīng)常出現(xiàn)因洞穴狹小，工作人員對(duì)其中的情況一無(wú)所知，因此不敢貿(mào)然進(jìn)入。針對(duì)這些情況設(shè)計(jì)一種能完成多種復(fù)雜地形的探測(cè)、能夠代替工作人員執(zhí)行搜救任務(wù)的新型機(jī)器人，在災(zāi)難救援中將起著越來(lái)越重要的作用。把機(jī)器人技術(shù)引入到這些領(lǐng)域是一個(gè)新的挑戰(zhàn)。機(jī)器人能通過(guò)狹小的空間，在復(fù)雜的地形中可運(yùn)動(dòng)自如，傳送數(shù)據(jù)準(zhǔn)確，控制方便，綜合這些方面的考慮，是研究此類(lèi)機(jī)器人的首要方向。
! 探索機(jī)器人的結(jié)構(gòu)設(shè)計(jì)
為進(jìn)行探索工作，探索機(jī)器人必須具有在廢墟下的狹小縫隙內(nèi)前進(jìn)、后退、轉(zhuǎn)彎和越障運(yùn)動(dòng)的能力，它屬于移動(dòng)機(jī)器人。移動(dòng)機(jī)器人有輪式、履帶式和足式等結(jié)構(gòu)方式，其中輪式機(jī)器人對(duì)路面平整度要求較高，不適合在廢墟上運(yùn)動(dòng)；足式機(jī)器人越障能力較強(qiáng)，但機(jī)械結(jié)構(gòu)和控制系統(tǒng)都很復(fù)雜；履帶式機(jī)器人在廢墟上有一定的越障能力，但現(xiàn)有履帶式機(jī)器人體積大，不適宜在狹小空間內(nèi)運(yùn)動(dòng)。采用毛毛蟲(chóng)形爬行機(jī)器人具有穩(wěn)定性好、橫截面小、柔性大等特點(diǎn)，更適合在廢墟的縫隙間穿行。
本文設(shè)計(jì)的探索機(jī)器人由頭部、身部和轉(zhuǎn)彎部#部
分構(gòu)成，總體結(jié)構(gòu)如圖*。為便于前進(jìn)和后退，頭尾采用相同結(jié)構(gòu)。中間身體由多個(gè)可自由拆裝的獨(dú)立單元連接而成。轉(zhuǎn)彎處采用柔性結(jié)構(gòu)能完成任意角度的轉(zhuǎn)彎動(dòng)作。其結(jié)構(gòu)設(shè)計(jì)包括頭部結(jié)構(gòu)設(shè)計(jì)、身部單元結(jié)構(gòu)設(shè)
計(jì)、轉(zhuǎn)彎部設(shè)計(jì)和連接部設(shè)計(jì)。
*0 * 頭部結(jié)構(gòu)設(shè)計(jì)
頭部位于機(jī)器人的最前端，攝像頭和照明燈必須安裝在頭部。由于毛毛蟲(chóng)形機(jī)器人不具備手爪，頭部須
具有清理通道的功能。因此，頭部前端設(shè)計(jì)成可張合的分瓣式頭錐，攝像頭和照明燈安裝在頭錐內(nèi)。閉合的頭錐（見(jiàn)圖%）便于穿越狹小空間，還可保護(hù)攝像頭；頭錐張開(kāi)時(shí)可擴(kuò)張通道、增大攝像頭視野，同時(shí)還起聚光的作用；頭錐張合動(dòng)作還可以用于抓放物體，相當(dāng)于動(dòng)物的嘴巴。頭錐的張合由曲柄搖桿機(jī)構(gòu)、滑塊機(jī)構(gòu)來(lái)完成（見(jiàn)圖#）。當(dāng)電機(jī)轉(zhuǎn)動(dòng)! 角時(shí)，電機(jī)帶動(dòng)搖桿轉(zhuǎn)動(dòng)，連桿推動(dòng)滑塊移動(dòng)，從而使頭錐張開(kāi)（虛線為完成動(dòng)作時(shí)的運(yùn)動(dòng)軌跡）。電機(jī)反轉(zhuǎn)! 角，則頭錐完成閉合動(dòng)作。
%& " 身部單元結(jié)構(gòu)設(shè)計(jì)
身部單元結(jié)構(gòu)主要是完成機(jī)器人的移動(dòng)，身部有一個(gè)控制單元和若干個(gè)運(yùn)送單元，每個(gè)身體單元均有自己的能源和驅(qū)動(dòng)器，在程序控制下，各單元間通過(guò)協(xié)調(diào)動(dòng)作完成前進(jìn)、后退。機(jī)器人采用四面履帶爬行運(yùn)動(dòng)方式。機(jī)器人體積狹小需要采用一個(gè)電機(jī)完成四面履帶的運(yùn)動(dòng)。經(jīng)過(guò)分析采用了蝸輪蝸桿傳動(dòng)（見(jiàn)圖’），由電機(jī)帶動(dòng)蝸桿轉(zhuǎn)動(dòng)，蝸桿帶動(dòng)’個(gè)蝸輪運(yùn)動(dòng)，蝸輪帶動(dòng)齒輪運(yùn)動(dòng)，從而把一個(gè)轉(zhuǎn)動(dòng)力傳到’個(gè)方向轉(zhuǎn)動(dòng)，帶動(dòng)履帶運(yùn)動(dòng)。
& ( 轉(zhuǎn)彎部結(jié)構(gòu)設(shè)計(jì)
轉(zhuǎn)彎部分體現(xiàn)探索機(jī)器人的靈活性，是連接頭部與身部、身部與身部的關(guān)節(jié)。主要完成上下左右’個(gè)方向"個(gè)自由度的轉(zhuǎn)彎動(dòng)作，采用了類(lèi)似柔性結(jié)構(gòu)，當(dāng)轉(zhuǎn)彎時(shí)遇到較大的阻力時(shí)，柔性結(jié)構(gòu)可以起緩解作用，同時(shí)也起了保護(hù)電機(jī)作用?？刂朴伞瘋€(gè)電機(jī)帶動(dòng)，電機(jī)的旋轉(zhuǎn)帶動(dòng)彈簧上的繩索再帶動(dòng)彈簧完成伸縮運(yùn)動(dòng)從而實(shí)現(xiàn)’個(gè)方向的轉(zhuǎn)彎?！鶑椈芍械膬蓚?cè)彈簧收縮量不同時(shí)，機(jī)器人作轉(zhuǎn)彎運(yùn)動(dòng)；上下彈簧收縮量不同時(shí)，機(jī)器人作抬頭或低頭運(yùn)動(dòng)。
%& ’ 單元連接結(jié)構(gòu)設(shè)計(jì)頭部、身部和轉(zhuǎn)彎部各單元間采用陰陽(yáng)快插接頭連接；各單元中電路電極、傳輸傳感器信號(hào)和控制信號(hào)線采用公頭、母頭插座連接。該結(jié)構(gòu)便于現(xiàn)場(chǎng)各單元的組合與拆裝。
! 探索機(jī)器人控制設(shè)計(jì)
探索機(jī)器人的各個(gè)機(jī)構(gòu)能完成相應(yīng)的動(dòng)作，主要?jiǎng)恿?lái)源是電機(jī)，對(duì)電機(jī)的種類(lèi)進(jìn)行分析后，決定身部采用直流減速電機(jī)，它是完成前進(jìn)、后退的動(dòng)力原件。頭部和轉(zhuǎn)彎部采用舵機(jī)，其體積小，輸出轉(zhuǎn)矩可以滿足探索機(jī)器人的動(dòng)力，完成頭部開(kāi)合控制、轉(zhuǎn)彎控制。舵機(jī)是一種將電脈沖信號(hào)轉(zhuǎn)換成角位移) 或線位移* 的機(jī)電元件。舵機(jī)有其獨(dú)特的優(yōu)點(diǎn)，歸納起來(lái)主要有：%）轉(zhuǎn)角不受各種干擾因素的影響；"）位移與輸入脈寬信號(hào)相對(duì)應(yīng)，轉(zhuǎn)角誤差不長(zhǎng)期積累；(）可以用數(shù)字信號(hào)直接進(jìn)行開(kāi)環(huán)控制，整個(gè)結(jié)構(gòu)簡(jiǎn)單、廉價(jià)；’）控制性能好
機(jī)器人的控制系統(tǒng)總體結(jié)構(gòu)分(級(jí)，如圖$所示：遙控器為第一級(jí)，主單片機(jī)為第二級(jí)，從單片機(jī)為第三級(jí)。遙控系統(tǒng)包括探索機(jī)器人控制界面和串行通信程序兩部分，通過(guò)遙控器中單片機(jī)+,-./$"串口利用無(wú)線通信模塊將各種控制命令和數(shù)據(jù)發(fā)送給主單片機(jī)。主單片機(jī)012%3-通過(guò)!"# 通信與從單片機(jī)012%3-協(xié)同工作?？刂葡到y(tǒng)軟件包括遙控器應(yīng)用程序、主單片機(jī)應(yīng)用程序和從單片機(jī)應(yīng)用程序(部分。無(wú)線通信是遙控器與主單片機(jī)之間的橋梁。遙控器控制系統(tǒng)的軟件設(shè)計(jì)包括：利用無(wú)線模塊與主單片機(jī)的通信程序，液晶屏的顯示程序。主單片機(jī)控制系統(tǒng)的主要功能是完成與從單片機(jī)!"# 通信、控制傳感器和直流電機(jī)。從單片機(jī)控制系統(tǒng)的軟件實(shí)現(xiàn)舵機(jī)的轉(zhuǎn)角控制。
伺服電機(jī)（servo motor ）是指在伺服系統(tǒng)中控制機(jī)械元件運(yùn)轉(zhuǎn)的發(fā)動(dòng)機(jī)，是一種補(bǔ)助馬達(dá)間接變速裝置。伺服電機(jī)可使控制速度，位置精度非常準(zhǔn)確，可以將電壓信號(hào)轉(zhuǎn)化為轉(zhuǎn)矩和轉(zhuǎn)速以驅(qū)動(dòng)控制對(duì)象。伺服電機(jī)轉(zhuǎn)子轉(zhuǎn)速受輸入信號(hào)控制，并能快速反應(yīng)，在自動(dòng)控制系統(tǒng)中，用作執(zhí)行元件，且具有機(jī)電時(shí)間常數(shù)小、線性度高、始動(dòng)電壓等特性，可把所收到的電信號(hào)轉(zhuǎn)換成電動(dòng)機(jī)軸上的角位移或角速度輸出。分為直流和交流伺服電動(dòng)機(jī)兩大類(lèi)，其主要特點(diǎn)是，當(dāng)信號(hào)電壓為零時(shí)無(wú)自轉(zhuǎn)現(xiàn)象，轉(zhuǎn)速隨著轉(zhuǎn)矩的增加而勻速下降。
工作原理
1、伺服系統(tǒng)（servomechanism）是使物體的位置、方位、
??
伺服電機(jī)（圖1）
[1]
狀態(tài)等輸出被控量能夠跟隨輸入目標(biāo)（或給定值）的任意變化的自動(dòng)控制系統(tǒng)。伺服主要靠脈沖來(lái)定位，基本上可以這樣理解，伺服電機(jī)接收到1個(gè)脈沖，就會(huì)旋轉(zhuǎn)1個(gè)脈沖對(duì)應(yīng)的角度，從而實(shí)現(xiàn)位移，因?yàn)?，伺服電機(jī)本身具備發(fā)出脈沖的功能，所以伺服電機(jī)每旋轉(zhuǎn)一個(gè)角度，都會(huì)發(fā)出對(duì)應(yīng)數(shù)量的脈沖，這樣，和伺服電機(jī)接受的脈沖形成了呼應(yīng)，或者叫閉環(huán)，如此一來(lái)，系統(tǒng)就會(huì)知道發(fā)了多少脈沖給伺服電機(jī)，同時(shí)又收了多少脈沖回來(lái)，這樣，就能夠很精確的控制電機(jī)的轉(zhuǎn)動(dòng)，從而實(shí)現(xiàn)精確的定位，可以達(dá)到0.001mm。直流伺服電機(jī)分為有刷和無(wú)刷電機(jī)。有刷電機(jī)成本低，結(jié)構(gòu)簡(jiǎn)單，啟動(dòng)轉(zhuǎn)矩大，調(diào)速范圍寬，控制容易，需要維護(hù)，但維護(hù)不方便（換碳刷），產(chǎn)生電磁干擾，對(duì)環(huán)境有要求。因此它可以用于對(duì)成本敏感的普通工業(yè)和民用場(chǎng)合。
無(wú)刷電機(jī)體積小，重量輕，出力大，響應(yīng)快，速度高，慣量小，轉(zhuǎn)動(dòng)平滑，力矩穩(wěn)定。控制復(fù)雜，容易實(shí)現(xiàn)智能化，其電子換相方式靈活，可以方波換相或正弦波換相。電機(jī)免維護(hù)，效率很高，運(yùn)行溫度低，電磁輻射很小，長(zhǎng)壽命，可用于各種環(huán)境。
2、交流伺服電機(jī)也是無(wú)刷電機(jī)，分為同步和異步電機(jī)，目前運(yùn)動(dòng)控制中一般都用同步電機(jī)，它的功率范圍大，可以做到很大的功率。大慣量，最高轉(zhuǎn)動(dòng)速度低，且隨著功率增大而快速降低。因而適合做低速平穩(wěn)運(yùn)行的應(yīng)用。
3、伺服電機(jī)內(nèi)部的轉(zhuǎn)子是永磁鐵，驅(qū)動(dòng)器控制的U/V/W三相電形成電磁場(chǎng)，轉(zhuǎn)子在此磁場(chǎng)的作用下轉(zhuǎn)動(dòng)，同時(shí)電機(jī)自帶的編碼器反饋信號(hào)給驅(qū)動(dòng)器，驅(qū)動(dòng)器根據(jù)反饋值與目標(biāo)值進(jìn)行比較，調(diào)整轉(zhuǎn)子轉(zhuǎn)動(dòng)的角度。伺服電機(jī)的精度決定于編碼器的精度（線數(shù)）。
交流伺服電機(jī)和無(wú)刷直流伺服電機(jī)在功能上的區(qū)別：交流伺服要好一些，因?yàn)槭钦也刂?，轉(zhuǎn)矩脈動(dòng)小。直流伺服是梯形波。但直流伺服比較簡(jiǎn)單，便宜。
發(fā)展歷史
自從德國(guó)MANNESMANN的Rexroth公司的Indramat分部在1978年漢諾威貿(mào)易博覽會(huì)
??
交流伺服電機(jī)（圖二）
上正式推出MAC永磁交流伺服電動(dòng)機(jī)和驅(qū)動(dòng)系統(tǒng)，這標(biāo)志著此種新一代交流伺服技術(shù)已進(jìn)入實(shí)用化階段。到20世紀(jì)80年代中后期，各公司都已有完整的系列產(chǎn)品。整個(gè)伺服裝置市場(chǎng)都轉(zhuǎn)向了交流系統(tǒng)。早期的模擬系統(tǒng)在諸如零漂、抗干擾、可靠性、精度和柔性等方面存在不足，尚不能完全滿足運(yùn)動(dòng)控制的要求，近年來(lái)隨著微處理器、新型數(shù)字信號(hào)處理器（DSP）的應(yīng)用，出現(xiàn)了數(shù)字控制系統(tǒng)，控制部分可完全由軟件進(jìn)行，分別稱為摪朧只瘮或摶旌鮮綌、撊只瘮?shù)挠来沤涣魉欧到y(tǒng)。
到目前為止，高性能的電伺服系統(tǒng)大多采用永磁同步型交流伺服電動(dòng)機(jī)，控制驅(qū)動(dòng)器多采用快速、準(zhǔn)確定位的全數(shù)字位置伺服系統(tǒng)。典型生產(chǎn)廠家如德國(guó)西門(mén)子、美國(guó)科爾摩根和日本松下及安川等公司。
日本安川電機(jī)制作所推出的小型交流伺服電動(dòng)機(jī)和驅(qū)動(dòng)器，其中D系列適用于數(shù)控機(jī)床（最高轉(zhuǎn)速為1000r/min，力矩為0.25～2.8N.m），R系列適用于機(jī)器人（最高轉(zhuǎn)速為3000r/min，力矩為0.016～0.16N.m）。之后又推出M、F、S、H、C、G 六個(gè)系列。20世紀(jì)90年代先后推出了新的D系列和R系列。由舊系列矩形波驅(qū)動(dòng)、8051單片機(jī)控制改為正弦波驅(qū)動(dòng)、80C、154CPU和門(mén)陣列芯片控制，力矩波動(dòng)由24%降低到7%，并提高了可靠性。這樣，只用了幾年時(shí)間形成了八個(gè)系列（功率范圍為0.05～6kW）較完整的體系，滿足了工作機(jī)械、搬運(yùn)機(jī)構(gòu)、焊接機(jī)械人、裝配機(jī)器人、電子部件、加工機(jī)械、印刷機(jī)、高速卷繞機(jī)、繞線機(jī)等的不同需要。
以生產(chǎn)機(jī)床數(shù)控裝置而著名的日本法那克（Fanuc）公司，在20世紀(jì)80年代中期也推出了S系列（13個(gè)規(guī)格）和L系列（5個(gè)規(guī)格）的永磁交流伺服電動(dòng)機(jī)。L系列有較小的轉(zhuǎn)動(dòng)慣量和機(jī)械時(shí)間常數(shù)，適用于要求特別快速響應(yīng)的位置伺服系統(tǒng)。
日本其他廠商，例如：三菱電動(dòng)機(jī)（HC-KFS、HC-MFS、HC-SFS、HC-RFS和HC-UFS系列）、東芝精機(jī)（SM系列）、大隈鐵工所(BL系列）、三洋電氣（BL系列）、立石電機(jī)（S系列）等眾多廠商也進(jìn)入了永磁交流伺服系統(tǒng)的競(jìng)爭(zhēng)行列。
德國(guó)力士樂(lè)公司（Rexroth）的Indramat分部的MAC系列交流伺服電動(dòng)機(jī)共有7個(gè)機(jī)座號(hào)92個(gè)規(guī)格。
德國(guó)西門(mén)子（Siemens）公司的IFT5系列三相永磁交流伺服電動(dòng)機(jī)分為標(biāo)準(zhǔn)型和短型兩大類(lèi)，共8個(gè)機(jī)座號(hào)98種規(guī)格。據(jù)稱該系列交流伺服電動(dòng)機(jī)與相同輸出力矩的直流伺服電動(dòng)機(jī)IHU系列相比，重量只有后者的1/2，配套的晶體管脈寬調(diào)制驅(qū)動(dòng)器6SC61系列，最多的可供6個(gè)軸的電動(dòng)機(jī)控制。
德國(guó)博世（BOSCH）公司生產(chǎn)鐵氧體永磁的SD系列（17個(gè)規(guī)格）和稀土永磁的SE系列（8個(gè)規(guī)格）交流伺服電動(dòng)機(jī)和Servodyn SM系列的驅(qū)動(dòng)控制器。
美國(guó)著名的伺服裝置生產(chǎn)公司Gettys曾一度作為Gould 電子公司一個(gè)分部（Motion Control Division），生產(chǎn)M600系列的交流伺服電動(dòng)機(jī)和A600 系列的伺服驅(qū)動(dòng)器。后合并到AEG，恢復(fù)了Gettys名稱，推出A700全數(shù)字化的交流伺服系統(tǒng)。
美國(guó)A-B（ALLEN-BRADLEY）公司驅(qū)動(dòng)分部生產(chǎn)1326型鐵氧體永磁交流伺服電動(dòng)機(jī)和1391型交流PWM伺服控制器。電動(dòng)機(jī)包括3個(gè)機(jī)座號(hào)共30個(gè)規(guī)格。
I.D.（Industrial Drives）是美國(guó)著名的科爾摩根（Kollmorgen）的工業(yè)驅(qū)動(dòng)分部，曾生產(chǎn)BR-210、BR-310、BR-510 三個(gè)系列共41個(gè)規(guī)格的無(wú)刷伺服電動(dòng)機(jī)和BDS3型伺服驅(qū)動(dòng)器。自1989年起推出了全新系列設(shè)計(jì)的摻鶼盜袛（Goldline）永磁交流伺服電動(dòng)機(jī)，包括B（小慣量）、M（中慣量）和EB（防爆型）三大類(lèi)，有10、20、40、60、80五種機(jī)座號(hào)，每大類(lèi)有42個(gè)規(guī)格，全部采用釹鐵硼永磁材料，力矩范圍為0.84～111.2N.m，功率范圍為0.54～15.7kW。配套的驅(qū)動(dòng)器有BDS4（模擬型）、BDS5（數(shù)字型、含位置控制）和Smart Drive（數(shù)字型）三個(gè)系列，最大連續(xù)電流55A。Goldline系列代表了當(dāng)代永磁交流伺服技術(shù)最新水平。
愛(ài)爾蘭的Inland原為Kollmorgen在國(guó)外的一個(gè)分部，現(xiàn)合并到AEG，以生產(chǎn)直流伺服電動(dòng)機(jī)、直流力矩電動(dòng)機(jī)和伺服放大器而聞名。生產(chǎn)BHT1100、2200、3300三種機(jī)座號(hào)共17種規(guī)格的SmCo永磁交流伺服電動(dòng)機(jī)和八種控制器。
法國(guó)Alsthom集團(tuán)在巴黎的Parvex工廠生產(chǎn)LC系列（長(zhǎng)型）和GC系列（短型）交流伺服電動(dòng)機(jī)共14個(gè)規(guī)格，并生產(chǎn)AXODYN系列驅(qū)動(dòng)器。
原蘇聯(lián)為數(shù)控機(jī)床和機(jī)器人伺服控制開(kāi)發(fā)了兩個(gè)系列的交流伺服電動(dòng)機(jī)。其中ДBy系列采用鐵氧體永磁，有兩個(gè)機(jī)座號(hào)，每個(gè)機(jī)座號(hào)有3種鐵心長(zhǎng)度，各有兩種繞組數(shù)據(jù)，共12個(gè)規(guī)格，連續(xù)力矩范圍為7～35N.m。2ДBy系列采用稀土永磁，6個(gè)機(jī)座號(hào)17個(gè)規(guī)格，力矩范圍為0.1～170N.m，配套的是3ДБ型控制器。
近年日本松下公司推出的全數(shù)字型MINAS系列交流伺服系統(tǒng)，其中永磁交流伺服電動(dòng)機(jī)有MSMA系列小慣量型，功率從0.03～5kW，共18種規(guī)格；中慣量型有MDMA、MGMA、MFMA三個(gè)系列，功率從0.75～4.5kW，共23種規(guī)格,MHMA系列大慣量電動(dòng)機(jī)的功率范圍從0.5～5kW，有7種規(guī)格。
韓國(guó)三星公司近年開(kāi)發(fā)的全數(shù)字永磁交流伺服電動(dòng)機(jī)及驅(qū)動(dòng)系統(tǒng)，其中FAGA交流伺服電動(dòng)機(jī)系列有CSM、CSMG、CSMZ、CSMD、CSMF、CSMS、CSMH、CSMN、CSMX多種型號(hào)，功率從15W～5kW。
現(xiàn)在常采用（Powerrate）這一綜合指標(biāo)作為伺服電動(dòng)機(jī)的品質(zhì)因數(shù)，衡量對(duì)比各種交直流伺服電動(dòng)機(jī)和步進(jìn)電動(dòng)機(jī)的動(dòng)態(tài)響應(yīng)性能。功率變化率表示電動(dòng)機(jī)連續(xù)（額定）力矩和轉(zhuǎn)子轉(zhuǎn)動(dòng)慣量之比。
按功率變化率進(jìn)行計(jì)算分析可知，永磁交流伺服電動(dòng)機(jī)技術(shù)指標(biāo)以美國(guó)I.D 的Goldline系列為最佳，德國(guó)Siemens的IFT5系列次之。
選型比較
功能及作用比較
交流伺服電動(dòng)機(jī)
交流伺服電動(dòng)機(jī)定子的構(gòu)造基本上與電容分相式單相異步電動(dòng)機(jī)相似.其定子上裝有兩個(gè)位置互差90°的繞組，一個(gè)是勵(lì)磁繞組Rf，它始終接在交流電壓Uf上；另一個(gè)是控制繞組L，聯(lián)接控制信號(hào)電壓Uc。所以交流伺服電動(dòng)機(jī)又稱兩個(gè)伺服電動(dòng)機(jī)。
交流伺服電動(dòng)機(jī)的轉(zhuǎn)子通常做成