雙足步行機(jī)器人畢業(yè)論文_doc版

1、<p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h3>　　交叉足印競步機(jī)器人行走步態(tài)實(shí)現(xiàn)</h2><p><b>　　I</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p><b>　　摘要</b>&l

2、t;/p><p>　　機(jī)器人技術(shù)代表了機(jī)電一體化的最高成就，是二十世紀(jì)人類最偉大的成果之 一，其中雙足步行機(jī)器人因其體積相對較小，對非結(jié)構(gòu)性環(huán)境具有較好的適應(yīng)性， 避障能力強(qiáng)，移動(dòng)盲區(qū)很小等優(yōu)良的品質(zhì)，越來越受到人們的關(guān)注，因此對其控 制研究和步態(tài)規(guī)劃具有相當(dāng)?shù)默F(xiàn)實(shí)意義。</p><p>　　本文的主要介紹了雙足競步機(jī)器人的國內(nèi)外發(fā)展情況，以及 PWM 指令算法和 舵機(jī)的聯(lián)動(dòng)控制，通過認(rèn)真的

3、研究人類行走方式以及翻跟斗的動(dòng)作，對機(jī)器人的 行走步態(tài)進(jìn)行簡單的規(guī)劃，設(shè)計(jì)出簡化結(jié)構(gòu)模型，然后以此為基礎(chǔ)進(jìn)行了適當(dāng)?shù)?調(diào)整，設(shè)計(jì)出符合交叉足競步機(jī)器人比賽要求的全部動(dòng)作程序，設(shè)計(jì)完成后將程 序下載到實(shí)驗(yàn)樣機(jī)中，驗(yàn)證程序設(shè)計(jì)的可行性和合理性，通過反復(fù)的修改和驗(yàn)證 使得機(jī)器人能順利的完成比賽任務(wù)。</p><p>　　關(guān)鍵詞 ：雙足步行機(jī)器人步態(tài)規(guī)劃PWM 控制</p><p><b

4、>　　II</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p><b>　　ABSTRACT</b></p><p>　　Robotic technology represents the electromechanical integration the greatest achievement of the

5、 20th century, is one of the great achievement of human beings, the biped robot robot even though only the history of nearly 40 years, but because of its unique adaptability and human nature, became the robot to an impor

6、tant developing direction of field.Topics which aims to design a bipedal humanoid robot platform, based on the bipedal robot, walking gait for better finish tasks matting.</p><p>　　Because of multi-joint rob

7、ot has feet, drive and multisensor characteristics, and generally have redundant freedom, these features to its control problem has brought great difficulty, but also for various control and optimization method provides

8、an ideal experimental platform, make its attracted many scholars eyes, become a blockbuster research direction, and so the biped robot gait planning and control study not only has high academic value, but also has quite

9、practical significance.Based on th</p><p>　　The paper mainly discussed the dynamic walking planning, design and simulation, detailed research using PWM control technology to achieve the linkage of the steeri

10、ng gear control more than.</p><p>　　Keywords： Biped robotGait planningPWM control</p><p><b>　　III</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p><b>　　目錄</b>&

11、lt;/p><p>　　摘要 ..........................................................................................................................I.I...</p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　4.2 實(shí)驗(yàn)演示

12、24</p><p>　　5 實(shí)驗(yàn)結(jié)論與總結(jié)28</p><p><b>　　參考文獻(xiàn)29</b></p><p><b>　　致謝30</b></p><p><b>　　附錄31</b></p><p><b>　　V</b

13、></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p><b>　　1緒論</b></p><p><b>　　1.1引言</b></p><p>　　近代機(jī)器人學(xué)是最近幾十年新發(fā)展起來的一門綜合性的學(xué)科，它集中了機(jī)械 工程技術(shù)、計(jì)算機(jī)工程技術(shù)、控制工程技術(shù)、人工智能、電子工程技術(shù)

14、以及仿生 學(xué)十等多種學(xué)科的最新研究成果，機(jī)器人中的雙足步行機(jī)器人雖然只有近四十年 的歷史，但是由于它獨(dú)特的適應(yīng)性和擬人性，成為了機(jī)器人領(lǐng)域的一個(gè)重要發(fā)展 方向。雙足步行機(jī)器人與輪式、爬行式和履帶式等移動(dòng)機(jī)器人相比，有著更好的 環(huán)境適應(yīng)性，這種優(yōu)越性在非結(jié)構(gòu)環(huán)境里的表現(xiàn)尤為突出。從某種意義上講，它 代表了機(jī)電一體化的最高成就，是二十世紀(jì)人類最偉大的成果之一，也是一個(gè)國 家制造業(yè)水平和綜合實(shí)力的象征。</p><h3&g

15、t;　　1.2雙足機(jī)器人的研究概況</h2><p>　　隨著國內(nèi)外學(xué)者紛紛投入到該領(lǐng)域的研究，機(jī)器人逐漸進(jìn)入到工業(yè)生產(chǎn)和人 類的生活 [1] 。根據(jù)機(jī)器人的發(fā)展進(jìn)程，通?？煞譃橐韵氯?lt;/p><p>　　第一代機(jī)器人，主要指只能以“示教-再現(xiàn)”方式工作的機(jī)器人，其只能依靠 人們給定的程序，重復(fù)進(jìn)行各種操作。</p><p>　　第二代機(jī)器人是具有一定傳感器

16、反饋功能的機(jī)器人，其能獲取作業(yè)環(huán)境、操 作對象的簡單信息，通過計(jì)算機(jī)處理、分析，對動(dòng)作進(jìn)行反饋控制，表現(xiàn)出低級 的智能。</p><p>　　第三代機(jī)器人是指具有環(huán)境感知能力，并能做出自主決策的自治機(jī)器人。它 具有多種感知功能，可進(jìn)行復(fù)雜的邏輯思維，判斷決策，在作業(yè)環(huán)境中可獨(dú)立行 動(dòng)。</p><h4>　　1.2.1國外研究概況</h2><p>　　擬人機(jī)器人

17、的研究是一個(gè)很誘人、難度很大的研究課題。關(guān)于這方面的研究 日本走在了世界的前列。早稻田大學(xué)理工學(xué)部1973 年建立了“人格化機(jī)器人”研</p><p>　　究室，曾開發(fā)出不少擬人機(jī)器人系統(tǒng)[2] 。例如會(huì)演奏鋼琴的機(jī)器人、雙足步行機(jī)器 人以及電動(dòng)假肢等。該研究室的帶頭人高西淳夫教授說：“人格化機(jī)器人的一個(gè)很 大特征就是它具有與人類相近的結(jié)構(gòu)，機(jī)器人與人類的共存是我們研究開發(fā)的課 題之一”。</p>

18、;<p><b>　　1</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　當(dāng)今世界，有“機(jī)器人王國”之稱的日本在雙足步行機(jī)器人研究領(lǐng)域處于絕 對領(lǐng)先地位，具有代表性的研究機(jī)構(gòu)有加藤實(shí)驗(yàn)室、日本早稻田大學(xué)、日本東京 大學(xué)、日本東京理工學(xué)院、日本機(jī)械學(xué)院、松下電工、本田公司和索尼公司等[3] 。</p><p&g

