機(jī)器爬蟲(chóng)運(yùn)動(dòng)步態(tài)策略研究【畢業(yè)論文絕對(duì)精品】

1、口前對(duì)于移動(dòng)式機(jī)器人多采用輪式移動(dòng)機(jī)構(gòu)，但是在適應(yīng)復(fù)雜地形吋輪式機(jī) 器人無(wú)法滿足路況的要求，由此設(shè)計(jì)一種靈活的、行走平穩(wěn)和對(duì)路況適應(yīng)性強(qiáng)的 機(jī)器人成為解決此類問(wèn)題的關(guān)鍵。六足仿生機(jī)器人便是這種機(jī)器人的典型代表， 而六足仿生機(jī)器人的步態(tài)研究對(duì)其的行走方式更是具有重要意義。硬件控制芯片采用parallax公司牛產(chǎn)的basic stamp微控制器，利用pbasic 語(yǔ)言設(shè)計(jì)程序，并完成機(jī)器人運(yùn)動(dòng)控制程序的設(shè)計(jì)。在實(shí)現(xiàn)數(shù)據(jù)的正常通信后， 利用計(jì)算機(jī)傳輸給basic stamp控制器，寫(xiě)入程序。論文針對(duì)一個(gè)已經(jīng)完成的六足仿生機(jī)器人木體，采用basic stamp微控制技 術(shù)，研究了六足仿生機(jī)器人運(yùn)動(dòng)步態(tài)

2、的控制規(guī)律，并對(duì)其進(jìn)行運(yùn)動(dòng)規(guī)劃，在其上 實(shí)現(xiàn)控制系統(tǒng)。論文主要研究了六足機(jī)器人的三角步態(tài)、四足步態(tài)走法并且提出 波動(dòng)步態(tài)。通過(guò)斑馬線步態(tài)圖可以很清楚的發(fā)現(xiàn)其三者之間的聯(lián)系和不同，從而 總結(jié)出每種步態(tài)的特點(diǎn)并h比較每種步態(tài)的優(yōu)缺點(diǎn)，為后面的實(shí)驗(yàn)過(guò)程提供了理 論依據(jù)。在實(shí)驗(yàn)屮分別在六足機(jī)器人木體上實(shí)現(xiàn)了基于三角步態(tài)的直線行走、基 于四足步態(tài)的直線行走、基于三角步態(tài)的右側(cè)轉(zhuǎn)彎運(yùn)動(dòng)和在兩種步態(tài)下的負(fù)重實(shí) 驗(yàn)。另外，三角步態(tài)屮的轉(zhuǎn)彎狀態(tài)分析和實(shí)現(xiàn)較直行狀態(tài)更為復(fù)雜。因?yàn)闄C(jī)器人 有六條腿，數(shù)口比較多，所以轉(zhuǎn)彎的吋候每條腿的運(yùn)動(dòng)狀態(tài)如何分配是一個(gè)難點(diǎn)。 通過(guò)對(duì)三角步態(tài)運(yùn)動(dòng)特點(diǎn)進(jìn)行仔細(xì)分析并且對(duì)六足機(jī)器人木體

3、的研究，實(shí)現(xiàn)了其 轉(zhuǎn)彎步態(tài)。從實(shí)驗(yàn)結(jié)果可以看出，六足仿生機(jī)器人的運(yùn)動(dòng)控制具有穩(wěn)定性和協(xié)調(diào)性。四 足步態(tài)較三角步態(tài)負(fù)重能力更強(qiáng),但是速度更慢。三角步態(tài)具有快速性和靈活性, 所以適用于平坦的地面。由于四足步態(tài)具有負(fù)重能力強(qiáng)支撐足較多的特點(diǎn)所以適 用于對(duì)路面平坦程度要求不高的情況下，而這恰恰是輪式機(jī)器人很難達(dá)到的。關(guān)鍵詞：六足機(jī)器人，仿生，步態(tài)，basic stamp,伺服電機(jī)abstractcurrently, the mobile robots mostly exist in the form of multi-wheel, but to adapt to the complex terrain

4、 conditions, they are often out of expectance for the reason of this fault, designing a new kind of robot with the characteristic of flexible, stable and adaptable, so that the problem can clearly discovered and easily resolved. as a typical representative of such robots, hexapod bio-robot regularly

5、 do a good job. so it can be of great significance to research the gait of this product.the chip of hardware control system is applied by parallax inc. basic stamp microcontroller, pbasic language is used for designing process and perfecting the robot motion. after performing the normal communicatio

6、n of data, the computer transmits them to basic stamp controller, and then imports the procedure.under the premise of basic stamp microcontroller, the thesis research on the law of hexapod robot gait controlling which is based on an accomplished one. and then mapping out its movement, on which try t

7、o implement the controlling system. the focus of this paper is to relate tripod gait,four-leg gait of hexapod robots and put forward fluctuations gait. through the crossing gait diagram, the links and different among the three units can be clearly bring to light, accordingly, and summarize the chara

8、cteristics of each type of gait and compare the advantages and disadvantages of them what can reference the following experiments. these experiments realize the straight-line walking based on tripod gait and four-legged gait, in addition, it also include the movement of turning right based on tripod

9、 gait and weight-bearing experiment under both types of gaits. in particular, it，s more complex to analyze and realize the turning movement in the tripod gait situation than in the straight-line one. according to the large amount, it often brings trouble to study how allocate the dynamic parameters

10、to these legs. here through careful analysis on tripod gait and comprehensive research on the hexapod robot, the turning gait will be achieved.as is shown in the experimental results, the control system of the hexapod bio-robot takes the feature of stable and coordinate. the four-leg gait does bette

11、r than tripod gait in the respect of weight-bearing but performs weaker in the respect of velocity. the tripod gait applies to smooth interface because of its quickness and flexibleness. on the contrary, four-leg gait can satisfy rough ground for the salient characteristic of weight-bearing, which b

12、eyond the multi-wheel robots.key words: hexapod robot, bionic, gait, basic stamp, servo motor摘要iabstractii第一章緒論111機(jī)器人的發(fā)展背景及意義11.2六足仿生機(jī)器人11. 2. 1具有代表性的六足仿生機(jī)器人11.2.2仿生六足機(jī)器人的特點(diǎn)313課題研究的主要內(nèi)容4第二章六足機(jī)器人硬件系統(tǒng)52.1機(jī)器人的結(jié)構(gòu)52. 2控制器與執(zhí)行器62. 2.1控制器62.2.2伺服電機(jī)7第三章六足機(jī)器人運(yùn)動(dòng)步態(tài)控制研究93. 1三角步態(tài)走法93.1.1步態(tài)的基木概念93. 1.2三角步態(tài)原理103.1.

13、3占空系數(shù)分析113.1.4行走穩(wěn)定性分析1232四足步態(tài)、波動(dòng)步態(tài)與三角步態(tài)的比較143. 2. 1各種步態(tài)143.2.2各腿的相位關(guān)系153. 2.3比較分析17第四章六足機(jī)器人運(yùn)動(dòng)控制程序設(shè)計(jì)184. 1六足機(jī)器人初始值設(shè)定184. 2三角步態(tài)整體程序設(shè)計(jì)194. 2.1六足機(jī)器人直線正向運(yùn)動(dòng)程序214. 2. 2六足機(jī)器人右側(cè)轉(zhuǎn)彎運(yùn)動(dòng)程序244. 3四足步態(tài)止向直行程序設(shè)計(jì)264.4實(shí)驗(yàn)結(jié)果294.4. 1實(shí)驗(yàn)條件294. 4.2棊于三角步態(tài)的直線行走實(shí)驗(yàn)304. 4.3基于三角步態(tài)的右側(cè)轉(zhuǎn)彎實(shí)驗(yàn)31第五章結(jié)論與展望341 2 - 錄錄馭 附附聲第一章緒論1.1機(jī)器人的發(fā)展背景及意義隨

14、著社會(huì)的發(fā)展和科技的進(jìn)步，越來(lái)越多的機(jī)電產(chǎn)品進(jìn)入現(xiàn)代化生產(chǎn)和 日常生活中，大幅度提高了社會(huì)生產(chǎn)力，并使我們的生活更加舒適與便捷。 機(jī)器人作為20世紀(jì)出現(xiàn)的一個(gè)科學(xué)技術(shù)發(fā)展的代表，無(wú)疑使人們認(rèn)識(shí)到科 技的力量，在大量工業(yè)機(jī)器人的應(yīng)用下，企業(yè)生產(chǎn)效率得到了明顯的提升。 特別是近年來(lái)智能機(jī)器人的出現(xiàn)，給航天、深?？碧降饶壳叭祟悷o(wú)法到達(dá)的 地域的科學(xué)研究工作提供了全新的研究途徑。機(jī)器人的發(fā)展也往往代表了一 個(gè)國(guó)家的科技實(shí)力和工業(yè)化的進(jìn)程。生產(chǎn)的需要和科學(xué)技術(shù)的發(fā)展，也使人 們開(kāi)始認(rèn)識(shí)到生物系統(tǒng)成為開(kāi)辟新技術(shù)的途徑之一，自覺(jué)地把生物界作為各 種技術(shù)思想、設(shè)計(jì)原理和創(chuàng)造發(fā)明的源泉。人們用化學(xué)、物理學(xué)、數(shù)學(xué)

15、以及 技術(shù)模型對(duì)生物系統(tǒng)開(kāi)展著深入的研究，促進(jìn)了生物學(xué)的極人發(fā)展，對(duì)生物 體內(nèi)功能機(jī)理的研究也取得了迅速的進(jìn)展。此吋模擬生物不再是引人入勝的 幻想，而成了可以實(shí)現(xiàn)的事實(shí)。在生物學(xué)和工程技術(shù)的結(jié)合下，人們開(kāi)始將 從生物界獲得的知識(shí)用來(lái)改善i口的或創(chuàng)造新的工程技術(shù)設(shè)備。生物學(xué)開(kāi)始跨 入各行各業(yè)技術(shù)革新和技術(shù)革命的行列，而且首先在自動(dòng)控制、航空、航海 等軍事部門(mén)取得了成功。于是生物學(xué)和工程技術(shù)學(xué)科結(jié)合在一起，互相滲透 孕育出一門(mén)新生的科學(xué)一一仿生學(xué)。將機(jī)器人的研究與仿生學(xué)結(jié)合，能夠充 分拓展機(jī)器人的功能，使機(jī)器人在特定工作條件下能夠模仿生物體的某些生 理特征，適應(yīng)環(huán)境的變化進(jìn)而做岀正確的判斷，使機(jī)構(gòu)

16、運(yùn)動(dòng)更加合理與準(zhǔn)確。 由于目前國(guó)內(nèi)外研究的機(jī)器人多采用輪式移動(dòng)機(jī)構(gòu)，在適應(yīng)復(fù)雜地形吋無(wú)法 滿足工況的耍求，而足式機(jī)器人就可以彌補(bǔ)這些缺點(diǎn)。1.2六足仿生機(jī)器人1.2.1具有代表性的六足仿生機(jī)器人（1）早期的六足機(jī)器人 隨著美國(guó)宇航總署對(duì)外太空探測(cè)計(jì)劃的不斷深入， 迫切需要一種可以在未知復(fù)雜星球表面執(zhí)行勘探任務(wù)的機(jī)器人。由于六足機(jī)器人 的所具有的這方面優(yōu)點(diǎn)，使其早在上世紀(jì)八|年代就已被列入資助研究計(jì)劃。其 研究成果包括八十年代末的genghis和九十年代初的attala和hannibalo genghis （如圖1. 1左）是由irobot公司研制于80年代,每條腿裝有兩個(gè)電機(jī), 使得它可以自由

17、行動(dòng)，但是因?yàn)槊客戎挥袃蓚€(gè)自由度，行動(dòng)有些笨拙。采用遞歸 控制結(jié)構(gòu)，可以使genghis在復(fù)雜路面上行走，包括橫越陡峭的地勢(shì)，爬過(guò)高大 的障礙，避免掉下懸崖。圖 1 1 genghis 和 attilaatt訂a （如圖1.1右）和hannibal是由麻省理工學(xué)院的移動(dòng)式遙控機(jī)械 裝置實(shí)驗(yàn)室于九十年代早期研制成功。他們是該實(shí)驗(yàn)室最早用于自主行星探測(cè)的 機(jī)器人。他們外形相同，只在顏色上有差異，都是genghis的“后代”。它們?cè)?設(shè)計(jì)上強(qiáng)調(diào)模塊化子系統(tǒng)結(jié)構(gòu)，各個(gè)部分（如頭部、腿部和身體）被當(dāng)作獨(dú)立的 模塊來(lái)處理。它的設(shè)計(jì)重量和尺寸受系統(tǒng)復(fù)雜程度的制約，為了保證其在太空運(yùn) 行的可靠性，釆用了冗余設(shè)

18、計(jì)：從機(jī)械角度看，六條腿行走吋，一旦有某條腿失 效，余下的腿仍然可以行走；從傳感器的角度看，這種冗余可以讓來(lái)自不同位置 的傳感器將信號(hào)傳給主控制器，以更有效地分析地形。當(dāng)有傳感器失效吋，剩下 傳感器仍可以讓機(jī)器正常運(yùn)行。（2）九十年代中期的六足機(jī)器人 對(duì)于跨海登陸作戰(zhàn)的部隊(duì)來(lái)說(shuō)，淺灘地雷 是無(wú)疑是最危險(xiǎn)也最頭疼的登陸障礙，出于這點(diǎn)考慮，美國(guó)麻省理工大學(xué)和其下 的is-robot公司得到國(guó)防部高級(jí)研究計(jì)劃局的資助，研制了兩代淺灘探雷機(jī)器 人 arieloariel （如圖1.2左）由美國(guó)is-robots公司于1995年研制。身體配備多 種傳感器，對(duì)周圍環(huán)境和自身狀況的感知非常靈敏。并配備一套自

19、適應(yīng)軟件，可 對(duì)一些變化做出積極的反應(yīng)。它是可以完全翻轉(zhuǎn)的，如果海浪將它打翻，他還可 以“底朝上”的繼續(xù)行走。robot ii （如圖1.2右）是由case western reserve大學(xué)，機(jī)械及航天工 程學(xué)院的仿牛機(jī)器人實(shí)驗(yàn)室研制。它的控制器在場(chǎng)外的計(jì)算機(jī)屮。步態(tài)控制器基 于節(jié)肢動(dòng)物腿部協(xié)調(diào)工作的機(jī)理。通過(guò)改變一個(gè)簡(jiǎn)單的速度參數(shù)，步態(tài)可以從一 個(gè)緩慢的波動(dòng)步態(tài)轉(zhuǎn)換到快速的三足步態(tài)。通過(guò)將仿昆蟲(chóng)反射與步態(tài)控制器結(jié) 合，它可以在復(fù)雜的路面上行走。圖 1.2 ariel 和 robot ii（3）近年完成的典型六足機(jī)器人scorpion 51（如圖1.3）是由美國(guó)波士頓東 北大學(xué)海洋科學(xué)屮心h