19、t;　　日本早稻田大學(xué)的加藤一郎教授于1968 年率先展開了雙足步行機(jī)器人的研制 工作，并先后研制出WAP 系列樣機(jī) [4] 。其中 WAP-1 步行機(jī)器人具有六個(gè)自由度， 每條腿有骻、膝、踝三個(gè)關(guān)節(jié)；關(guān)節(jié)處使用人造橡膠肌肉，通過充氣、排氣引起 肌肉收縮，肌肉的收縮牽引關(guān)節(jié)轉(zhuǎn)動(dòng)從而實(shí)現(xiàn)步行。1971 年，研制出 WAP-3 型雙 足機(jī)器人，仍采用人工肌肉，具有11 個(gè)自由度，能在平地、斜坡和階梯上行走。 同年又研制出 WL-5

20、雙足步行機(jī)器人， 該機(jī)器人采用液壓驅(qū)動(dòng)， 具有 11 個(gè)自由度， 下肢作三維運(yùn)動(dòng)，上軀體左右擺動(dòng)以實(shí)現(xiàn)雙足機(jī)器人重心的左右移動(dòng)。1973 年， 在 WAP-5 的基礎(chǔ)上配置機(jī)械手及人工視覺、聽覺等裝置組成自主式機(jī)器人 WAROT-1。 1980 年，推出 WL-9DR(Dynam 、Refined)雙足機(jī)器人 [5] ，該機(jī)器人采 用預(yù)先設(shè)計(jì)步行方式的程序控制方法，通過對步行運(yùn)動(dòng)的分析及重復(fù)實(shí)驗(yàn)設(shè)計(jì)步 態(tài)軌跡，用設(shè)計(jì)出的步態(tài)控制機(jī)器人

21、的步行運(yùn)動(dòng)，該機(jī)器人采用了以單腳支撐期 為靜態(tài)， 雙腳切換期為動(dòng)態(tài)的準(zhǔn)動(dòng)態(tài)步行方案，實(shí)現(xiàn)了步幅 45cm，每步 9s 的準(zhǔn)動(dòng) </p><p>　　機(jī)器人研究最高水平的是本田公司和索尼公司。本田公司從1986 年至今已經(jīng)推出 了 Pl，P2，P3 系列機(jī)器人，在 P2 和 P3 中，使用了大量的傳感器：陀螺儀(測定上 體偏轉(zhuǎn)的角度和角速度 )、重力傳感器、六維力 /力矩傳感器和視覺傳感器等，利用 這些傳感器

22、感受機(jī)器人的當(dāng)前狀態(tài)和外界環(huán)境的變化，并基于這些傳感器對下肢 各關(guān)節(jié)的運(yùn)動(dòng)作出調(diào)整，實(shí)現(xiàn)動(dòng)態(tài)步行。</p><p>　　2000 年 11 月日本本田公司又推出了新型雙足步行機(jī)器人ASIMO （圖 1-1）， ASIMO 擁有 34 個(gè)自由度，是目前最先進(jìn)的雙足機(jī)器人。ASIMO 身高 1.2 米， 體重 52 公斤。它的行走速度是0-6km/h，行走平穩(wěn)，增加了語音識別功能，具有 聽說看的能力，可實(shí)時(shí)

23、識別人的姿態(tài)與運(yùn)動(dòng)，并進(jìn)行交互。由于采用了新開發(fā)的 雙足步行技術(shù)，具有預(yù)測運(yùn)動(dòng)控制功能，可以更加自由地步行，步行動(dòng)作也更為 連續(xù)流暢，并能完成跑步，轉(zhuǎn)彎，上樓梯等多種復(fù)雜情況下的步行動(dòng)作。</p><p>　　2002 年 6 月 12 日，機(jī)器人世界杯國際委員會(huì)宣布將從2002 年 6 月 20 日起在 日本的福岡與韓國的釜山舉行機(jī)器人世界杯大賽。從該屆起，將增設(shè)雙足步行機(jī) 器人的足球賽事。這標(biāo)志著機(jī)器人選手

24、參加的世界杯又向人類走近了一步。該大 賽的目標(biāo)是“在 2050 年之前，制造出能夠戰(zhàn)勝當(dāng)時(shí)世界冠軍隊(duì)的自律型機(jī)器人隊(duì)</p><p><b>　　2</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　伍”，這一夢想將由雙足步行機(jī)器人來實(shí)現(xiàn)[8] 。</p><p>　　2005 年 1 月 12

25、日，由日本產(chǎn)業(yè)技術(shù)綜合研究所的比留川博等人開發(fā)出一臺取 名“HRP-2”擬人機(jī)器人亮相東京（見圖1-2）。該機(jī)器人身高 154cm，體重 58kg。 研究人員先請民間藝術(shù)家跳舞，用特殊攝像機(jī)拍攝后將畫面輸入電腦，并對手、 腳、頭、腰等 32 個(gè)部位的動(dòng)作進(jìn)行解析，然后把有關(guān)解析數(shù)據(jù)輸入給機(jī)器人，最 后利用這些數(shù)據(jù)來控制機(jī)器人手的動(dòng)作和腳步等，使“HRP-2”可以和人一樣動(dòng)作 連貫，翩翩起舞 [9] 。</p><

26、p>　　圖 1-1 本田公司ASIMO機(jī)器人圖 1-2“HRP -2 ”擬人機(jī)器人</p><p>　　除了日本之外，美國、英國、法國等也對步行機(jī)器人做了大量的基礎(chǔ)理論研 究和樣機(jī)研制工作，并取得一定成就。美國Ohio.大學(xué)的美籍華人鄭元芳博士是美 國雙足步行機(jī)器人研究者中一位非常杰出的人物。他基于神經(jīng)網(wǎng)絡(luò)研制出兩臺雙 足步行機(jī)器人，分別命名為SD-1 和 SD-2，SD-1 具有 4 個(gè)自由

27、度， SD-2 具有 8 個(gè) 自由度， 其中 SD-2 是美國第一臺真正類人的雙足步行機(jī)器人[8] 。他利用 SDR-2 于 1986 年實(shí)現(xiàn)了平地上的前進(jìn)、后退以及左、右側(cè)行；1987 年，又成功地實(shí)現(xiàn)了動(dòng) 態(tài)步行。 1971 年至 1986 年間，英國牛津大學(xué)的Witt 等人制造并完善了一個(gè)雙足 步行機(jī)器人，該機(jī)器人在平地上行走良好，步速達(dá)0.23/s。前面所述的研究主要是 關(guān)于主動(dòng)式步行機(jī)器人 (靠關(guān)節(jié)電機(jī)驅(qū)動(dòng) )。加

28、拿大的幾d.McGeer 主要研究被動(dòng)式 雙足步行機(jī)器人 [6] ，即在無任何外界輸入的情況下， 靠重力和慣性力實(shí)現(xiàn)步行運(yùn)動(dòng)。 1989 年，他建立了平面型的雙足步行機(jī)構(gòu)，兩腿為直桿機(jī)構(gòu)，沒有膝關(guān)節(jié)，每條 腿上各有一個(gè)小電機(jī)來控制腿的伸縮，無任何主動(dòng)控制和能量供</p><p><b>　　3</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p>

29、<h4>　　1.2.2國內(nèi)研究概況</h2><p>　　國內(nèi)雙足步行機(jī)器人的研制工作起步較晚，我國是從20 世紀(jì) 80 年代開始雙</p><p>　　足步行機(jī)器人領(lǐng)域的研究和應(yīng)用的。1986 年，我國開展了“七五”機(jī)器人攻關(guān)計(jì) 劃，1987 年，我國的“ 863”高技術(shù)計(jì)劃將機(jī)器人方面的研究開發(fā)列入其中。目前 我國從事機(jī)器人研究與應(yīng)用開發(fā)的單位主要是高校和有關(guān)科研院