20、主水下機(jī)器人研究小組和德國(guó)fraunhofer自主智能系統(tǒng) 研究所（ais）共同完成于2001年。這項(xiàng)工程的口標(biāo)是運(yùn)用集成來(lái)i!行為學(xué)實(shí)驗(yàn) 和無(wú)脊椎動(dòng)物的神經(jīng)生物學(xué)數(shù)據(jù)的低級(jí)行為指令，通過(guò)高級(jí)的控制模式來(lái)組成行 為序列，實(shí)現(xiàn)復(fù)朵的行為。機(jī)器人的設(shè)計(jì)是根據(jù)來(lái)自多足節(jié)支動(dòng)物的解剖學(xué)數(shù)據(jù)。 其采用機(jī)器人的行走控制基于兩個(gè)仿生控制元卩央模式生成元和基本運(yùn)動(dòng)的高 級(jí)行為元。圖 1. 3 scorpion 和 tarrytany （如圖1.4）由德國(guó)杜伊斯堡大學(xué)機(jī)械工程部機(jī)械學(xué)院研制，項(xiàng)口始 于1998年。它是在前一代六足機(jī)器人tum的基礎(chǔ)上研制的。仍然釆用hoik cruse 教授的walknet控制結(jié)

21、構(gòu)，完善了更多的智能策略如加入腿部反射等，這使其行 動(dòng)很靈活。1.2.2仿生六足機(jī)器人的特點(diǎn)仿生機(jī)器人就是模仿自然界屮生物的外部形狀或某些機(jī)能的機(jī)器人系統(tǒng)。 從本質(zhì)上來(lái)講，所謂仿生機(jī)器人就是指利用齊種機(jī)、電、液、光等各種無(wú)機(jī)元器 件和有機(jī)功能體相配合所組建起來(lái)的在運(yùn)動(dòng)機(jī)理和行為方式、感知模式和信息處 理、控制協(xié)調(diào)和計(jì)算推理、能量代謝和材料結(jié)構(gòu)等多方面具有高級(jí)生命形態(tài)特征 從而可以在未知的非結(jié)構(gòu)化環(huán)境下精確地、靈活地、可靠地、高效地完成各種復(fù) 雜任務(wù)的機(jī)器人系統(tǒng)。六足機(jī)器人具有以下幾個(gè)特點(diǎn)(1) 控制結(jié)構(gòu)簡(jiǎn)單。這是因?yàn)槔ハx(chóng)體型和行走步態(tài)比較簡(jiǎn)單，在機(jī)器人的 設(shè)計(jì)過(guò)程屮可以對(duì)其控制系統(tǒng)和行走裝置進(jìn)

22、行簡(jiǎn)化。(2) 行走平穩(wěn)。昆蟲(chóng)行走吋為多足支撐，可以始終保持穩(wěn)定的地面支撐， 所以系統(tǒng)比較容易實(shí)現(xiàn)平穩(wěn)行走。其三角步態(tài)行走法是基于三角型穩(wěn)定性原理的 一種步態(tài)，可確保昆蟲(chóng)穩(wěn)定地行走。(3) 作為行走機(jī)構(gòu)的腿部的數(shù)口屬于冗余設(shè)計(jì)。即使有的腿損壞無(wú)法工作, 其他腿仍可以完成一定的行走。具有的大量的自由度可以使機(jī)器人的運(yùn)動(dòng)更加靈 活，對(duì)凹凸不平的地面的適應(yīng)能力更強(qiáng)。1.3課題研究的主要內(nèi)容木論文主要做了以下的工作(1) 對(duì)機(jī)器人的機(jī)構(gòu)進(jìn)行運(yùn)動(dòng)學(xué)分析(2) 認(rèn)識(shí)機(jī)器人控制系統(tǒng)硬件。包括主控電路的認(rèn)識(shí)，舵機(jī)控制器的認(rèn)識(shí)。(3) 研究了仿生學(xué)的基木知識(shí)和應(yīng)用于昆蟲(chóng)行走的三角步態(tài)，通過(guò)對(duì)其步 態(tài)分析，占空系

23、數(shù)分析、穩(wěn)定性分析、轉(zhuǎn)彎步態(tài)和轉(zhuǎn)彎半徑分析設(shè)計(jì)出六足機(jī)器 人三角步態(tài)行走以及轉(zhuǎn)彎的程序。提出四足步態(tài)和波動(dòng)步態(tài)，并編寫(xiě)四足步態(tài)程 序和三足步態(tài)比較。(4) 將所設(shè)計(jì)的控制系統(tǒng)軟硬件在機(jī)器人木體上進(jìn)行實(shí)驗(yàn)，對(duì)其三角步態(tài)、 四足步態(tài)進(jìn)行驗(yàn)證。第二章六足機(jī)器人硬件系統(tǒng)2. 1機(jī)器人的結(jié)構(gòu)六腳步行機(jī)器人的構(gòu)造相對(duì)于雙足機(jī)器人和雙輪小車復(fù)雜一些，但通過(guò)對(duì)零 配件的分類以及機(jī)械原理的分析，可以幫助你簡(jiǎn)化安裝。首先，六腳步行機(jī)器人的是由三大部分構(gòu)成，機(jī)器人主體、六只帶動(dòng)機(jī)器人運(yùn)動(dòng)的腿、機(jī)器人的伺服控制器芯片與basic stamp控制芯片。如圖2. 1圖2.1六腳步行機(jī)器人機(jī)器人的運(yùn)動(dòng)是靠12個(gè)伺服電機(jī)作為

24、動(dòng)力，每只腿分配2個(gè)電機(jī)（2*6）, 分別控制機(jī)器人的兩個(gè)門(mén)由度，即水平方向和豎直方向（縱向），腿部是由伺服 控制器控制完成運(yùn)動(dòng)過(guò)程，水平推動(dòng)機(jī)器人的前進(jìn)或后退，豎直方向則是利用機(jī) 器人的關(guān)節(jié)拉高或降低。機(jī)器人的主體部分，是由兩塊鋁制板材和兩塊側(cè)板構(gòu)成, 安裝比較簡(jiǎn)單，但它貝有一定的物理意義：固定機(jī)器人的六只腳，換言z不使六 只腳有任何非移動(dòng)范疇的松動(dòng)，并使6只腳在機(jī)器人平放地面時(shí)保持同一水平 面，每只腳必須與地面完全接觸。因?yàn)椴环€(wěn)固的安裝會(huì)使每只腿的移動(dòng)距離存在 誤差，從而使機(jī)器人行走時(shí)出現(xiàn)摔落情況，十分危險(xiǎn)。另外兩個(gè)控制器也安裝其 上（如圖2.1）,因此耍求比較高的穩(wěn)定性。2. 2控制器與

25、執(zhí)行器2.2.1控制器控制器（如圖2.2）安裝在機(jī)器人頂部，兩控制器用導(dǎo)線相連接，保證 完成數(shù)據(jù)的正確傳輸。basic stamp控制器的主要功能是完成計(jì)算機(jī)與機(jī)器人的 數(shù)據(jù)傳輸（basic stamp指令的傳輸），計(jì)算機(jī)用15針com 口數(shù)據(jù)線與控制器相 連，傳輸各利'basic stamp程序，在控制器收到數(shù)據(jù)后再次傳輸給伺服電機(jī)控制 器。伺服控制器與機(jī)器人的六只腳通過(guò)電路相連，對(duì)它們進(jìn)行直接控制，而后伺 服電機(jī)帶動(dòng)機(jī)器人運(yùn)動(dòng)。具體執(zhí)行過(guò)程見(jiàn)圖2. 3,另外，basic stamp控制器與 伺服電機(jī)控制器各用6*1. 5v供電2。圖 2. 2 basic stemip 控制器a：通

26、過(guò)15針com 口數(shù)據(jù)線與計(jì)算機(jī)保持連接圖a為接口部分b： 9v控制器供電部分，可用9v電池或者6*1.5v電池，也可通過(guò)變壓器 連接電源。c：連接伺服電動(dòng)機(jī)接口，止常機(jī)器人連接時(shí)與伺服控制器連接端d：開(kāi)關(guān)，在測(cè)試電機(jī)時(shí)，撥開(kāi)關(guān)至2端另外在圖a與dz間存在一個(gè)可編程芯片，它是basic stamp控制器的核 心部分，插入在面板上。芯片的型號(hào)決定編程的語(yǔ)言種類，不同的型號(hào)在編輯 程序過(guò)程中,會(huì)存在大小不同的差異。比如，圖中為basic stamp bs2型號(hào)。 它用來(lái)對(duì)六腳步行機(jī)器人進(jìn)行編程，同時(shí)也適用于很多其他控制對(duì)象。在此次 設(shè)計(jì)過(guò)程中，所有的編程指令都依據(jù)bs2控制芯片。圖2. 3機(jī)器人執(zhí)

27、行任務(wù)流程圖2. 2.2伺服電機(jī)伺服電機(jī)被廣泛運(yùn)用于無(wú)電線遙控的汽車、輪船和飛機(jī)的運(yùn)動(dòng)方向及油門(mén) 系統(tǒng)的控制。這些伺服電機(jī)被設(shè)計(jì)用來(lái)控制某一物休的特定位置，例如無(wú)線遙控 e機(jī)的方向舵。他們的控制范圍一般從90度到270度，特別適應(yīng)于要求價(jià)格低 廉、精度較高、力矩較大的位置控制場(chǎng)合。通過(guò)利用一種信號(hào)來(lái)控制這些伺服 電機(jī)的位置，稱這種信號(hào)為脈沖序列。伺服電機(jī)內(nèi)安裝有一個(gè)機(jī)械限位器，防止 電機(jī)轉(zhuǎn)動(dòng)超岀其設(shè)定的運(yùn)動(dòng)范圍。伺服電機(jī)內(nèi)還裝有一個(gè)位置反饋裝置，這樣一 來(lái)伺服電機(jī)內(nèi)的控制電路才能知道在響應(yīng)脈沖序列時(shí)轉(zhuǎn)到哪。本次使用六腳步行 機(jī)器人的電機(jī)能轉(zhuǎn)過(guò)最大角度約270度。從basic stamp控制器屮

28、發(fā)送出的一組控制伺服電機(jī)的控制信號(hào)被稱為“脈 沖序列”，控制器能通過(guò)編程產(chǎn)生這樣的信號(hào)波型，而且述能用它任意的一個(gè) 1/0 口進(jìn)行信號(hào)輸岀。下面舉例說(shuō)明：控制器向p15（basic stamp控制器向伺服控制器發(fā)送信號(hào)的 輸出口之一）發(fā)送一個(gè)1500微秒的脈沖信號(hào)。在1500微秒高電平輸出后，繼續(xù) 發(fā)送一個(gè)20毫秒的低電平給該引角，產(chǎn)生一組脈沖序列。這個(gè)脈沖序列由1500 微秒的高電平和25毫秒的低電平組成。伺服電機(jī)控制的主要由1500微秒的高電 平來(lái)控制，我們通常稱這一段時(shí)間為脈寬。脈沖信號(hào)由低電平到高電平這一變化 過(guò)程稱上升沿。由高電平到低電平的變化我們稱為下降沿。所使用的伺服電機(jī)， 伺服

29、脈沖之間的理想時(shí)間間隔為10-40毫秒（例為25毫秒），如果高于或者低于 這個(gè)范圍，將影響伺服電機(jī)的正常運(yùn)行。由于六腳步行機(jī)器人的構(gòu)造相對(duì)復(fù)雜，乂加入了伺服電機(jī)控制（具體作用前 面以做介紹），因此脈沖信號(hào)要再通過(guò)伺服電機(jī)控制器的2次傳遞才能到達(dá)機(jī)器 人腳部，但電機(jī)的工作原理完全相同。伺服電機(jī)控制器和控制器用一根信號(hào)傳輸線相連，接到控制器的p15串口， 在伺服電機(jī)控制器上有16個(gè)通道用于和伺服電機(jī)相連接。木文所提到的六足機(jī) 器人由于只有12個(gè)伺服電機(jī)，所以只用其屮的12個(gè)通道用于和伺服電機(jī)的連接。 cho ch2 ch4、ch6、ch8> chlo六個(gè)通道用于連接水平方向的電機(jī),chl&g

30、t; ch3、 ch5> ch7、ch9 chll六個(gè)通道用于連接垂直方向的電機(jī)。因?yàn)樵陂_(kāi)始拿到機(jī)器人的時(shí)候并不知道各個(gè)電機(jī)是什么樣的安裝狀態(tài)，所以 需要對(duì)電機(jī)進(jìn)行測(cè)試。首先對(duì)六個(gè)水平電機(jī)進(jìn)行測(cè)試，當(dāng)同時(shí)給六個(gè)水平電機(jī)加 一個(gè)使其正轉(zhuǎn)的脈沖時(shí)可以測(cè)試出六個(gè)水平電機(jī)正轉(zhuǎn)時(shí)每條腿處于什么樣的位 置。如圖2. 4所示，機(jī)器人右側(cè)三條腿全部向前邁進(jìn)，左側(cè)三條腿反z。然后對(duì) 垂直電機(jī)進(jìn)行測(cè)試，當(dāng)同時(shí)給六個(gè)垂直電機(jī)加一個(gè)使其正轉(zhuǎn)的脈沖時(shí)，可以發(fā)現(xiàn) 兩側(cè)的中間的腿和另外四條腿方向不一致，所以可以知道這兩個(gè)電機(jī)安裝的時(shí)候 和其他幾個(gè)時(shí)相反的。對(duì)12個(gè)電機(jī)測(cè)試完成z后，在后面的程序中要注意各個(gè) 電機(jī)的止轉(zhuǎn)

31、以及反轉(zhuǎn)造成的每條腿的狀態(tài)。第三章六足機(jī)器人運(yùn)動(dòng)步態(tài)控制研究3.1三角步態(tài)走法任何動(dòng)物的行走有具有一定的方式，動(dòng)物種類的不同導(dǎo)致行走方式的差異， 并且同一動(dòng)物在不同的狀況下具有不同的步態(tài)。三角步態(tài)走法就是六足昆蟲(chóng)常見(jiàn) 的一種步態(tài)°。3. 1. 1步態(tài)的基本概念步態(tài)是行走系統(tǒng)的邁步方式，即行走系統(tǒng)抬腿和放腿的順序。人和動(dòng)物的行 走吋都具有一定的步態(tài)。例如獵豹在奔跑吋兩個(gè)前腿為一對(duì)，兩個(gè)后腿為一 組，后腿發(fā)力前腿收縮，從而飛速前進(jìn)。四足動(dòng)物在行走吋，四條腿形成對(duì)角的 兩對(duì)，先是左前腿與右后腿同時(shí)著地，然后才是右前腿與左后腿。人在行走吋也 是同理，左臂和右腿為一組，右臂和左腿為一組交替擺動(dòng)