30、所等。最初我國 進(jìn)行機(jī)器人技術(shù)研究的主要目的是跟蹤國際先進(jìn)的機(jī)器人技術(shù)，隨后取得了一定 的成就。自 1985 年以來，相繼有幾所高校進(jìn)行了這方面的研究并取得了一定的成 果，其中以哈爾濱工業(yè)大學(xué)和國防科技大學(xué)較為成果顯著。在自然科學(xué)基金和國</p><p>　　家”863”計(jì)劃的支持下，哈爾濱工業(yè)大學(xué)自1985 年開始研制雙足步行機(jī)器人[11]， 迄今為止己經(jīng)完成三個(gè)型號的研制工作。1988 年哈工大 HIT

31、-1 型雙足步行機(jī)器人 問世， HIT-1 型雙足步行機(jī)器人具有10 個(gè)自由度，重100kg，高 1.2m，關(guān)節(jié)由直 流伺服電機(jī)驅(qū)動(dòng)，屬于靜步態(tài)行走。HIT-2 具有 12 個(gè)自由度，該機(jī)器人髓關(guān)節(jié)和 腿部結(jié)構(gòu)采用了平行四邊形結(jié)構(gòu)。HIT-3 具有 12 個(gè)自由度，跺關(guān)節(jié)采用兩電機(jī)交 叉結(jié)構(gòu)，同時(shí)實(shí)現(xiàn)了兩個(gè)自由度，腿部結(jié)構(gòu)采用了圓筒形結(jié)構(gòu)。HIT-2 實(shí)現(xiàn)了靜步 態(tài)行和動(dòng)步態(tài)步行，能夠完成前/后行、側(cè)行、轉(zhuǎn)彎、上下臺階

32、及上斜坡等動(dòng)作。</p><p>　　清華大學(xué) 2002 年 4 月 9 日研制雙足機(jī)器人THBIP-I 樣機(jī)。THBIP-I 有 32 個(gè)自 由度，采用獨(dú)特傳動(dòng)結(jié)構(gòu)，成功實(shí)現(xiàn)無纜連續(xù)穩(wěn)定的平地行走、連續(xù)上下臺論階 行走，以及端水、 太極拳和點(diǎn)頭等動(dòng)作。 其平地行走速度為4.2 米/分，步距為 0.35</p><p>　　米，跨越臺階高度75 毫米，跨越速度20 秒/步。&l

33、t;/p><p>　　國防科技大學(xué)從1988~95 年，先后研制成功平面型六自由度雙足機(jī)器人 KDW-I ，空間運(yùn)動(dòng)型 KDW-II和 KDW-III 。KDW-III下肢有 12 個(gè)自由度；最大步 距為 40 厘米，步速為 4 秒/步；可實(shí)現(xiàn)前進(jìn) /后退和上 /下臺階的靜 /動(dòng)態(tài)步行和轉(zhuǎn)彎 運(yùn)動(dòng)[12] 。2000 年 11 月 29 日，又研制出我國第一臺類人型雙足步行機(jī)器人“先行 者”，高 1.4 米，重

34、 20 千克，可實(shí)現(xiàn)前進(jìn) /后退、左 /右側(cè)行、左 /右轉(zhuǎn)彎和手臂前后 擺動(dòng)等各種基本步態(tài)，行走頻率每秒兩步，能平地靜態(tài)步行和動(dòng)態(tài)步行。從只能 平地靜態(tài)步行，到能快速自如地動(dòng)態(tài)步行；從只能在己知環(huán)境下步行，到可在小 偏差、不確定環(huán)境下行走，實(shí)現(xiàn)了多項(xiàng)關(guān)鍵技術(shù)突破。2003 年 1 月取名為 BRH-1</p><p>　　的仿人機(jī)器人在北京理工大學(xué)通過國家“863” 項(xiàng)目組的驗(yàn)收。這個(gè)機(jī)器人身高 1.58m

35、，體重 76kg，具有 32 個(gè)自由度，每小時(shí)能夠行走1km，步幅 0.33m。驗(yàn)收 專家認(rèn)為該機(jī)器人在系統(tǒng)集成、步態(tài)規(guī)劃和控制系統(tǒng)等方面實(shí)現(xiàn)了重大的突破。 仿人機(jī)器人課題組負(fù)責(zé)人、北京理工大學(xué)教授李科杰認(rèn)為：目前“BHR-1 ”仿人機(jī) 器人己經(jīng)能夠根據(jù)自身力覺、平衡覺等感知機(jī)器人自身的平衡狀態(tài)和地面高度的 變化，實(shí)現(xiàn)在未知地面上的穩(wěn)定行走和太極拳表演，使中國成為繼日本之后，第 二個(gè)研制出無外接電纜行走，集感知、控制、驅(qū)動(dòng)、電源和機(jī)

36、構(gòu)于一體的高水平</p><p><b>　　4</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p><b>　　仿人機(jī)器人國家。</b></p><h3>　　1.3雙足步行機(jī)器人的步行特點(diǎn)及研究意義</h2><p>　　機(jī)器人是現(xiàn)代科學(xué)技術(shù)發(fā)展的必然產(chǎn)

37、物，因?yàn)槿藗兛偸窃O(shè)法讓機(jī)器來代替人 的繁重工作，從而發(fā)明了各種各樣的機(jī)器[13] 。機(jī)器的發(fā)展和其它事物一樣，遵循 著由低級到高級的發(fā)展規(guī)律，機(jī)器發(fā)展的最高形式必然是機(jī)器人。而機(jī)器人發(fā)展 的最高目標(biāo)是制造出像人一樣可以行走和作業(yè)的機(jī)器人，也就是擬人機(jī)器人。因 為它具有良好的環(huán)境適應(yīng)性，并且這種優(yōu)秀品質(zhì)在高低不平的路面上以及具有障 礙物的空間里更加突出，所以與之相關(guān)的問題己經(jīng)成為研究熱點(diǎn)。擬人機(jī)器人的 研制工作開始于20 世紀(jì) 60

38、 年代，短短的幾十年時(shí)間內(nèi)，其研制工作進(jìn)展迅速。 步行機(jī)器人的研制工作是其中一項(xiàng)重要內(nèi)容。目前，機(jī)器人的移動(dòng)方式主要包括 輪式、履帶式、爬行式、蠕動(dòng)式以及步行等方式。對輪式和履帶式移動(dòng)機(jī)器人的 研究主要集中在自主運(yùn)動(dòng)控制上，如避障路徑規(guī)劃等。這兩種機(jī)器人過分依賴于 周圍環(huán)境，應(yīng)用范圍受限。爬行和蠕動(dòng)式機(jī)器人主要用于管道作業(yè)，具有良好的 靜動(dòng)態(tài)穩(wěn)定性，但速度較低[14] 。常見的步行機(jī)器人有雙足、四足和六足等情況。 自然界事實(shí)、仿生學(xué)以

39、及力學(xué)分析表明: 在具有許多優(yōu)點(diǎn)的步行機(jī)器人中，雙足步 行機(jī)器人因其體積相對較小，對非</p><p>　　首先，對于支撐路面，雙足步行機(jī)器人的要求很低，理論上只需要分散的、 孤立的支撐點(diǎn)，就可以通過機(jī)器人自行選擇最佳的支撐點(diǎn)，獲得最佳的移動(dòng)性能。 而輪式移動(dòng)機(jī)器人通常要求連續(xù)的、硬質(zhì)的支撐路面，對于惡劣的支撐路面，它 只能被動(dòng)的適應(yīng)。</p><p>　　其次，在存在障礙物的情況下，雙