32、，實(shí)現(xiàn)平穩(wěn)行走。不同 的物種在不同的行動(dòng)狀態(tài)下具有不同的步態(tài)。由于開(kāi)發(fā)步行機(jī)器人的需要，美國(guó)著名機(jī)器人學(xué)家r.b.mcghee在總結(jié)前人 對(duì)動(dòng)物步態(tài)研究成果的基礎(chǔ)上，系統(tǒng)地給出了一系列描述和分析步態(tài)的嚴(yán)格的數(shù) 學(xué)定義。之后各國(guó)學(xué)者在四足、六足、八足等多足步行機(jī)的靜態(tài)穩(wěn)定的規(guī)則周期 步態(tài)的研究屮取得了很多成果，這些成果包括各種步態(tài)特點(diǎn)及分類，如三角步態(tài)、 波動(dòng)步態(tài)、自由步態(tài)、跟隨步態(tài)、步態(tài)參數(shù)及其相互關(guān)系等，但是這些研究很多 都局限在步態(tài)分析的圈子里，其屮很多研究成果并不考慮具體的實(shí)現(xiàn)山。步態(tài)是牛物學(xué)所用的術(shù)語(yǔ)，在研究基于仿生學(xué)原理的多足步行機(jī)器人時(shí)需要 借鑒相關(guān)概念和參數(shù)，具體表述如下氏：(1

33、) 步態(tài)(gait)o腿部擺動(dòng)順序及其時(shí)間相序等的步行模式。(2) 支撐相(support phase)o腿部著地的狀態(tài)叫做支撐相或站立相。(3) 擺動(dòng)相(swing phase)o腿部處于空中的狀態(tài)叫做擺動(dòng)相。(4) 支撐多邊形(support polygon)o支撐腿著地點(diǎn)用凸形輪廓線所構(gòu)成的凸 多邊形在水平面的投影。六足機(jī)器人的支撐多邊形為三角形。(5) 步長(zhǎng)(stride length)o指單位周期機(jī)器人重心移動(dòng)距離。(6) 占空系數(shù)(duty factor).,指腿著地時(shí)間與步行周期時(shí)間之比。所有腿的 占空系數(shù)都相等的步態(tài)稱為規(guī)則步態(tài)，幾乎所有的動(dòng)物都采用規(guī)則步態(tài)，步行機(jī) 器人一般也

34、以此為基準(zhǔn)。3. 1.2三角步態(tài)原理昆蟲(chóng)屬于節(jié)肢動(dòng)物門(mén)屮的昆蟲(chóng)綱，特征為體軀三段(頭、胸、腹)，兩對(duì)翅 膀六只足和一對(duì)觸角，一生形態(tài)多變化。它是自然界屮最龐大的物種，全世界已 知的150萬(wàn)種動(dòng)物屮，昆蟲(chóng)就有100萬(wàn)種以上，即占2/3昆蟲(chóng)在十幾億年的發(fā)展 過(guò)程屮，為了適應(yīng)環(huán)境機(jī)體發(fā)生了近乎完滿的進(jìn)化過(guò)程。人們研究發(fā)現(xiàn)，生物 的這種為了適應(yīng)環(huán)境所形成的進(jìn)化方案，可以為工程技術(shù)提供十分重要的參考信 息，將極大地提高人類的適應(yīng)性和改造能力，產(chǎn)生巨大的社會(huì)及經(jīng)濟(jì)效益，因此 研究昆蟲(chóng)的特性就具有一定的現(xiàn)實(shí)意義。昆蟲(chóng)有幾種步態(tài)，如螳螂、蟋蟀在跳躍 吋是一種跳躍步態(tài)，兩個(gè)強(qiáng)有力的后退蹬地從而實(shí)現(xiàn)跳躍。在慢行吋

35、又是一種 步態(tài)，在行走吋遵循三角步態(tài)走法。其規(guī)則是每次落腳和提腳前進(jìn)吋相應(yīng)的一組 足都是正三角型，這可以確保行走的穩(wěn)定。很多不具備跳躍能力的昆蟲(chóng)，如蜜蜂、 甲殼蟲(chóng)等和有跳躍能力但是在地面上慢行的昆蟲(chóng)行走吋，多以交替的三角步態(tài)運(yùn) 動(dòng)，即在步行吋將六只足分為兩組，以身體一側(cè)的前足、后足與另一側(cè)的屮足作 為一組，其他三只足作為另一組。當(dāng)一組足同吋提起吋，另一組足支撐身體，并 以中足為支點(diǎn)，前足脛節(jié)肌肉收縮，拉動(dòng)身體向前，后腿脛節(jié)肌肉收縮，推動(dòng)身 體向前，此吋蟲(chóng)體的屮心落在另一組足的三角形上，以此往復(fù)交替，實(shí)現(xiàn)快速行 走。這種步態(tài)可以使昆蟲(chóng)隨吋隨地停息和運(yùn)動(dòng)，三角形的支撐點(diǎn)也使蟲(chóng)體站立與 行走更加穩(wěn)定

36、。六足昆蟲(chóng)在行走吋的軌跡如圖3. 1所示。 o o o>o o o o圖3.1六足昆蟲(chóng)行走軌跡圖當(dāng)用機(jī)器人模仿昆蟲(chóng)的步態(tài)時(shí)，英運(yùn)動(dòng)步驟可以描述為六種狀態(tài)。如圖3.2 所示，黑點(diǎn)表示為支撐足，白點(diǎn)表示為擺動(dòng)足。狀態(tài)1：當(dāng)機(jī)器人開(kāi)始運(yùn)動(dòng)時(shí)，足1、3、5從后方準(zhǔn)備向前擺動(dòng)，足2、4、 6處于支撐狀態(tài)，支撐機(jī)器人本體確保機(jī)器人的重心位置處丁三足所構(gòu)成的三角 形內(nèi),使機(jī)器人處于穩(wěn)定狀態(tài)不至于摔倒。如圖3.2 (a)o狀態(tài)2：擺動(dòng)足1、3、5擺動(dòng)到前方，2、4、6足繼續(xù)支撐機(jī)本體。如圖3.2 (b)o狀態(tài)3：支撐足2、4、6 而支撐機(jī)器人本體，一而在伺服電機(jī)作用下驅(qū)動(dòng)機(jī)器人本體，使機(jī)器人機(jī)體向前運(yùn)動(dòng)

37、半個(gè)步長(zhǎng)。如圖3. 2 （c）。狀態(tài)4：在機(jī)器人機(jī)體移動(dòng)到位吋，原先的擺動(dòng)足1、3、5立即放下，呈支 撐態(tài)，使機(jī)器人的重心位置處于1、3、5三只足所構(gòu)成的三角形穩(wěn)定區(qū)內(nèi)，原來(lái) 的支撐足2、4、6變成擺動(dòng)足，準(zhǔn)備向前跨步。如圖3. 2 （d）o狀態(tài)5：擺動(dòng)足2、4、6向前跨步，支撐足1、3、5支撐機(jī)器人木體。如圖 3. 2 （e）o狀態(tài)6：支撐足1、3、5 面支撐機(jī)器人木體，一面驅(qū)動(dòng)機(jī)器人本體，使機(jī) 器人機(jī)體又向前運(yùn)動(dòng)了半個(gè)步長(zhǎng)。如圖3. 2 （f）o如此不斷從步態(tài)（a）、（b）、（c）、（d）、（e）、（f）、（a）循環(huán)往復(fù)，實(shí)現(xiàn)機(jī) 器人向前快速運(yùn)動(dòng)。這種行走方式使昆蟲(chóng)可以隨時(shí)隨地停息下來(lái)，因

38、為重心總是 落在三角支架之內(nèi)。這就是典型的三角步態(tài)行走法，其行走軌跡并非是直線，而 是呈“之”字形的曲線前進(jìn)。(«)圖3. 2二角步態(tài)示意圖3.1.3占空系數(shù)分析占空系數(shù)是指支撐腿支撐在地面的時(shí)間占這個(gè)行走周期的比例"。即：b二腿的支撐吋間腿的周期時(shí)間b值不同時(shí)，機(jī)器人的狀態(tài)不同，其表述如門(mén)（1）p<0.5,這種情況卜，機(jī)器人兩組足同時(shí)行走的ii舜間，會(huì)存在同時(shí)擺動(dòng)的情況，這樣機(jī)器人出現(xiàn)騰空的狀態(tài)，這要求機(jī)器人要具有良好的彈性和吸振性。（2）3=0.5,兩組足步行時(shí)，每組的支撐時(shí)間與擺動(dòng)時(shí)間相等，保證在任意時(shí)刻都有三條腿支撐地面，三條腿擺起。這是規(guī)則步態(tài)。(3) b0

39、.5,在兩組足交替擺起和著地的過(guò)程屮，有六條腿瞬間同時(shí)著地， 這會(huì)使機(jī)器人行走更穩(wěn)定，但是行走速度會(huì)相對(duì)降低。由于行走機(jī)構(gòu)在運(yùn)動(dòng)吋會(huì) 出現(xiàn)不可消除的摩擦力，并且為了保證機(jī)器人的穩(wěn)定行走，木設(shè)計(jì)屮的機(jī)器人占 空系數(shù)大于0.5e11o3.1.4行走穩(wěn)定性分析在機(jī)器人行走過(guò)程屮，假設(shè)1、3、5足為一組，其支撐點(diǎn)為一等邊三角形， 以其重心為原點(diǎn)做直角坐標(biāo)系，原點(diǎn)為0,三點(diǎn)的坐標(biāo)為1 (xl, yl), 3 (x3, y3), 5 (x5, y5)。如圖3. 3所示。當(dāng)機(jī)器人運(yùn)動(dòng)一個(gè)步長(zhǎng)后，2、4、6足向前 擺動(dòng)，1、3、5足向前移動(dòng)半個(gè)步長(zhǎng)，三點(diǎn)的坐標(biāo)變化為r (xi , yr ), 3 '(

40、x3，y3)，5(x5，y5,),其重心0仍在原三角形內(nèi)，可知其運(yùn)動(dòng)是穩(wěn)定的步態(tài)。¥圖3. 3三角形步態(tài)的坐標(biāo)分析3.1.5轉(zhuǎn)彎狀態(tài)分析轉(zhuǎn)向運(yùn)動(dòng)過(guò)程分析，相比于直線運(yùn)動(dòng)存在一些差別，對(duì)于一個(gè)可以轉(zhuǎn)動(dòng)的物 體，它都需耍有一個(gè)軸作為旋轉(zhuǎn)的中心，那么對(duì)與六腳步行機(jī)器人來(lái)說(shuō)也一樣。 設(shè)置一個(gè)轉(zhuǎn)動(dòng)軸心是必耍的條件，在這里的軸心是由一只腳負(fù)責(zé)帶動(dòng)其他腳進(jìn)行 順時(shí)針或逆時(shí)針的轉(zhuǎn)動(dòng)(左轉(zhuǎn)或右轉(zhuǎn))。下而以右轉(zhuǎn)為例，分析下六腳步行機(jī)器 人的運(yùn)動(dòng)原理。向右側(cè)轉(zhuǎn)動(dòng)，選用機(jī)器人左側(cè)的后端腳為軸心，形成一個(gè)以這只 腳為屮心，機(jī)器人前端整體旋轉(zhuǎn)的情況。當(dāng)然也可以選擇左側(cè)的前端腳為軸心， 但實(shí)際情況變成了以它為中心

41、，機(jī)器人的后端整體轉(zhuǎn)動(dòng)*。那么在確定軸心的前提下，其他的五只腳應(yīng)當(dāng)怎樣協(xié)調(diào)運(yùn)動(dòng)呢？六腳步行機(jī)器人的屮端兩只腳在旋轉(zhuǎn)過(guò)程屮具有提供轉(zhuǎn)向動(dòng)力的功能。換言之，在轉(zhuǎn)動(dòng)過(guò)程 屮除屮端腳與軸心腳的其他三只腳不是提供動(dòng)力的，所謂的“動(dòng)力”便是在水平 方向的位移。保持六腳步行機(jī)器人的穩(wěn)定運(yùn)動(dòng)至少要保證有三只腳在地面支撐， 那么其他三只腳在轉(zhuǎn)動(dòng)過(guò)程屮就是起到這種作用，維持機(jī)器人的穩(wěn)定性。在向右轉(zhuǎn)動(dòng)的過(guò)程屮，如果選用后端左側(cè)腳作為軸心，它依靠縱向伺服電機(jī) 提起從而向前水平位移(它與屮端兩只腳配合提供轉(zhuǎn)動(dòng)動(dòng)力)。向前水平位移則 提供向左轉(zhuǎn)動(dòng)的動(dòng)力。如圖3. 4所示。軸心腳向前位移的同吋，屮端的兩只腳也 隨之提起并位

42、移，值得注意的是，屮端兩只腳的水平運(yùn)動(dòng)方式存在差異，即方向 相反。原因很簡(jiǎn)單，一只與軸心腳在同側(cè)，一只與軸心腳在異側(cè)，達(dá)到協(xié)調(diào)運(yùn)動(dòng) 的口的必然存在運(yùn)動(dòng)方式的差別。這三只腳同時(shí)提起，同吋落地，而要滿足三角 支撐穩(wěn)定性的任務(wù)，就需要其他三只腳的縱伺服電機(jī)了。在軸心和屮端腳提起的 時(shí)候，控制這3只腳落地，達(dá)到穩(wěn)定移動(dòng)。如圖所示，六腳步行機(jī)器人在右轉(zhuǎn)過(guò)程屮腳步的移動(dòng)情況，箭頭標(biāo)明了方向, 對(duì)于向左轉(zhuǎn)彎的過(guò)程，也與此原理十分類似。圖3. 4右轉(zhuǎn)彎示意圖完成對(duì)六腳步行機(jī)器人狂 某種意義上說(shuō)它是機(jī)器人務(wù) 觀運(yùn)動(dòng)規(guī)律的陸程7地驢 正確的程序。e設(shè)計(jì)程序前所必須的。從 只有分析岀符合機(jī)器人客 卩步行機(jī)器人運(yùn)動(dòng)合

43、理程的3. 2四足步態(tài)、波動(dòng)步態(tài)在行進(jìn)過(guò)程中，節(jié)肢動(dòng)物 由兩個(gè)相交替變化實(shí)現(xiàn)的。一旬期性變化，這一變化，是 e衣e),此狀態(tài)包扌舌腿的抬起、前擺和下落并與地面接觸；另一個(gè)是支撐相(stance phase),是指腿部支撐地 面，承受載荷，并向后擺動(dòng)的過(guò)程。3. 2. 1各種步態(tài)節(jié)肢動(dòng)物步態(tài)的描述通常是以狀如斑馬線的步態(tài)圖表示，以竹節(jié)蟲(chóng)的步態(tài)圖為例，最常見(jiàn)的三種步態(tài)分別是三足步態(tài)(tripod gait)如圖3.5、四足步態(tài)(tetrapod gait)如圖3. 6和波動(dòng)步態(tài)(wave gait)如圖3. 7,這三種步態(tài)的差別在于某一時(shí)刻，支撐腿的數(shù)口分別為3, 4和5。三足步態(tài)是昆蟲(chóng)穩(wěn)定行走

44、時(shí)，速度最快的一種步態(tài)。其b值略大于0. 5。最大特點(diǎn)是，每一步有三條腿（r2、 li、l3）支撐地面，形成穩(wěn)定的三角形支撐結(jié)構(gòu)，同吋另外三條腿（rl、r3、l2） 快速向前方邁進(jìn)、落地并形成新的三角形支撐，如此交替。由于這種步態(tài)的腿部 狀態(tài)只有2種：支撐和前擺，實(shí)現(xiàn)起來(lái)比較簡(jiǎn)單，即使采用機(jī)構(gòu)也可以實(shí)現(xiàn)，所 以在許多控制系統(tǒng)簡(jiǎn)單的仿生機(jī)器人屮廣泛采用。這是一種效率很高的行走方 式，理論上b值可以達(dá)到0.5,但是為了使支撐腿與前擺腿的狀態(tài)交換時(shí)保持穩(wěn) 定，需要加入一段共同支撐的時(shí)間，即狀態(tài)的過(guò)渡時(shí)間。zzi圖3. 5三足步態(tài)四足步態(tài)（如圖3. 6）則是相對(duì)緩慢的一種步態(tài)，每一時(shí)刻都有4條腿在地