40、足步行機(jī)器人能夠跨越與自身腿長相當(dāng)?shù)?障礙物，甚至跳越障礙，而輪式移動(dòng)機(jī)器人僅能滾越尺寸小于輪子半徑的障礙物。 機(jī)器人力學(xué)計(jì)算表明，足式步行機(jī)器人的能耗通常低于輪式和履帶式。步行是人 類的一種基本活動(dòng)能力，雙足步行技術(shù)的發(fā)展會(huì)促進(jìn)動(dòng)力型假肢的研制，將有可 能解決截癱病人和小兒麻痹癥患者的行走問題，為康復(fù)醫(yī)學(xué)做出貢獻(xiàn)。對機(jī)器人 雙足動(dòng)態(tài)行走機(jī)理的深入研究也使我們更深刻地理解人類活動(dòng)的內(nèi)在本質(zhì)，有助 于生物醫(yī)學(xué)工程和體育運(yùn)動(dòng)科學(xué)的發(fā)展。而雙

41、足步行機(jī)器人與傳統(tǒng)的輪式機(jī)器人 相比，最具有挑戰(zhàn)性的問題之一就在于，它的單、雙足交替支撐的步行方式使得 雙足步行機(jī)器人難以保持較好的穩(wěn)定性。從而，使得人們在機(jī)器人穩(wěn)定性和步態(tài) 規(guī)劃方面的研究更加深入。</p><p><b>　　5</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h3>　　1.4本文研究內(nèi)容及主要工作<

42、/h2><p>　　為了促進(jìn)機(jī)器人技術(shù)在我國的發(fā)展，全國各地尤其是部分高校舉辦了各種類 型的機(jī)器人大賽。中國機(jī)器人大賽是由中國自動(dòng)化學(xué)會(huì)機(jī)器人競賽工作委員會(huì)和 科技部高技術(shù)研究發(fā)展中心主辦的一個(gè)全國性的賽事。其中最為引人矚目的舞蹈 機(jī)器人項(xiàng)目就是為了促進(jìn)雙足步行機(jī)器人的發(fā)展而設(shè)立的。由于步行機(jī)器人的實(shí) 現(xiàn)目前還存在很多技術(shù)難題，前幾屆由中國科技大學(xué)主辦的舞蹈機(jī)器人大賽基本 上是以輪式機(jī)器人為主，還沒有出現(xiàn)步行機(jī)器人參

43、賽，由此可見，雙足步行機(jī)器 人的發(fā)展還有一段很長的路要走。研制雙足步行機(jī)器人的一項(xiàng)重要內(nèi)容就是步態(tài) 規(guī)劃。所謂的步態(tài)，是指在步行過程中，步行本體的身體各部位在時(shí)序和空間上 的一種協(xié)調(diào)關(guān)系，步態(tài)規(guī)劃就是給出機(jī)器人各關(guān)節(jié)位置與時(shí)間的關(guān)系，是雙足步 行機(jī)器人研制中的一項(xiàng)關(guān)鍵技術(shù)，也是難點(diǎn)之一。步態(tài)規(guī)劃的好壞將直接影響到 雙足步行機(jī)器人的行走穩(wěn)定性、美觀性以及各關(guān)節(jié)所需驅(qū)動(dòng)力矩的大小等多個(gè)方 面，已經(jīng)成為雙足步行機(jī)器人領(lǐng)域的研究熱點(diǎn)。</

44、p><p>　　本文的主要任務(wù)就是在大量研讀資料后，認(rèn)真的研究人類行走過程，并通過 的適當(dāng)?shù)恼{(diào)整，完成交叉足競步機(jī)器人行走程序的設(shè)計(jì)，完成設(shè)計(jì)后將設(shè)計(jì)好的 程序下載都到實(shí)驗(yàn)樣機(jī)中，驗(yàn)證設(shè)計(jì)程序的可行性和合理性，通過反復(fù)的驗(yàn)證和 改進(jìn)使得機(jī)器人能順利的完成比賽任務(wù)。</p><h3>　　1.5試驗(yàn)樣機(jī)的介紹</h2><p>　　本文采用的樣機(jī)是 SHR-TLA機(jī)器

45、人，該機(jī)器人的關(guān)鍵技術(shù)主要包括3部分： 其一是數(shù)控系統(tǒng)，也指電子部分，其二是伺服舵機(jī)，其三是機(jī)械結(jié)構(gòu)件。</p><p>　　1、實(shí)驗(yàn)樣機(jī)的控制器系統(tǒng)采用北京森漢科技生產(chǎn)的控制板 (見圖 1-3), 該控制 板采用 STC12C5412AD 單片機(jī) ,設(shè)計(jì)合理，擴(kuò)展了 STC12C5412AD 系列單片機(jī)的 所有外接端口 ,具有很好的操作性 .。</p><p>　　2、樣機(jī)共有六個(gè) S

46、H14-M-C舵機(jī)（見圖 1-4），它是一款數(shù)字型的舵機(jī)， 成本低，， 采用PWM控制，不用隨時(shí)接收指令，減少CPU 的疲勞程度；重量輕、反應(yīng)速度、 每個(gè)舵機(jī)扭矩為 14kg.cm，全部采用金屬齒輪傳動(dòng)，旋轉(zhuǎn)角度可達(dá)到185 度，可以 保證機(jī)器人動(dòng)作靈敏、行動(dòng)有力，它還有一個(gè)最突出的特點(diǎn)，是有“電子自鎖” 功能。</p><p>　　3、該款樣機(jī)全身的機(jī)械結(jié)構(gòu)均采用金屬結(jié)構(gòu)（見圖 1-5），有較強(qiáng)的機(jī)械強(qiáng)

47、度， 樣機(jī)的身高 280mm，肩寬 165mm，胸厚 140mm，質(zhì)量 0.9kg。</p><p><b>　　6</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　圖１ - ３STC12C5412AD 控制板圖 1-4SH14-M-C 舵機(jī)圖 1-5 SHR-TLA機(jī)器人</p><p>

48、;　　4、機(jī)器人各舵機(jī)與控制口的定義</p><p>　　程序中命名定義接口平面命名電路板接口</p><p><b>　　舵機(jī)分布圖</b></p><p><b>　　7</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h2>　　2舵機(jī)聯(lián)動(dòng)單周期指

49、令算法研究</h2><h3>　　2.1舵機(jī) PWM信號介紹</h2><p>　　PWM 是 Pulse Width Modulation 縮寫， 中文意思就是脈沖寬度調(diào)制，簡稱脈 寬調(diào)制。它是利用微處理器的數(shù)字輸出來對模擬電路進(jìn)行控制的一種非常有效的 技術(shù)，其特點(diǎn)在于他的上升沿與下降沿之間的時(shí)間寬度。我們目前使用的舵機(jī)主 要依賴于模型行業(yè)的標(biāo)準(zhǔn)協(xié)議，隨著機(jī)器人行業(yè)的漸漸獨(dú)立，有些廠

50、商已經(jīng)推出 全新的舵機(jī)協(xié)議，這些舵機(jī)只能應(yīng)用于機(jī)器人行業(yè)，已經(jīng)不能夠應(yīng)用于傳統(tǒng)的模 型上面了。</p><p>　　本文采用的是8 位 STC12C5410ADCPU ，其數(shù)據(jù)分辨率為256 ，經(jīng)過舵機(jī) 極限參數(shù)實(shí)驗(yàn)，得到應(yīng)該將其劃分為250 份。那么 0.5mS~2.5ms 的脈沖寬度為 2mS 即 2000uS，2000uS÷250=8uS 則：PWM的控制精度為 8uS,本文以 8uS

51、 為單位遞 增控制舵機(jī)轉(zhuǎn)動(dòng)與定位，舵機(jī)可以轉(zhuǎn)動(dòng)185 度，那么 185 度÷ 250=0.74 度， 則： 舵機(jī)的控制精度為0.74 度。由此我們定義了1 DWT = 8uS； 1DWA=0.74 度。</p><h3>　　2． 2單舵機(jī)拖動(dòng)及調(diào)速算法</h2><p>　　舵機(jī)為隨動(dòng)機(jī)構(gòu)，當(dāng)其未轉(zhuǎn)到目標(biāo)位置時(shí)，將全速向目標(biāo)位置轉(zhuǎn)動(dòng)，當(dāng)其到 達(dá)目標(biāo)位置時(shí)，將自動(dòng)保持該

52、位置。所以對于數(shù)字舵機(jī)而言，PWM 信號提供的是 目標(biāo)位置，跟蹤運(yùn)動(dòng)要靠舵機(jī)本身。像SH-0680 這樣的模擬舵機(jī)需要時(shí)刻供給 PWM信號，舵機(jī)自己不能鎖定目標(biāo)位置。所以我們的控制系統(tǒng)是一個(gè)目標(biāo)規(guī)劃 系統(tǒng)。</p><p>　　SH14-M舵機(jī)的位置控制方法：</p><p>　?。?）相關(guān)計(jì)算說明：舵機(jī)角度= 0.74×N；</p><p>

53、;　　PWM高電平的時(shí)間為：500us + N× 8us 或者舵機(jī)角度 /8us+500us； 部分角度對應(yīng)的N 值和 PWM 值如下：</p><p>　　舵機(jī)要求 PWM格式上升沿最少為0.5mS，為 0.5mS---2.5mS 之間；下降沿時(shí)間沒 要求，目前采用0.5mS 就行；也就是說PWM波形可以是一個(gè)周期1mS 的標(biāo)準(zhǔn)</p><p><b&

54、gt;　　8</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　方波，具體格式說明圖例如下圖：</p><p><b>　　0.5ms</b></p><p><b>　　N × 0.8us</b></p><p><b>

55、;　　PWM</b></p><p>　　0.5ms+N × 0.8us</p><p>　?。?）SH14-M舵機(jī)的運(yùn)動(dòng)協(xié)議</p><p>　　圖 2-1 PWM 格式</p><p>　?、俣鏅C(jī)的轉(zhuǎn)動(dòng)方向?yàn)?: 逆時(shí)針為正轉(zhuǎn)</p><p>　　②Φ對應(yīng) N值N=0， Φ=0 ；度