45、面支撐，而每側(cè)各有一條腿向前擺動(dòng)，這種步態(tài)由于支撐時(shí)間較長(zhǎng)，可以承受比 較大的載荷。其b值約為0. 67,穩(wěn)定系數(shù)為4l9：o圖3. 6四足步態(tài)波動(dòng)步態(tài)（如圖3.7）是最為緩慢的一種步態(tài)，毎一時(shí)刻都有5條以上的腿 支撐地面，整個(gè)身體緩慢平穩(wěn)的向前移動(dòng)，前擺腿的順序?yàn)?l1-l2-l3-r1-r2-r3-l1,依次循環(huán)。其b值大于0. 83,穩(wěn)定系數(shù)大于5。圖3. 7波動(dòng)步態(tài)節(jié)肢動(dòng)物的步態(tài)變化主要與其運(yùn)動(dòng)的速度和載荷有關(guān)，載荷越大，要求單位 吋間內(nèi)支撐腿的數(shù)口越多，b越大，后撐時(shí)間越長(zhǎng)，移動(dòng)速度也就越慢。3. 2. 2各腿的相位關(guān)系每側(cè)的腿按照由前向后的順序，依次抬起落下，后面的腿依次重復(fù)前面腿

46、的 動(dòng)作，動(dòng)作像波浪一樣傳播，如圖3. 8所示。圖3. 8腿部動(dòng)作的傳播為了研究動(dòng)作在腿之間傳播的相位關(guān)系，定義節(jié)拍的概念：一條腿的某 種動(dòng)作傳播到與它相鄰的下一條腿的時(shí)間為一拍?？梢?jiàn)同側(cè)相鄰的腿之間的 相位差是一拍。為了研究?jī)蓚?cè)腿的“步態(tài)波”之間的相位差，將節(jié)肢動(dòng)物三種典 型步態(tài)的各腿運(yùn)動(dòng)的同步關(guān)系畫(huà)成示意圖，如圖3. 9所示川。圖3.9 （a）三足步態(tài)圖3.9 （b）四足步態(tài)圖3.9 （c）波動(dòng)步態(tài)由圖3. 9可以看出，對(duì)于三足步態(tài)，右側(cè)腿的動(dòng)作比左側(cè)落后1拍，對(duì)于四 足步態(tài)，右側(cè)腿的動(dòng)作比左側(cè)落后2拍，對(duì)于波動(dòng)（五足）步態(tài)，右側(cè)腿的動(dòng)作 比左側(cè)落后3拍。由此口j以歸納岀規(guī)律：對(duì)于n足步態(tài)

47、，右側(cè)腿比左側(cè)腿的動(dòng)作 落后n-2拍山。3.2.3比較分析上文講到三足步態(tài)，四足以及波動(dòng)步態(tài)的原理和行走方法，并且對(duì)各種步 態(tài)的特點(diǎn)進(jìn)行了比較完整的闡述。下面對(duì)這幾種步態(tài)進(jìn)行比較分析。（1）三種步態(tài)最少需要三條腿做支撐，也就是說(shuō)支撐相不能小于3。三足 步態(tài)同時(shí)冇三個(gè)支撐相三個(gè)擺動(dòng)相，只有兩種組合，交替比較迅速，所以行走比 較快速。（2）四足步態(tài)行走每次有四個(gè)支撐相，兩個(gè)擺動(dòng)相三種組合，所以支撐吋 間長(zhǎng)，動(dòng)作較緩慢。但是由于每次冇四條腿支撐在地面所以載荷比較大。（3）波動(dòng)步態(tài)行走時(shí)每次有五個(gè)支撐相，一個(gè)擺動(dòng)相，所以存在六種組合, 由于每次有五條腿同時(shí)支撐在地面所以支撐時(shí)間最長(zhǎng)，動(dòng)作最緩慢。但是其

48、載荷 能力也最強(qiáng)。(4) 由于四足步態(tài)是同時(shí)有四條腿支撐在地面上，所以其四個(gè)點(diǎn)可以構(gòu)成 一個(gè)四邊形。四邊形的穩(wěn)定性比三角形穩(wěn)定性差，所以四足步態(tài)容易發(fā)生偏離設(shè) 定軌跡的現(xiàn)象。綜上所述，三足步態(tài)適用于平穩(wěn)的一般的情況下，三足步態(tài)也是最常規(guī)的步 態(tài)，當(dāng)遇到需要載荷吋可以考慮用到四組步態(tài)或是波動(dòng)步態(tài)。遇到不平整的地面 時(shí)，由于三組步態(tài)的支撐相較少所以可能會(huì)出現(xiàn)較大的沖擊或是不能按照正常步 態(tài)行走，這吋候就需要考慮多足步態(tài)的使用。由于四足步態(tài)和波動(dòng)步態(tài)的支撐相 比較多而需要擺動(dòng)的腿少所以遇到崎嶇的路時(shí)不會(huì)產(chǎn)生較大的波動(dòng)，但是在達(dá)到 穩(wěn)定的同時(shí)速度會(huì)變慢。六足機(jī)器人能力與其速度成反比，但是在平坦的地面上

49、 三角步態(tài)最穩(wěn)定。所以在設(shè)計(jì)步態(tài)吋需考慮現(xiàn)實(shí)的環(huán)境和速度的關(guān)系，以求在其 保證穩(wěn)定的情況下盡可能的達(dá)到最大速度。第四章 六足機(jī)器人運(yùn)動(dòng)控制程序設(shè)計(jì)4.1六足機(jī)器人初始值設(shè)定在編輯主程序前，對(duì)數(shù)據(jù)通信要明確，由于利用的是com串口數(shù)據(jù)通信，便 于數(shù)據(jù)的同步傳輸，使用波特率(baud)作為傳輸信號(hào)。basic stamp控制器與 伺服電機(jī)控制直接通過(guò)的數(shù)據(jù)線連接的接口位置(pin 15)也要明確標(biāo)明。在程 序前段也要設(shè)置出來(lái)，下面對(duì)幾個(gè)所需要的初始值進(jìn)行設(shè)定2：psc con 15baud con 396ramp con 1“psc”代表伺服電機(jī)控制器。六腳步行機(jī)器人的運(yùn)動(dòng)速率由兩個(gè)變量來(lái)控 制，

50、其一 是腳部擺動(dòng)的幅度，可以根據(jù)程序屮變量進(jìn)行直接修改來(lái)改變運(yùn)動(dòng)速率, 而第二點(diǎn)是容易被忽視的，便是伺服電機(jī)的轉(zhuǎn)動(dòng)速率，可以形象地描述兩者之間 的關(guān)系，如同一個(gè)人在走路，加大腳步邁出的幅度和增加跨步的頻率，都可以使 人的步行速度增加刃。這里的伺服電機(jī)轉(zhuǎn)速，便是跨步的頻率。當(dāng)然伺服電機(jī) 的轉(zhuǎn)動(dòng)速率肯定是有極限的。所以控制好伺服電機(jī)的速率是t分重要的，在編輯 程序前，一定要進(jìn)行設(shè)置，僅僅編輯出運(yùn)動(dòng)形態(tài)，而沒(méi)有具體運(yùn)動(dòng)的速率，機(jī)器 人是不可能完成任務(wù)的。所以速率可以設(shè)置為ramp con 1,在這里con代表常 量?；趐absic編程指令，要在主程序編輯前對(duì)它進(jìn)行初始值的設(shè)定。根據(jù)六 腳步行機(jī)器人