56、 N=250，Φ =185 度；1 ≤ N≤ 250 運(yùn)動(dòng)時(shí)可以外接較大的轉(zhuǎn)動(dòng)負(fù)載，舵機(jī)輸出扭矩較大，而且抗抖動(dòng)性很好，電位 器的線性度較高，達(dá)到極限位置時(shí)也不會(huì)偏離目標(biāo)。</p><p><b>　　2.3算法分析</b></p><p>　　我們使用定時(shí)器中斷的方式產(chǎn)生所需的PWM 波，定時(shí)器初始化后， 由定時(shí)器 0 產(chǎn)生 20ms 的脈沖周期，開始執(zhí)行第

57、一組數(shù)據(jù)。定時(shí)器1 被賦予第 n 個(gè)舵機(jī)的脈 寬值（n 初始值為 0，對應(yīng) A0 口），同時(shí)對應(yīng)第 n 個(gè)舵機(jī)的 I/O 口翻轉(zhuǎn)， 輸出為高， 定時(shí)器 1 定時(shí)時(shí)間到，進(jìn)入中斷，n 口翻轉(zhuǎn)，輸出變?yōu)榈?，同時(shí)n++，循環(huán)上述過</p><p>　　程，直到 n＝5，這時(shí) j++ ，n 重新賦 0，等待定時(shí)器 0 的中斷發(fā)生后，進(jìn)入下一組 數(shù)執(zhí)行，這樣已知循環(huán)，知道執(zhí)行完所有的數(shù)據(jù)（j ＝ m）為止，即機(jī)器人

58、走完一 個(gè)完整的步態(tài)。</p><p>　　當(dāng)同時(shí)發(fā)給 6 個(gè)舵機(jī)位置目標(biāo)值時(shí)，該指令的執(zhí)行周期盡量短，目的有2 個(gè)：</p><p>　　其一，是為了將來擴(kuò)充至24 舵機(jī)； 其二，目標(biāo)越快，舵機(jī)的轉(zhuǎn)動(dòng)速度越快；</p><p>　　我們以 P0 口得 6 路為 1 組或稱 1 個(gè)單位，連續(xù)發(fā)出目標(biāo)位置，形成連續(xù)的目</p><p>　　

59、標(biāo)規(guī)劃曲線，電機(jī)在跟隨過程中自然形成了位置與速度的雙指標(biāo)曲線，實(shí)現(xiàn)6 路 舵機(jī)聯(lián)動(dòng)。為了方便以后擴(kuò)充到P1、P2 的 24 舵機(jī)的聯(lián)動(dòng)控制，采用并行運(yùn)算， 目前采用的并行算法是P0.0—P0.5 為一個(gè)基本單位， 6 位一并。</p><p>　　具體如下： P0 口的 6 個(gè)位置各不相同：</p><p><b>　　9</b></p><

60、p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　端口N 寄存器目標(biāo)位置（度） N 數(shù)值（整數(shù)）</p><p><b>　　PWM寬度</b></p><p><b>　　表 2-2</b></p><h3>　　2.46路 PWM信號發(fā)生算法解析</h2>&

61、lt;p>　?、?ass[6]內(nèi)為 P0 口的 6 路 N數(shù)值，這些數(shù)值是根據(jù)舵機(jī)狀態(tài)定的， 沒有規(guī)律。</p><p>　　logic[8] 內(nèi)為固定的一組邏輯參數(shù)。</p><p>　?、趯?shù)組 ass 內(nèi)的數(shù)據(jù)由大到小排列，logic 內(nèi)的數(shù)據(jù)也數(shù)之變化，變成：</p><p>　　③將 N值做減法，求得：</p><p>

62、　　ass[0]=ass[0]-ass[1]=81</p><p>　　ass[1]=ass[1]-ass[2]=31</p><p>　　ass[2]=ass[2]-ass[3]=29</p><p>　　ass[3]=ass[3]-ass[4]=40</p><p>　　ass[4]=ass[4]-ass[5]=8 ass[5]=ass[

63、5] =12</p><p>　?、芪覀儗⒚?6 路輸出的高電平時(shí)間限制在一個(gè)2.5ms 的中斷內(nèi)，開啟中斷。</p><p>　?、輰⑷康?6 路輸出置為高電平，并延時(shí)500us 作為目標(biāo)位置為0 的基礎(chǔ)。</p><p><b>　　10</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p>

64、<p>　?、扪h(huán) 6 次,每次延時(shí) ass 內(nèi)的值個(gè) 8us,再將 P0 口“與”相應(yīng)的邏輯參數(shù) .</p><p><b>　　例如：</b></p><p><b>　　N 差值</b></p><p>　　延時(shí)時(shí)間（N 差值× 8us）</p><p>　　對應(yīng)