51、的特點(diǎn)，六只腳12個(gè)伺服電機(jī)在控制過(guò)程屮比較復(fù)雜，且在運(yùn)動(dòng) 過(guò)程中，同一吋刻承擔(dān)的任務(wù)不同，所以要對(duì)它們加以區(qū)分，便于編程與控制。 12個(gè)伺服電機(jī)可以以10進(jìn)制數(shù)代表如“0”到“11” 一次代表12個(gè)電機(jī)（水平 與縱向電機(jī)均在其內(nèi)）。其設(shè)置如下cho = 0chi = 1ch2 = 2ch3 = 3ch4 = 4ch5 = 5ch6 = 6ch7 = 7ch8 = 8ch9 = 9chlo= 10chll = 11“cho”到“chll”代表連接伺服電機(jī)的通道。另外由于垂直方向和水平方向上電機(jī)的正反轉(zhuǎn)不是一致的，并且電機(jī)的正反 轉(zhuǎn)使每條腿的運(yùn)動(dòng)狀態(tài)不同，所以需要設(shè)置幾個(gè)變量用以調(diào)節(jié)每條腿的抬起

52、、下 落，前進(jìn)、后退。其設(shè)置如下：hoi var wordho2 var wordho3 var wordho4 var wordho5 var word在下面的具體的子程序里可以看到這幾個(gè)變量的作用。4. 2三角步態(tài)整體程序設(shè)計(jì)六足機(jī)器人三角步態(tài)程序整體設(shè)計(jì)思路是采用主程序通過(guò)循環(huán)調(diào)用子程序 來(lái)達(dá)到其行走以及轉(zhuǎn)彎的口的。其主程序非常簡(jiǎn)單，用了一些循環(huán)和跳轉(zhuǎn)子程序 的指令，程序如下eb 21 ：gosub initializationfor n = oto 10gosub movestraightn = n+lnextfor n = 0 to 6gosub tumrightn = n+lnex

53、t4.2.1六足機(jī)器人初始化程序六足機(jī)器人最初的時(shí)候需要對(duì)其進(jìn)行初始化，口的是使每條腿都處于一致的 靜止的狀態(tài)為其后行走和轉(zhuǎn)彎程序的設(shè)計(jì)做好準(zhǔn)備，并h這個(gè)過(guò)程屬于伺服電機(jī) 調(diào)零的過(guò)程。由于電機(jī)在出廠時(shí)，沒(méi)有進(jìn)行電氣調(diào)整，這將使它接受到信號(hào)吋產(chǎn) 牛誤差，調(diào)零的原因就在這里，也可以說(shuō)伺服電機(jī)的調(diào)整是在其使用前不可缺少 的一步。所以六組機(jī)器人的初始化是必不可少的。圖4.1顯示的信號(hào)是發(fā)送到與p15連接的伺服電機(jī)校準(zhǔn)信號(hào)，又稱零點(diǎn)標(biāo)定 信號(hào)。伺服電機(jī)調(diào)好之后，這個(gè)信號(hào)就可以指示電機(jī)保持靜止。這個(gè)指令是由間 隔20ms,脈沖帶寬1. 5ms的一組系列脈沖組成。從圖屮很容易可以看出兩個(gè)脈沖20 ms之的p

54、ause吋間為20ms,即pause 2041 o圖4. 11. 5ms脈沖寬度的時(shí)間矢最圖pause命令：令basic stamp控制器在執(zhí)行下一個(gè)命令前有一段等待吋間, 即延吋o(jì) pause的參數(shù)的單位是千分之一秒，如果想延吋2秒，即pause 2000。下面來(lái)計(jì)算下帶寬為1. 5ms吋pulsout命令參數(shù)值。pulsout命令：在basic stamp屮用來(lái)發(fā)送2微秒為單位的高電平脈沖信 號(hào)。pulsout duration相比于pause屮的duration把高電平分為更高的精度 （后者為千分之一）。舉例說(shuō)明：pulsout 15 60000即在pin 15接口（電機(jī) 連接處）發(fā)出一

55、個(gè)60000*2微秒的脈沖信號(hào)。（0.12秒）無(wú)論pulsout命令的參數(shù)值是多少，都要乘以2微秒，這樣就可以計(jì)算出 脈沖持續(xù)的時(shí)間。計(jì)算方式:1.5ms二0.0015s , 0. 0015s/0. 000002s二750.下面對(duì)六條腿111的一條腿的初始化加以說(shuō)明，serout psc , baud+$8000,”!sc”，cho, ramp, hol.lowbyte, hol.highbyte, cr其|f serout指令為：在輸出引腳寫(xiě)入串行程序?？刂菩酒圆ㄌ芈氏蛞?腳p15發(fā)送中括號(hào)里面的內(nèi)容。cho為一水平伺服電機(jī),hoi此時(shí)設(shè)其值為750, 也就是說(shuō)這個(gè)信號(hào)使這個(gè)水平方向的電機(jī)

56、保持靜止并且處于標(biāo)定的零點(diǎn)山。4. 2.1六足機(jī)器人直線正向運(yùn)動(dòng)程序完成了在執(zhí)行程序麗對(duì)六足機(jī)器人的初始化，卜面先對(duì)六腳步行機(jī)器人直線 運(yùn)動(dòng)進(jìn)行程序的編輯。首先明確在六足機(jī)器人直線行走的狀態(tài)下各個(gè)伺服電機(jī)是如何工作的。伺服 電機(jī)控制器與電機(jī)的地址分配及初始化狀態(tài)如圖4. 2所示0123d 67891011圖4. 2伺服電機(jī)地址分配及初始化狀態(tài)如圖，把編輯前把12個(gè)伺服電機(jī)按照16進(jìn)制次序編號(hào)，便于編程序。0、2、 4、6、8、10分別為水平伺服電機(jī),而、3、5、7、9、11則為縱向伺服電機(jī)。 另外根據(jù)它們所在位置，可以直觀地看出各個(gè)伺服電機(jī)在主體哪個(gè)部位，在何種 任務(wù)屮執(zhí)行什么樣的運(yùn)動(dòng)。對(duì)每只

57、腳也進(jìn)行了編號(hào)，便于說(shuō)明分別為a到e。下面分析基于三角步態(tài)下各個(gè)電機(jī)的工作狀態(tài)。第一步，同吋抬起a、c、e 三只腳，這時(shí)候需要縱向電機(jī)1、5、9向上轉(zhuǎn)，b、d、f三只腳作為支撐相支撐 在地面，所以不需要?jiǎng)幼?。第二步，在d、b、f支撐的同時(shí)，它們水平方向的 伺服電機(jī)要使這三只腳有一個(gè)推力，很容易想象在三只腳著地的情況下，提供一 個(gè)向后的力是機(jī)器人的整體向前伸出，也可以說(shuō)在提起的a、c、e邁步之前提 供一個(gè)輔助的動(dòng)力。所以水平方向的電機(jī)2、6、10應(yīng)向后轉(zhuǎn)動(dòng)推動(dòng)機(jī)器人木體。 這吋候a、c、e應(yīng)向前邁出，0、4、8三個(gè)水平電機(jī)應(yīng)向前轉(zhuǎn)動(dòng)帶動(dòng)a、c、e 向前正向邁出。此時(shí)完成正向直線行走的半個(gè)步長(zhǎng)，如圖4. 3所示圖4. 3總線行走半步長(zhǎng)狀態(tài)程序如下：hoi =750ho2 = ho 1-300ho3 = ho1+300serout psc , baud+$8000,h!sch, chi, ramp, ho2.lowbyte