65、“與”的值相應(yīng)輸出 0 的位</p><p><b>　　相繼變成 低電平的</b></p><p><b>　　11</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h2>　　3交叉足機(jī)器人行走步態(tài)設(shè)計(jì)</h2><p>　　人形機(jī)器人具有廣闊的應(yīng)用前

66、景,其研制工作得到了各國的重視,近年來已取 得巨大的進(jìn)展 ,但仍存在大量的理論和技術(shù)問題有待深入研究[15] 。如何規(guī)劃機(jī)器人 步態(tài)使其穩(wěn)定行走仍是人形機(jī)器人研究領(lǐng)域的關(guān)鍵技術(shù)之一。步態(tài)是在步行運(yùn)動(dòng) 過程中 ,機(jī)器人的各個(gè)關(guān)節(jié)在時(shí)序和空間上的一種協(xié)調(diào)關(guān)系，步態(tài)規(guī)劃的目標(biāo)是產(chǎn) 生期望步態(tài)，即產(chǎn)生在某個(gè)步行周期中的實(shí)現(xiàn)某種步態(tài)的各關(guān)節(jié)運(yùn)動(dòng)軌跡（期望 運(yùn)動(dòng)軌跡）。步態(tài)規(guī)劃是機(jī)器人穩(wěn)定步行的基礎(chǔ)，也是雙足步行機(jī)器人研究中的一 個(gè)關(guān)鍵技術(shù)。

67、要實(shí)現(xiàn)和提高機(jī)器人的行走性能，必須研究實(shí)用而有效的步態(tài)規(guī)劃 方法，實(shí)現(xiàn)機(jī)器人的穩(wěn)定步行[16]。</p><p>　　人類在研究人體結(jié)構(gòu)之前花費(fèi)了大量的時(shí)間去研究昆蟲，哺乳動(dòng)物的腿部移 動(dòng)，甚至登山運(yùn)動(dòng)員在爬山時(shí)的腿部運(yùn)動(dòng)方式[17]。這些研究幫助我們更好的了解 在行走過程中發(fā)生的一切，特別是關(guān)節(jié)處的運(yùn)動(dòng)。比如，我們在行走的時(shí)候會(huì)移 動(dòng)我們的重心，并且前后擺動(dòng)雙手來平衡我們的身體。這些構(gòu)成了人形機(jī)器人行 走的

68、基礎(chǔ)方式，人形機(jī)器人和人類一樣，有髖關(guān)節(jié)，膝關(guān)節(jié)和足關(guān)節(jié)。機(jī)器人中 的關(guān)節(jié)一般用 “自由度 ”來表示。一個(gè)自由度表示一個(gè)運(yùn)動(dòng)可以或者向上，或者向下， 或者向右，或者向左。分散在身體的不同部位，所以骨骼結(jié)構(gòu)因此而生。</p><h3>　　3.1步態(tài)規(guī)劃基本原則</h2><p>　　對雙足步行機(jī)器人而言，理論上可供選擇的步態(tài)有無數(shù)種。但是，步態(tài)規(guī)劃 必須保證以下兩個(gè)原則 [18]：&l

69、t;/p><p>　　1．所規(guī)劃的步態(tài)必須滿足設(shè)定的目標(biāo)。</p><p>　　2．機(jī)器人按照規(guī)劃步態(tài)行走時(shí)必須始終保持自身的穩(wěn)定。 同時(shí)，所規(guī)劃的步態(tài)還應(yīng)符合人類的行走習(xí)慣，并使控制盡可能簡單。人類</p><p>　　行走步態(tài)是幾千年演化的結(jié)果，是自然界中最合理的行走方式，符合人類的行走 習(xí)慣的步態(tài)不僅能使機(jī)器人保持穩(wěn)定，而且能使其所消耗的能量減少到最低程度。 此外

70、，機(jī)器人的行走必須加以人為的控制，如果規(guī)劃的步態(tài)存在控制上的困難甚 至難以實(shí)現(xiàn)，顯然意義不大。</p><p><b>　　3.2步態(tài)設(shè)計(jì)</b></p><p>　　2010 年中國機(jī)器人大賽雙足競步機(jī)器人組比賽規(guī)則交叉足印項(xiàng)目要求: 機(jī)器 人通過步行的方式從起點(diǎn)線走到終點(diǎn)線（相距200cm，限寬 60cm）。競賽開始時(shí)先 走出 3 步距離、立正、然后臥下、

71、向前翻跟斗3 次，再起立、向前走出3 步距離、</p><p><b>　　12</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　立正、然后臥下（身體向后） 、再向后翻跟斗3 次、再起立、然后以輕快步履走向 終點(diǎn)，參賽機(jī)器人要在4 分鐘以內(nèi)完成所有動(dòng)作。</p><p>　　為了符合比賽

72、的要求，本文將整套動(dòng)作的設(shè)計(jì)分成三大塊，分別是前三步行 走步態(tài)的設(shè)計(jì)，翻跟斗的設(shè)計(jì)和連續(xù)行走步態(tài)的設(shè)計(jì)，其中前三步和連續(xù)行走的 設(shè)計(jì)有很多相似之處，可統(tǒng)一設(shè)計(jì)。另外還包括主程序和相關(guān)輔助程序的設(shè)計(jì)。</p><h4>　　3.2 ． 1前三步步態(tài)設(shè)計(jì)</h2><p>　　近年來 , 隨著雙足機(jī)器人研究的興起， 人類行走步態(tài)的特征成了仿生機(jī)械學(xué)家 研究雙足機(jī)器人的一個(gè)重要依據(jù)。體育研究者

73、和人體運(yùn)動(dòng)信息研究專家對人體的 運(yùn)動(dòng)做了大量的研究工作。他們讓實(shí)驗(yàn)者穿上緊身衣，并在踝、膝、髖、肩、肘 等關(guān)鍵關(guān)節(jié)貼上亮片標(biāo)志以便于識別，在實(shí)驗(yàn)者行走過程中，利用高速攝像機(jī)對 試驗(yàn)者的行走步態(tài)進(jìn)行連續(xù)拍照，如圖3-1 所示。通過大量實(shí)驗(yàn)，獲得不同實(shí)驗(yàn) 者的行走步態(tài)連續(xù)照片，經(jīng)過分析整理獲得可以指導(dǎo)機(jī)器人步態(tài)規(guī)劃的人類行走 步態(tài)數(shù)據(jù)。</p><p>　　圖 3-1人類行走步態(tài)</p><p

74、>　　雙足機(jī)器人步態(tài)研究 [6] 的一個(gè)重要方法就簡化出雙足機(jī)器人的結(jié)構(gòu)簡圖。由于 雙足機(jī)器人的原始模型是一個(gè)高階次、多變量、強(qiáng)耦合、非線性和變結(jié)構(gòu)的復(fù)雜 動(dòng)力學(xué)系統(tǒng) [19] ,要對它進(jìn)行直接研究甚至是理解都很困難,因此必須在某種條件下 進(jìn)行簡化 ,這種簡化必須具備真實(shí)性和可復(fù)原性，人類通過交替地以一條腿作為支</p><p><b>　　13</b></p>&l

75、t;p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　撐,向前擺動(dòng)另一條腿 , 并伴以軀干和手臂的 運(yùn)動(dòng)來實(shí)現(xiàn)靈活的步 行運(yùn)動(dòng) ,其過程和機(jī)理 是非常復(fù)雜的。 研究證 明[20] :雙足步行機(jī)器人 在平穩(wěn)步行的條件下 ,</p><p>　　能夠?qū)崿F(xiàn)上身軀和下肢的運(yùn)動(dòng)解耦,并且容易對下身軀的各個(gè)關(guān)節(jié)角實(shí)施角度 規(guī)劃,因此可以利用解耦控制分別控制上身軀和下身軀的運(yùn)動(dòng),并且對下身

76、軀的各 個(gè)關(guān)節(jié)角實(shí)施軌跡規(guī)劃。 因此,在分析和模擬人類的步行運(yùn)動(dòng)時(shí),進(jìn)行了簡化 ,去掉一 些復(fù)雜的動(dòng)作細(xì)節(jié) ,重點(diǎn)抓住下肢的主要?jiǎng)幼魈攸c(diǎn)和要領(lǐng)。</p><p>　　一個(gè)完整的行走周期分為雙腿支撐階段和單腿支撐階段。在雙腿支撐階段,兩 只腳都與地面接觸 ,這個(gè)階段開始于前腳的后跟接觸地面,結(jié)束于后腳的腳尖離開 地面。單腿支撐階段一條腿支撐身體,另外一條腿完成步行前移。在單腿支撐階段, 一只腳固定在地

77、面上而另一只腳從后往前擺動(dòng),步行時(shí) ,機(jī)器人交替地進(jìn)入雙腿支 撐階段和單腿支撐階段。</p><p>　　機(jī)器人行走過程步態(tài)解析如下：初始位置：雙腿直立。 動(dòng)作流程：</p><p>　　雙腿下蹲抬一腿，直立→邁一腿，下蹲</p><p>　　循環(huán)（ N 步） 邁一腿，下蹲←抬一腿，直立</p><p>　　根據(jù)人類行走姿態(tài)，經(jīng)過簡化修改

78、設(shè)計(jì)出符合機(jī)器人行走的步態(tài)，設(shè)計(jì)流程圖 如下：</p><p>　　1、前三步步態(tài)設(shè)計(jì)過程圖</p><p><b>　　啟動(dòng)步態(tài)</b></p><p><b>　　雙腳站降低</b></p><p><b>　　立狀態(tài)重心</b></p><p>

79、;<b>　　重心擺 到左腿</b></p><p><b>　　右腿向前 邁出半步</b></p><p><b>　　重心擺到 兩腿中間</b></p><p><b>　　重心</b></p><p>　　停止步態(tài)擺到 右腿</p>

80、<p>　　左 腿 向 前 邁 出 半步</p><p>　　重 心 擺 到 兩 腿 中間</p><p><b>　　重心雙腳</b></p><p><b>　　升高站立</b></p><p>　　圖 3-2 前三步步態(tài)設(shè)計(jì)過程圖</p><p><

81、b>　　14</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　2、前三步步態(tài)設(shè)計(jì)結(jié)構(gòu)簡圖 按照上一節(jié)的設(shè)計(jì)思路，將人類的行走的步態(tài)進(jìn)一步簡化，畫出機(jī)器人腿部三個(gè) 關(guān)節(jié)處個(gè)各舵機(jī)的旋轉(zhuǎn)角度，角度的大小均以自然行走時(shí)的姿勢為準(zhǔn)。</p><p><b>　　啟 動(dòng) 步 態(tài)</b></p>&l

82、t;p><b>　　正視圖</b></p><p><b>　　第 一 步</b></p><p><b>　　第 二 步</b></p><p><b>　　第 三 步</b></p><p><b>　　停 止 步 態(tài)</b>

83、;</p><p><b>　　15</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　3、前三步程序設(shè)計(jì)流程圖</p><p>　　在前期準(zhǔn)備的基礎(chǔ)上， 根據(jù)舵機(jī)的旋轉(zhuǎn)角度算出for循環(huán)的次數(shù)； for循環(huán)的 次數(shù)i等于舵機(jī)角度 /0.74度。例如 : 當(dāng)舵機(jī)轉(zhuǎn)動(dòng)24 度時(shí)， fo

84、r循環(huán)的次數(shù) i=24/0.74=33，對應(yīng)舵機(jī)正轉(zhuǎn)時(shí)position++，反轉(zhuǎn)時(shí) position--，然后得出行走 步態(tài)的程序流程圖，如下所示：</p><p><b>　　站立姿態(tài)</b></p><p>　　position[0]-- ； position[1]+=2 ； position[2]++ ； position[3]++ ； positio

85、n[4]-=2 ； position[5]-- ；</p><p>　　position[0]++ ； position[1]-=2； position[2]-- ；</p><p>　　position[4]+=2 ；</p><p>　　position[5]++ ；</p><p>　　if((i%2)==0)</p>

86、<p>　　position[5]++ ；</p><p>　　if((i%3)==0)</p><p>　　position[5]++ ；</p><p>　　position[0]-- ； position[1]+=2 ； position[2]++ ；</p><p>　　position[1]--；</p>

87、<p>　　position[4]++；</p><p>　　position[1]++； position[3]--； position[4]-- ； position[5]-- ；</p><p>　　position[4]+=2 ； position[5]++ ； if((i%2)==0)</p><p>　　position[5]++ ；&l

88、t;/p><p>　　if((i%3)==0)</p><p>　　position[4]--； position[0]++； position[1]++ ； position[2]++ ；</p><p>　　position[1]--；</p><p>　　position[4]++ ；</p><p>　　po

89、sition[3]++ ； position[4]-=2 ； position[5]-- ；</p><p>　　position[2]-=7 ； 微調(diào)</p><p>　　position[1]-=2 ； position[2]-- ； if((i%2)==0)</p><p>　　position[2]-- ；</p><p>　　if(

90、(i%4)==0)</p><p>　　position[2]-- ；</p><p>　　position[5]+=5 ；</p><p>　　position[0]-- ； position[1]+=2 ； position[2]++ ；</p><p>　　position[1]-- ；</p><p>

91、　　position[4]++ ；</p><p>　　position[1]++； position[3]--； position[4]-- ； position[5]-- ；</p><p>　　position[0]++ ； position[1]-=2 ； position[2]-- ；</p><p><b>　　結(jié)束</b>

92、;</p><p><b>　　注：程序見附錄</b></p><p><b>　　16</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　3.2 ． 2翻跟頭步態(tài)設(shè)計(jì)</p><p>　　機(jī)器人大賽中要求機(jī)器人有翻跟頭的動(dòng)作，為了滿足比賽要求，作者搜

93、集了 人類翻跟頭的資料（見下圖） ，人類翻跟斗時(shí)動(dòng)作的連貫性和柔韌性是機(jī)器人無法 比擬的，所以在在動(dòng)作的設(shè)計(jì)上做了大量的改動(dòng)。</p><p>　　一、翻跟頭步態(tài)設(shè)計(jì)結(jié)構(gòu)簡圖 翻跟頭的設(shè)計(jì)和前邊的前三步設(shè)計(jì)思路和方法是一樣的，根據(jù)人類翻跟頭的相關(guān) 資料，畫出機(jī)器人簡化結(jié)構(gòu)模型，并根據(jù)動(dòng)作姿態(tài)確定個(gè)舵機(jī)的旋轉(zhuǎn)角度。人類 各個(gè)關(guān)節(jié)部位經(jīng)過幾千年的演化，其連續(xù)性和柔韌性比機(jī)器人好的多，所以機(jī)器 人翻跟頭會(huì)和人有較大的差

94、別，本文做了大量的改進(jìn)，以適合機(jī)器人的自身 要求。設(shè)計(jì)結(jié)構(gòu)簡圖如下：</p><p><b>　　17</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　二、翻跟頭程序設(shè)計(jì)流程圖</p><p>　　在前期準(zhǔn)備的基礎(chǔ)上， 根據(jù)舵機(jī)的旋轉(zhuǎn)角度算出for循環(huán)的次數(shù)； for循環(huán)的次數(shù) i 等于舵

95、機(jī)角度 /0.74度。例如 : 當(dāng)舵機(jī)轉(zhuǎn)動(dòng) 41 度時(shí)，for 循環(huán)的次數(shù) i=41/0.74=55， 對應(yīng)舵機(jī)正轉(zhuǎn)時(shí)position++，反轉(zhuǎn)時(shí) position--，然后得出行走步態(tài)的程序流程 圖，如下所示：</p><p><b>　　開始</b></p><p>　　position[1]-81 度</p><p>　　

96、position[2]-41 度</p><p>　　position[4]81度</p><p>　　position[5]41 度</p><p>　　position[0]-80 度</p><p>　　position[3]80 度</p><p>　　position[2]48 度</p&

97、gt;<p>　　position[5]-48 度</p><p>　　position[0]80 度</p><p>　　position[3]-80 度</p><p>　　position[1]163度</p><p>　　position[4]-163 度</p><p><b&

98、gt;　　調(diào)用結(jié)束</b></p><p>　　position[2]-15 度</p><p>　　position[5]15 度</p><p>　　position[1]-81度</p><p>　　position[2]-41度</p><p>　　position[4]81度<

99、;/p><p>　　position[5]41 度</p><p>　　position[0]-80 度</p><p>　　position[3]80 度</p><p>　　position[2]48度</p><p>　　position[5]-48 度</p><p>　　p

100、osition[0]80 度</p><p>　　position[3]-80 度</p><p><b>　　注：程序見附錄</b></p><p><b>　　18</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h2>　　3.2.3連續(xù)前進(jìn)步態(tài)設(shè)

101、計(jì)</h2><p>　　連續(xù)行走步態(tài)設(shè)計(jì)，和前邊的前三步的設(shè)計(jì)方法是一樣的，只是在連續(xù)行走 的設(shè)計(jì)中沒有停止步態(tài)，其余步態(tài)只是前三步的連續(xù)循環(huán)調(diào)用。故不在做重復(fù)說 明。</p><p>　　1、 連續(xù)前進(jìn)步態(tài)設(shè)計(jì)結(jié)構(gòu)簡圖</p><p><b>　　啟 動(dòng) 步 態(tài)</b></p><p><b>　　正視圖&

102、lt;/b></p><p><b>　　邁 出 右 腿</b></p><p><b>　　邁 出 左 腿</b></p><p>　　說明： 連續(xù)行走過程中左右腿交叉前進(jìn)，結(jié)構(gòu)簡圖與前邊相同，故不重復(fù)呈現(xiàn)。</p><p>　　2、連續(xù)行走程序設(shè)計(jì)流程圖 連續(xù)行走程序設(shè)計(jì)與前邊的前三步的設(shè)

103、計(jì)方法是一樣的，為了實(shí)現(xiàn)連續(xù)行走，在</p><p><b>　　19</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><p>　　程序中間設(shè)置了一個(gè)while（1）循環(huán)。其他的設(shè)計(jì)與3.2.1 相同故不再闡述。設(shè)計(jì) 流程圖如下：</p><p><b>　　站立姿態(tài)</b><

104、/p><p>　　position[0]-- ； position[1]+=2 ； position[2]++ ； position[3]++ ；</p><p>　　position[4]-=2 ；重</p><p>　　position[5]-- ；復(fù)</p><p><b>　　執(zhí) 行</b></p>

105、<p>　　position[0]++ ； position[1]-=2； position[2]-- ；</p><p>　　While （ 1） position[4]+=2 ；</p><p>　　position[5]++ ；</p><p>　　if((i%2)==0)</p><p>　　position[5]++

106、；</p><p>　　if((i%3)==0)</p><p>　　position[5]++ ；</p><p>　　position[0]-- ； position[1]+=2 ； position[2]++ ；</p><p>　　position[1]--；</p><p>　　position[4]++

107、；</p><p>　　position[1]--；</p><p>　　position[4]++ ；</p><p>　　position[3]++ ； position[4]-=2 ； position[5]-- ；</p><p>　　position[2]-=7 ；</p><p>　　position[1

108、]-=2 ； position[2]-- ； if((i%2)==0)</p><p>　　position[2]-- ；</p><p>　　if((i%4)==0)</p><p>　　position[2]-- ；</p><p>　　position[1]++； position[3]--； position[4]-- ； pos

109、ition[5]-- ；</p><p><b>　　注：程序見附錄</b></p><p><b>　　20</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h4>　　3.2.4主程序流程圖 ：</h2><p>　　在前面對三個(gè)子程序分別進(jìn)行了設(shè)計(jì)，主

110、程序的設(shè)計(jì)只是對子程序的一種調(diào) 用，按照 2010 年交叉足競步機(jī)器人比賽規(guī)則的要求，設(shè)計(jì)出了主程序流程圖以及 主程序。 程序中的翻跟頭程序fan_gendou(3,n)中的 n 可以取 +1 和-1，+1 表示向 前翻， -1 表示向后翻。設(shè)計(jì)流程圖如下：</p><p><b>　　比賽開始</b></p><p><b>　　初始化 CPU<

111、/b></p><p><b>　　{</b></p><p><b>　　舵機(jī)初始化</b></p><p><b>　　執(zhí)行前三步子程序</b></p><p>　　執(zhí)行向前翻跟斗子程序</p><p><b>　　執(zhí)行向前三步子程序

112、</b></p><p>　　執(zhí)行向后翻跟頭子程序</p><p><b>　　向前連續(xù)行走子程序</b></p><p><b>　　}</b></p><p><b>　　比賽結(jié)束</b></p><p><b>　　主程序：&

113、lt;/b></p><p>　　void main(void)</p><p><b>　　{</b></p><p>　　unsignedchar i = 0;</p><p>　　init_cpu();//初始化 cpu fm100ms(2);//用于欠壓報(bào)警 initial_position(

114、);//初始位置</p><p>　　while(1);//重復(fù)執(zhí)行</p><p>　　delay1s(1);//延時(shí) 1S go_ahead_3();//前三步子程序 fan_gendou(3,1);//翻跟斗子程序 go_ahead_3();//前三步子程序 fan_gendou(3,-1); //翻跟斗子程序 go_ahead();

115、//連續(xù)前進(jìn)子程 while(1);}//重復(fù)執(zhí)行</p><p><b>　　21</b></p><p>　　雙足步行機(jī)器人畢業(yè)論文</p><h4>　　3.2.5 PWM_ 6 流程圖</h2><p>　　6路舵機(jī)輸出子程序， 其功能是實(shí)現(xiàn) 6路舵機(jī)的 PWM信號在最短的時(shí)間內(nèi)輸出， 其 中包

116、括了給舵機(jī)端口賦值，將接收到的數(shù)值放入寄存器的數(shù)組中，然后按照大小 進(jìn)行排序，循環(huán)做差后重新賦值并參與邏輯與運(yùn)算，之后將P0口全部拉高及為高 電平延時(shí) 500us后計(jì)時(shí)器后， 根據(jù)PWM 寬度控制控制舵機(jī)旋轉(zhuǎn)角度。 程序設(shè)計(jì)流程 如下：</p><p><b>　　開始</b></p><p><b>　　各舵機(jī)口賦值</b></p>