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

《雙足步行機(jī)器人畢業(yè)論文doc版.docx》由會(huì)員分享，可在線閱讀，更多相關(guān)《雙足步行機(jī)器人畢業(yè)論文doc版.docx（31頁(yè)珍藏版）》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。

. —－可編輯修改，可打印—— 別找了你想要的都有！ 精品教育資料 ——全冊(cè)教案，，試卷，教學(xué)課件，教學(xué)設(shè)計(jì)等一站式服務(wù)—— 全力滿足教學(xué)需求，真實(shí)規(guī)劃教學(xué)環(huán)節(jié) 最新全面教學(xué)資源，打造完美教學(xué)模式 雙足步行機(jī)器人畢業(yè)論文 雙足步行機(jī)器人畢業(yè)論文 交叉足印競(jìng)步機(jī)器人行走步態(tài)實(shí)現(xiàn) I 31 . 雙足步行機(jī)器人畢業(yè)論文 摘 要 機(jī)器人技術(shù)代表了機(jī)電一體化的最高成就，是二十世紀(jì)人類(lèi)最偉大的成果之 一，其中雙足步行機(jī)器人因其體積相對(duì)較小，對(duì)非結(jié)構(gòu)性環(huán)境具有較好的適應(yīng)性， 避障能力強(qiáng)，移動(dòng)盲區(qū)很小等優(yōu)良的品質(zhì)，越來(lái)越受到人們的關(guān)注，因此對(duì)其控 制研究和步態(tài)規(guī)劃具有相當(dāng)?shù)默F(xiàn)實(shí)意義。 本文的主要介紹了雙足競(jìng)步機(jī)器人的國(guó)內(nèi)外發(fā)展情況， 以及 PWM 指令算法和 舵機(jī)的聯(lián)動(dòng)控制，通過(guò)認(rèn)真的研究人類(lèi)行走方式以及翻跟斗的動(dòng)作，對(duì)機(jī)器人的 行走步態(tài)進(jìn)行簡(jiǎn)單的規(guī)劃，設(shè)計(jì)出簡(jiǎn)化結(jié)構(gòu)模型，然后以此為基礎(chǔ)進(jìn)行了適當(dāng)?shù)?調(diào)整，設(shè)計(jì)出符合交叉足競(jìng)步機(jī)器人比賽要求的全部動(dòng)作程序，設(shè)計(jì)完成后將程 序下載到實(shí)驗(yàn)樣機(jī)中，驗(yàn)證程序設(shè)計(jì)的可行性和合理性，通過(guò)反復(fù)的修改和驗(yàn)證 使得機(jī)器人能順利的完成比賽任務(wù)。 關(guān)鍵詞 ：雙足步行機(jī)器人 步態(tài)規(guī)劃 PWM 控制 II 雙足步行機(jī)器人畢業(yè)論文 ABSTRACT Robotic technology represents the electromechanical integration the greatest achievement of the 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 important 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. Because of multi-joint robot 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 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 practical significance.Based on the study of human walking style process and simplify the process after walking with a simplified model, to realize the steering gear PWM robot is effectively controlled. The paper mainly discussed the dynamic walking planning, design and simulation, detailed research using PWM control technology to achieve the linkage of the steering gear control more than. Keywords： Biped robot Gait planning PWM control III 雙足步行機(jī)器人畢業(yè)論文 目錄 摘 要 ..........................................................................................................................I.I... ABSTRACT III 目錄 IV 1 緒論 1 1.1 引言 1 1.2 雙足機(jī)器人的研究概況 1 1.2.2 國(guó)內(nèi)研究概況 4 1.3 雙足步行機(jī)器人的步行特點(diǎn)及研究意義 5 1.4 本文研究?jī)?nèi)容及主要工作 6 1.5 試驗(yàn)樣機(jī)的介紹 6 2 舵機(jī)聯(lián)動(dòng)單周期指令算法研究 8 2.1 舵機(jī) PWM 信號(hào)介紹 8 2． 2 單舵機(jī)拖動(dòng)及調(diào)速算法 8 2.3 算法分析 9 2.4 6 路 PWM 信號(hào)發(fā)生算法解析 10 3 交叉足機(jī)器人行走步態(tài)設(shè)計(jì) 12 3.1 步態(tài)規(guī)劃基本原則 12 3.2 步態(tài)設(shè)計(jì) 12 3.2．1 前三步步態(tài)設(shè)計(jì) 13 3.2．2 翻跟頭步態(tài)設(shè)計(jì) 17 3.2.3 連續(xù)前進(jìn)步態(tài)設(shè)計(jì) 19 3.2.4 主程序流程圖： 21 3.2.5 PWM_ 6 流程圖 22 4 實(shí)驗(yàn)驗(yàn)證及結(jié)果分析 23 4.1 實(shí)驗(yàn)調(diào)試過(guò)程 23 IV 雙足步行機(jī)器人畢業(yè)論文 4.2 實(shí)驗(yàn)演示 24 5 實(shí)驗(yàn)結(jié)論與總結(jié) 28 參考文獻(xiàn) 29 致 謝 30 附錄 31 V 雙足步行機(jī)器人畢業(yè)論文 1 緒論 1.1 引言 近代機(jī)器人學(xué)是最近幾十年新發(fā)展起來(lái)的一門(mén)綜合性的學(xué)科，它集中了機(jī)械 工程技術(shù)、計(jì)算機(jī)工程技術(shù)、控制工程技術(shù)、人工智能、電子工程技術(shù)以及仿生 學(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ì)人類(lèi)最偉大的成果之一，也是一個(gè)國(guó) 家制造業(yè)水平和綜合實(shí)力的象征。 1.2 雙足機(jī)器人的研究概況 隨著國(guó)內(nèi)外學(xué)者紛紛投入到該領(lǐng)域的研究，機(jī)器人逐漸進(jìn)入到工業(yè)生產(chǎn)和人 類(lèi)的生活 [1] 。根據(jù)機(jī)器人的發(fā)展進(jìn)程，通常可分為以下三代： 第一代機(jī)器人，主要指只能以“示教 -再現(xiàn)”方式工作的機(jī)器人，其只能依靠 人們給定的程序，重復(fù)進(jìn)行各種操作。 第二代機(jī)器人是具有一定傳感器反饋功能的機(jī)器人，其能獲取作業(yè)環(huán)境、操 作對(duì)象的簡(jiǎn)單信息，通過(guò)計(jì)算機(jī)處理、分析，對(duì)動(dòng)作進(jìn)行反饋控制，表現(xiàn)出低級(jí) 的智能。 第三代機(jī)器人是指具有環(huán)境感知能力，并能做出自主決策的自治機(jī)器人。它 具有多種感知功能，可進(jìn)行復(fù)雜的邏輯思維，判斷決策，在作業(yè)環(huán)境中可獨(dú)立行 動(dòng)。 1.2.1 國(guó)外研究概況 擬人機(jī)器人的研究是一個(gè)很誘人、難度很大的研究課題。關(guān)于這方面的研究 日本走在了世界的前列。早稻田大學(xué)理工學(xué)部 1973 年建立了“人格化機(jī)器人”研 究室，曾開(kāi)發(fā)出不少擬人機(jī)器人系統(tǒng) [2] 。例如會(huì)演奏鋼琴的機(jī)器人、雙足步行機(jī)器 人以及電動(dòng)假肢等。該研究室的帶頭人高西淳夫教授說(shuō)： “人格化機(jī)器人的一個(gè)很 大特征就是它具有與人類(lèi)相近的結(jié)構(gòu)，機(jī)器人與人類(lèi)的共存是我們研究開(kāi)發(fā)的課 題之一”。 1 雙足步行機(jī)器人畢業(yè)論文 當(dāng)今世界，有“機(jī)器人王國(guó)”之稱(chēng)的日本在雙足步行機(jī)器人研究領(lǐng)域處于絕 對(duì)領(lǐng)先地位，具有代表性的研究機(jī)構(gòu)有加藤實(shí)驗(yàn)室、日本早稻田大學(xué)、日本東京 大學(xué)、日本東京理工學(xué)院、日本機(jī)械學(xué)院、松下電工、本田公司和索尼公司等 [3] 。 日本早稻田大學(xué)的加藤一郎教授于 1968 年率先展開(kāi)了雙足步行機(jī)器人的研制 工作，并先后研制出 WAP 系列樣機(jī) [4] 。其中 WAP-1 步行機(jī)器人具有六個(gè)自由度， 每條腿有骻、膝、踝三個(gè)關(guān)節(jié)；關(guān)節(jié)處使用人造橡膠肌肉，通過(guò)充氣、排氣引起 肌肉收縮，肌肉的收縮牽引關(guān)節(jié)轉(zhuǎn)動(dòng)從而實(shí)現(xiàn)步行。 1971 年，研制出 WAP-3 型雙 足機(jī)器人，仍采用人工肌肉，具有 11 個(gè)自由度，能在平地、斜坡和階梯上行走。 同年又研制出 WL-5 雙足步行機(jī)器人， 該機(jī)器人采用液壓驅(qū)動(dòng)， 具有 11 個(gè)自由度， 下肢作三維運(yùn)動(dòng)，上軀體左右擺動(dòng)以實(shí)現(xiàn)雙足機(jī)器人重心的左右移動(dòng)。 1973 年， 在 WAP-5 的基礎(chǔ)上配置機(jī)械手及人工視覺(jué)、聽(tīng)覺(jué)等裝置組成自主式機(jī)器人 WAROT-1。 1980 年，推出 WL-9DR(Dynam 、Refined)雙足機(jī)器人 [5] ，該機(jī)器人采 用預(yù)先設(shè)計(jì)步行方式的程序控制方法，通過(guò)對(duì)步行運(yùn)動(dòng)的分析及重復(fù)實(shí)驗(yàn)設(shè)計(jì)步 態(tài)軌跡，用設(shè)計(jì)出的步態(tài)控制機(jī)器人的步行運(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) 態(tài)步行。 1984 年，研制出采用跺關(guān)節(jié)力矩控制的 WL-10DR 雙足機(jī)器人 [3][6] ，增加 了跺關(guān)節(jié)力矩控制，將一個(gè)步行周期分為單腳支撐期和轉(zhuǎn)換期。 1986 年，又成功 研制了 WL-12(R) 雙足機(jī)器人，該機(jī)器人通過(guò)軀體運(yùn)動(dòng)來(lái)補(bǔ)償下肢的任意運(yùn)動(dòng)，實(shí) 現(xiàn)了步行周期 1.3 秒，步幅 30 厘米的平地動(dòng)態(tài)步行。代表雙足步行機(jī)器人和擬人 機(jī)器人研究最高水平的是本田公司和索尼公司。本田公司從 1986 年至今已經(jīng)推出 了 Pl，P2，P3 系列機(jī)器人，在 P2 和 P3 中，使用了大量的傳感器：陀螺儀 (測(cè)定上 體偏轉(zhuǎn)的角度和角速度 )、重力傳感器、六維力 /力矩傳感器和視覺(jué)傳感器等，利用 這些傳感器感受機(jī)器人的當(dāng)前狀態(tài)和外界環(huán)境的變化，并基于這些傳感器對(duì)下肢 各關(guān)節(jié)的運(yùn)動(dòng)作出調(diào)整，實(shí)現(xiàn)動(dòng)態(tài)步行。 [7] 2000 年 11 月日本本田公司又推出了新型雙足步行機(jī)器人 ASIMO （圖 1-1）， ASIMO 擁有 34 個(gè)自由度，是目前最先進(jìn)的雙足機(jī)器人 。ASIMO 身高 1.2 米， 體重 52 公斤。它的行走速度是 0-6km/h，行走平穩(wěn)，增加了語(yǔ)音識(shí)別功能，具有 聽(tīng)說(shuō)看的能力，可實(shí)時(shí)識(shí)別人的姿態(tài)與運(yùn)動(dòng)，并進(jìn)行交互。由于采用了新開(kāi)發(fā)的 雙足步行技術(shù)，具有預(yù)測(cè)運(yùn)動(dòng)控制功能，可以更加自由地步行，步行動(dòng)作也更為 連續(xù)流暢，并能完成跑步，轉(zhuǎn)彎，上樓梯等多種復(fù)雜情況下的步行動(dòng)作。 2002 年 6 月 12 日，機(jī)器人世界杯國(guó)際委員會(huì)宣布將從 2002 年 6 月 20 日起在 日本的福岡與韓國(guó)的釜山舉行機(jī)器人世界杯大賽。從該屆起，將增設(shè)雙足步行機(jī) 器人的足球賽事。這標(biāo)志著機(jī)器人選手參加的世界杯又向人類(lèi)走近了一步。該大 賽的目標(biāo)是“在 2050 年之前，制造出能夠戰(zhàn)勝當(dāng)時(shí)世界冠軍隊(duì)的自律型機(jī)器人隊(duì) 2 雙足步行機(jī)器人畢業(yè)論文 伍”，這一夢(mèng)想將由雙足步行機(jī)器人來(lái)實(shí)現(xiàn) [8] 。 2005 年 1 月 12 日，由日本產(chǎn)業(yè)技術(shù)綜合研究所的比留川博等人開(kāi)發(fā)出一臺(tái)取 名“HRP-2”擬人機(jī)器人亮相東京（見(jiàn)圖 1-2）。該機(jī)器人身高 154cm，體重 58kg。 研究人員先請(qǐng)民間藝術(shù)家跳舞，用特殊攝像機(jī)拍攝后將畫(huà)面輸入電腦，并對(duì)手、 腳、頭、腰等 32 個(gè)部位的動(dòng)作進(jìn)行解析，然后把有關(guān)解析數(shù)據(jù)輸入給機(jī)器人，最 后利用這些數(shù)據(jù)來(lái)控制機(jī)器人手的動(dòng)作和腳步等，使“ HRP-2”可以和人一樣動(dòng)作 連貫，翩翩起舞 [9] 。 圖 1-1 本田公司 ASIMO 機(jī)器人 圖 1-2 “HRP -2 ”擬人機(jī)器人 除了日本之外，美國(guó)、英國(guó)、法國(guó)等也對(duì)步行機(jī)器人做了大量的基礎(chǔ)理論研 究和樣機(jī)研制工作，并取得一定成就。美國(guó) Ohio.大學(xué)的美籍華人鄭元芳博士是美 國(guó)雙足步行機(jī)器人研究者中一位非常杰出的人物。他基于神經(jīng)網(wǎng)絡(luò)研制出兩臺(tái)雙 足步行機(jī)器人，分別命名為 SD-1 和 SD-2，SD-1 具有 4 個(gè)自由度， SD-2 具有 8 個(gè) 自由度， 其中 SD-2 是美國(guó)第一臺(tái)真正類(lèi)人的雙足步行機(jī)器人 [8] 。他利用 SDR-2 于 1986 年實(shí)現(xiàn)了平地上的前進(jìn)、后退以及左、右側(cè)行； 1987 年，又成功地實(shí)現(xiàn)了動(dòng) 態(tài)步行。 1971 年至 1986 年間，英國(guó)牛津大學(xué)的 Witt 等人制造并完善了一個(gè)雙足 步行機(jī)器人，該機(jī)器人在平地上行走良好，步速達(dá) 0.23/s。前面所述的研究主要是 關(guān)于主動(dòng)式步行機(jī)器人 (靠關(guān)節(jié)電機(jī)驅(qū)動(dòng) )。加拿大的幾 d.McGeer 主要研究被動(dòng)式 雙足步行機(jī)器人 [6] ，即在無(wú)任何外界輸入的情況下， 靠重力和慣性力實(shí)現(xiàn)步行運(yùn)動(dòng)。 1989 年，他建立了平面型的雙足步行機(jī)構(gòu)，兩腿為直桿機(jī)構(gòu)，沒(méi)有膝關(guān)節(jié)，每條 腿上各有一個(gè)小電機(jī)來(lái)控制腿的伸縮，無(wú)任何主動(dòng)控制和能量供給，放在斜坡上， 可依靠重力實(shí)現(xiàn)動(dòng)態(tài)步行。目前，主動(dòng)和被動(dòng)式雙足步行機(jī)器人在研究上很少互 相借鑒。 3 雙足步行機(jī)器人畢業(yè)論文 1.2.2 國(guó)內(nèi)研究概況 國(guó)內(nèi)雙足步行機(jī)器人的研制工作起步較晚，我國(guó)是從 20 世紀(jì) 80 年代開(kāi)始雙 足步行機(jī)器人領(lǐng)域的研究和應(yīng)用的。 1986 年，我國(guó)開(kāi)展了“七五”機(jī)器人攻關(guān)計(jì) 劃，1987 年，我國(guó)的“ 863”高技術(shù)計(jì)劃將機(jī)器人方面的研究開(kāi)發(fā)列入其中。目前 我國(guó)從事機(jī)器人研究與應(yīng)用開(kāi)發(fā)的單位主要是高校和有關(guān)科研院所等。最初我國(guó) 進(jìn)行機(jī)器人技術(shù)研究的主要目的是跟蹤國(guó)際先進(jìn)的機(jī)器人技術(shù)，隨后取得了一定 的成就。自 1985 年以來(lái)，相繼有幾所高校進(jìn)行了這方面的研究并取得了一定的成 果，其中以哈爾濱工業(yè)大學(xué)和國(guó)防科技大學(xué)較為成果顯著。在自然科學(xué)基金和國(guó) 家”863”計(jì)劃的支持下，哈爾濱工業(yè)大學(xué)自 1985 年開(kāi)始研制雙足步行機(jī)器人 [11]， 迄今為止己經(jīng)完成三個(gè)型號(hào)的研制工作。 1988 年哈工大 HIT-1 型雙足步行機(jī)器人 問(wèn)世， 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)彎、上下臺(tái)階及上斜坡等動(dòng)作。 清華大學(xué) 2002 年 4 月 9 日研制雙足機(jī)器人 THBIP-I 樣機(jī)。THBIP-I 有 32 個(gè)自 由度，采用獨(dú)特傳動(dòng)結(jié)構(gòu)，成功實(shí)現(xiàn)無(wú)纜連續(xù)穩(wěn)定的平地行走、連續(xù)上下臺(tái)論階 行走，以及端水、 太極拳和點(diǎn)頭等動(dòng)作。 其平地行走速度為 4.2 米/分，步距為 0.35 米，跨越臺(tái)階高度 75 毫米，跨越速度 20 秒/步。 國(guó)防科技大學(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) /后退和上 /下臺(tái)階的靜 /動(dòng)態(tài)步行和轉(zhuǎn)彎 運(yùn)動(dòng)[12] 。2000 年 11 月 29 日，又研制出我國(guó)第一臺(tái)類(lèi)人型雙足步行機(jī)器人“先行 者”，高 1.4 米，重 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 的仿人機(jī)器人在北京理工大學(xué)通過(guò)國(guó)家“ 863” 項(xiàng)目組的驗(yàn)收。這個(gè)機(jī)器人身高 1.58m，體重 76kg，具有 32 個(gè)自由度，每小時(shí)能夠行走 1km，步幅 0.33m。驗(yàn)收 專(zhuā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ù)自身力覺(jué)、平衡覺(jué)等感知機(jī)器人自身的平衡狀態(tài)和地面高度的 變化，實(shí)現(xiàn)在未知地面上的穩(wěn)定行走和太極拳表演，使中國(guó)成為繼日本之后，第 二個(gè)研制出無(wú)外接電纜行走，集感知、控制、驅(qū)動(dòng)、電源和機(jī)構(gòu)于一體的高水平 4 雙足步行機(jī)器人畢業(yè)論文 仿人機(jī)器人國(guó)家。 1.3 雙足步行機(jī)器人的步行特點(diǎn)及研究意義 機(jī)器人是現(xiàn)代科學(xué)技術(shù)發(fā)展的必然產(chǎn)物，因?yàn)槿藗兛偸窃O(shè)法讓機(jī)器來(lái)代替人 的繁重工作，從而發(fā)明了各種各樣的機(jī)器 [13] 。機(jī)器的發(fā)展和其它事物一樣，遵循 著由低級(jí)到高級(jí)的發(fā)展規(guī)律，機(jī)器發(fā)展的最高形式必然是機(jī)器人。而機(jī)器人發(fā)展 的最高目標(biāo)是制造出像人一樣可以行走和作業(yè)的機(jī)器人，也就是擬人機(jī)器人。因 為它具有良好的環(huán)境適應(yīng)性，并且這種優(yōu)秀品質(zhì)在高低不平的路面上以及具有障 礙物的空間里更加突出，所以與之相關(guān)的問(wèn)題己經(jīng)成為研究熱點(diǎn)。擬人機(jī)器人的 研制工作開(kāi)始于 20 世紀(jì) 60 年代，短短的幾十年時(shí)間內(nèi)，其研制工作進(jìn)展迅速。 步行機(jī)器人的研制工作是其中一項(xiàng)重要內(nèi)容。目前，機(jī)器人的移動(dòng)方式主要包括 輪式、履帶式、爬行式、蠕動(dòng)式以及步行等方式。對(duì)輪式和履帶式移動(dòng)機(jī)器人的 研究主要集中在自主運(yùn)動(dòng)控制上，如避障路徑規(guī)劃等。這兩種機(jī)器人過(guò)分依賴(lài)于 周?chē)h(huán)境，應(yīng)用范圍受限。爬行和蠕動(dòng)式機(jī)器人主要用于管道作業(yè)，具有良好的 靜動(dòng)態(tài)穩(wěn)定性，但速度較低 [14] 。常見(jiàn)的步行機(jī)器人有雙足、四足和六足等情況。 自然界事實(shí)、仿生學(xué)以及力學(xué)分析表明 : 在具有許多優(yōu)點(diǎn)的步行機(jī)器人中，雙足步 行機(jī)器人因其體積相對(duì)較小，對(duì)非結(jié)構(gòu)性環(huán)境具有較好的適應(yīng)性，避障能力強(qiáng)， 移動(dòng)盲區(qū)很小等優(yōu)良的移動(dòng)品質(zhì)，格外引人注目。 首先，對(duì)于支撐路面，雙足步行機(jī)器人的要求很低，理論上只需要分散的、 孤立的支撐點(diǎn)，就可以通過(guò)機(jī)器人自行選擇最佳的支撐點(diǎn)，獲得最佳的移動(dòng)性能。 而輪式移動(dòng)機(jī)器人通常要求連續(xù)的、硬質(zhì)的支撐路面，對(duì)于惡劣的支撐路面，它 只能被動(dòng)的適應(yīng)。 其次，在存在障礙物的情況下，雙足步行機(jī)器人能夠跨越與自身腿長(zhǎng)相當(dāng)?shù)?障礙物，甚至跳越障礙，而輪式移動(dòng)機(jī)器人僅能滾越尺寸小于輪子半徑的障礙物。 機(jī)器人力學(xué)計(jì)算表明，足式步行機(jī)器人的能耗通常低于輪式和履帶式。步行是人 類(lèi)的一種基本活動(dòng)能力，雙足步行技術(shù)的發(fā)展會(huì)促進(jìn)動(dòng)力型假肢的研制，將有可 能解決截癱病人和小兒麻痹癥患者的行走問(wèn)題，為康復(fù)醫(yī)學(xué)做出貢獻(xiàn)。對(duì)機(jī)器人 雙足動(dòng)態(tài)行走機(jī)理的深入研究也使我們更深刻地理解人類(lèi)活動(dòng)的內(nèi)在本質(zhì)，有助 于生物醫(yī)學(xué)工程和體育運(yùn)動(dòng)科學(xué)的發(fā)展。而雙足步行機(jī)器人與傳統(tǒng)的輪式機(jī)器人 相比，最具有挑戰(zhàn)性的問(wèn)題之一就在于，它的單、雙足交替支撐的步行方式使得 雙足步行機(jī)器人難以保持較好的穩(wěn)定性。從而，使得人們?cè)跈C(jī)器人穩(wěn)定性和步態(tài) 規(guī)劃方面的研究更加深入。 5 雙足步行機(jī)器人畢業(yè)論文 1.4 本文研究?jī)?nèi)容及主要工作 為了促進(jìn)機(jī)器人技術(shù)在我國(guó)的發(fā)展，全國(guó)各地尤其是部分高校舉辦了各種類(lèi) 型的機(jī)器人大賽。中國(guó)機(jī)器人大賽是由中國(guó)自動(dòng)化學(xué)會(huì)機(jī)器人競(jìng)賽工作委員會(huì)和 科技部高技術(shù)研究發(fā)展中心主辦的一個(gè)全國(guó)性的賽事。其中最為引人矚目的舞蹈 機(jī)器人項(xiàng)目就是為了促進(jìn)雙足步行機(jī)器人的發(fā)展而設(shè)立的。由于步行機(jī)器人的實(shí) 現(xiàn)目前還存在很多技術(shù)難題，前幾屆由中國(guó)科技大學(xué)主辦的舞蹈機(jī)器人大賽基本 上是以輪式機(jī)器人為主，還沒(méi)有出現(xiàn)步行機(jī)器人參賽，由此可見(jiàn)，雙足步行機(jī)器 人的發(fā)展還有一段很長(zhǎng)的路要走。研制雙足步行機(jī)器人的一項(xiàng)重要內(nèi)容就是步態(tài) 規(guī)劃。所謂的步態(tài)，是指在步行過(guò)程中，步行本體的身體各部位在時(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)。 本文的主要任務(wù)就是在大量研讀資料后，認(rèn)真的研究人類(lèi)行走過(guò)程，并通過(guò) 的適當(dāng)?shù)恼{(diào)整，完成交叉足競(jìng)步機(jī)器人行走程序的設(shè)計(jì)，完成設(shè)計(jì)后將設(shè)計(jì)好的 程序下載都到實(shí)驗(yàn)樣機(jī)中，驗(yàn)證設(shè)計(jì)程序的可行性和合理性，通過(guò)反復(fù)的驗(yàn)證和 改進(jìn)使得機(jī)器人能順利的完成比賽任務(wù)。 1.5 試驗(yàn)樣機(jī)的介紹 本文采用的樣機(jī)是 SHR-TLA 機(jī)器人，該機(jī)器人的關(guān)鍵技術(shù)主要包括 3部分： 其一是數(shù)控系統(tǒng)，也指電子部分，其二是伺服舵機(jī)，其三是機(jī)械結(jié)構(gòu)件。 1、實(shí)驗(yàn)樣機(jī)的控制器系統(tǒng)采用北京森漢科技生產(chǎn)的控制板 (見(jiàn)圖 1-3), 該控制 板采用 STC12C5412AD 單片機(jī) ,設(shè)計(jì)合理，擴(kuò)展了 STC12C5412AD 系列單片機(jī)的 所有外接端口 ,具有很好的操作性 .。 2、樣機(jī)共有六個(gè) SH14-M-C舵機(jī)（見(jiàn)圖 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)，是有“電子自鎖” 功能。 3、該款樣機(jī)全身的機(jī)械結(jié)構(gòu)均采用金屬結(jié)構(gòu) （見(jiàn)圖 1-5），有較強(qiáng)的機(jī)械強(qiáng)度， 樣機(jī)的身高 280mm，肩寬 165mm，胸厚 140mm，質(zhì)量 0.9kg。 6 雙足步行機(jī)器人畢業(yè)論文 圖１ - ３STC12C5412AD 控制板 圖 1-4 SH14-M-C 舵機(jī) 圖 1-5 SHR-TLA 機(jī)器人 4、機(jī)器人各舵機(jī)與控制口的定義 程序中命名 定義接口 平面命名 電路板接口 舵機(jī)分布圖 position[0] —— P1.0 x1 舵機(jī) J12 position[1] —— P1.1 x2 舵機(jī) J11 position[2] —— P1.2 x3 舵機(jī) J10 position[3] —— P1.3 x4 舵機(jī) J8 position[4] —— P1.4 x5 舵機(jī) J7 position[5] —— P1.5 x6 舵機(jī) J5 圖 1-6 舵機(jī)分布圖 7 雙足步行機(jī)器人畢業(yè)論文 2 舵機(jī)聯(lián)動(dòng)單周期指令算法研究 2.1 舵機(jī) PWM信號(hào)介紹 PWM 是 Pulse Width Modulation 縮寫(xiě)， 中文意思就是脈沖寬度調(diào)制，簡(jiǎn)稱(chēng)脈 寬調(diào)制。它是利用微處理器的數(shù)字輸出來(lái)對(duì)模擬電路進(jìn)行控制的一種非常有效的 技術(shù)，其特點(diǎn)在于他的上升沿與下降沿之間的時(shí)間寬度。我們目前使用的舵機(jī)主 要依賴(lài)于模型行業(yè)的標(biāo)準(zhǔn)協(xié)議，隨著機(jī)器人行業(yè)的漸漸獨(dú)立，有些廠商已經(jīng)推出 全新的舵機(jī)協(xié)議，這些舵機(jī)只能應(yīng)用于機(jī)器人行業(yè)，已經(jīng)不能夠應(yīng)用于傳統(tǒng)的模 型上面了。 本文采用的是 8 位 STC12C5410ADCPU ，其數(shù)據(jù)分辨率為 256 ，經(jīng)過(guò)舵機(jī) 極限參數(shù)實(shí)驗(yàn)，得到應(yīng)該將其劃分為 250 份。那么 0.5mS~2.5ms 的脈沖寬度為 2mS 即 2000uS，2000uS÷250=8uS 則：PWM 的控制精度為 8uS,本文以 8uS 為單位遞 增控制舵機(jī)轉(zhuǎn)動(dòng)與定位，舵機(jī)可以轉(zhuǎn)動(dòng) 185 度，那么 185 度÷ 250=0.74 度， 則： 舵機(jī)的控制精度為 0.74 度。由此我們定義了 1 DWT = 8uS ； 1DWA=0.74 度。 2． 2 單舵機(jī)拖動(dòng)及調(diào)速算法 舵機(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)保持該位置。所以對(duì)于數(shù)字舵機(jī)而言， PWM 信號(hào)提供的是 目標(biāo)位置，跟蹤運(yùn)動(dòng)要靠舵機(jī)本身。像 SH-0680 這樣的模擬舵機(jī)需要時(shí)刻供給 PWM 信號(hào)，舵機(jī)自己不能鎖定目標(biāo)位置。 所以我們的控制系統(tǒng)是一個(gè)目標(biāo)規(guī)劃 系統(tǒng)。 SH14-M 舵機(jī)的位置控制方法： （1）相關(guān)計(jì)算說(shuō)明：舵機(jī)角度 = 0.74×N； PWM 高電平的時(shí)間為： 500us + N× 8us 或者舵機(jī)角度 /8us+500us； 部分角度對(duì)應(yīng)的 N 值和 PWM 值如下： 角度 0 45 90 135 185 N 0 62 125 187 250 PWM 0.5ms 1ms 1.5ms 2ms 2.5ms 表 2-1 舵機(jī)要求 PWM 格式上升沿最少為 0.5mS，為 0.5mS---2.5mS 之間；下降沿時(shí)間沒(méi) 要求，目前采用 0.5mS 就行；也就是說(shuō) PWM 波形可以是一個(gè)周期 1mS 的標(biāo)準(zhǔn) 8 雙足步行機(jī)器人畢業(yè)論文 方波，具體格式說(shuō)明圖例如下圖： 0.5ms N × 0.8us PWM 0.5ms+N × 0.8us （2）SH14-M 舵機(jī)的運(yùn)動(dòng)協(xié)議 圖 2-1 PWM 格式 ①舵機(jī)的轉(zhuǎn)動(dòng)方向?yàn)?: 逆時(shí)針為正轉(zhuǎn) ②Φ對(duì)應(yīng) N 值 N=0， Φ=0 ；度 N=250，Φ =185 度 ；1 ≤ N ≤ 250 運(yùn)動(dòng)時(shí)可以外接較大的轉(zhuǎn)動(dòng)負(fù)載，舵機(jī)輸出扭矩較大，而且抗抖動(dòng)性很好，電位 器的線性度較高，達(dá)到極限位置時(shí)也不會(huì)偏離目標(biāo)。 2.3 算法分析 我們使用定時(shí)器中斷的方式產(chǎn)生所需的 PWM 波，定時(shí)器初始化后， 由定時(shí)器 0 產(chǎn)生 20ms 的脈沖周期，開(kāi)始執(zhí)行第一組數(shù)據(jù)。定時(shí)器 1 被賦予第 n 個(gè)舵機(jī)的脈 寬值（n 初始值為 0，對(duì)應(yīng) A0 口），同時(shí)對(duì)應(yīng)第 n 個(gè)舵機(jī)的 I/O 口翻轉(zhuǎn)， 輸出為高， 定時(shí)器 1 定時(shí)時(shí)間到，進(jìn)入中斷， n 口翻轉(zhuǎn)，輸出變?yōu)榈?，同時(shí) n++，循環(huán)上述過(guò) 程，直到 n＝5，這時(shí) j++ ，n 重新賦 0，等待定時(shí)器 0 的中斷發(fā)生后，進(jìn)入下一組 數(shù)執(zhí)行，這樣已知循環(huán)，知道執(zhí)行完所有的數(shù)據(jù)（ j ＝ m）為止，即機(jī)器人走完一 個(gè)完整的步態(tài)。 當(dāng)同時(shí)發(fā)給 6 個(gè)舵機(jī)位置目標(biāo)值時(shí)，該指令的執(zhí)行周期盡量短，目的有 2 個(gè)： 其一，是為了將來(lái)擴(kuò)充至 24 舵機(jī)； 其二，目標(biāo)越快，舵機(jī)的轉(zhuǎn)動(dòng)速度越快； 我們以 P0 口得 6 路為 1 組或稱(chēng) 1 個(gè)單位，連續(xù)發(fā)出目標(biāo)位置，形成連續(xù)的目 標(biāo)規(guī)劃曲線，電機(jī)在跟隨過(guò)程中自然形成了位置與速度的雙指標(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 位一并。 具體如下： P0 口的 6 個(gè)位置各不相同： 9 雙足步行機(jī)器人畢業(yè)論文 （us） P0.0 position[0] 0 0 500 P0.1 position[1] 0.74 1 508 P0.2 position[2] 7.4 10 580 P0.3 position[3] 37 50 900 P0.4 position[4] 74 100 1300 P0.5 position[5] 111 150 1700 端口 N 寄存器 目標(biāo)位置（度） N 數(shù)值（整數(shù)） PWM 寬度 表 2-2 2.4 6 路 PWM信號(hào)發(fā)生算法解析 定義數(shù)組： ass[6]； 例如： logic[6] ； ass [0] [1] [2] [3] [4] [5] 120 60 89 20 12 201 logic [0] [1] [2] [3] [4] [5] 0xFE 0xFD 0xFB 0xF7 0xEF 0xDF ① ass[6]內(nèi)為 P0 口的 6 路 N 數(shù)值，這些數(shù)值是根據(jù)舵機(jī)狀態(tài)定的， 沒(méi)有規(guī)律。 logic[8] 內(nèi)為固定的一組邏輯參數(shù)。 ②將數(shù)組 ass 內(nèi)的數(shù)據(jù)由大到小排列， logic 內(nèi)的數(shù)據(jù)也數(shù)之變化，變成： ass [0] [1] [2] [3] [4] [5] 201 120 89 60 20 12 logic [5] [4] [3] [2] [1] [0] 0xDF 0xFE 0xFB 0xFD 0xF7 0xEF ③將 N 值做減法，求得： ass[0]=ass[0]-ass[1]=81 ass[1]=ass[1]-ass[2]=31 ass[2]=ass[2]-ass[3]=29 ass[3]=ass[3]-ass[4]=40 ass[4]=ass[4]-ass[5]=8 ass[5]=ass[5] =12 ④我們將每 6 路輸出的高電平時(shí)間限制在一個(gè) 2.5ms 的中斷內(nèi)，開(kāi)啟中斷。 ⑤將全部的 6 路輸出置為高電平，并延時(shí) 500us 作為目標(biāo)位置為 0 的基礎(chǔ)。 10 雙足步行機(jī)器人畢業(yè)論文 ⑥循環(huán) 6 次,每次延時(shí) ass 內(nèi)的值個(gè) 8us,再將 P0 口“與”相應(yīng)的邏輯參數(shù) . 例如： 順序 ass[5] 12 96us 0xEF（ 0B10111111） 第四位置 “0” 4 ass[4] 8 64us 0XF7（ 0B11111101） 第三位置 “0” 3 ass[3] 40 320us 0xFD（ 0B11111011） 第一位置 “0” 1 ass[2] 29 232us 0xFB（ 0B01111111） 第二位置 “0” 2 ass[1] 31 248us 0xFE（ 0B11111110） 第零位置 “0” 0 ass[0] 81 648us 0xDF（ 0B11011111） 第五位置 “0” 5 N 差值  延時(shí)時(shí)間 （N 差值× 8us）  對(duì)應(yīng) “與”的值 相應(yīng)輸出 0 的位 相繼變成 低電平的 11 雙足步行機(jī)器人畢業(yè)論文 3 交叉足機(jī)器人行走步態(tài)設(shè)計(jì) 人形機(jī)器人具有廣闊的應(yīng)用前景 ,其研制工作得到了各國(guó)的重視 ,近年來(lái)已取 得巨大的進(jìn)展 ,但仍存在大量的理論和技術(shù)問(wèn)題有待深入研究 [15] 。如何規(guī)劃?rùn)C(jī)器人 步態(tài)使其穩(wěn)定行走仍是人形機(jī)器人研究領(lǐng)域的關(guān)鍵技術(shù)之一。步態(tài)是在步行運(yùn)動(dòng) 過(guò)程中 ,機(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ù)。要實(shí)現(xiàn)和提高機(jī)器人的行走性能，必須研究實(shí)用而有效的步態(tài)規(guī)劃 方法，實(shí)現(xiàn)機(jī)器人的穩(wěn)定步行 [16]。 人類(lèi)在研究人體結(jié)構(gòu)之前花費(fèi)了大量的時(shí)間去研究昆蟲(chóng)，哺乳動(dòng)物的腿部移 動(dòng)，甚至登山運(yùn)動(dòng)員在爬山時(shí)的腿部運(yùn)動(dòng)方式 [17]。這些研究幫助我們更好的了解 在行走過(guò)程中發(fā)生的一切，特別是關(guān)節(jié)處的運(yùn)動(dòng)。比如，我們?cè)谛凶叩臅r(shí)候會(huì)移 動(dòng)我們的重心，并且前后擺動(dòng)雙手來(lái)平衡我們的身體。這些構(gòu)成了人形機(jī)器人行 走的基礎(chǔ)方式，人形機(jī)器人和人類(lèi)一樣，有髖關(guān)節(jié)，膝關(guān)節(jié)和足關(guān)節(jié)。機(jī)器人中 的關(guān)節(jié)一般用 “自由度 ”來(lái)表示。一個(gè)自由度表示一個(gè)運(yùn)動(dòng)可以或者向上， 或者向下， 或者向右，或者向左。分散在身體的不同部位，所以骨骼結(jié)構(gòu)因此而生。 3.1 步態(tài)規(guī)劃基本原則 對(duì)雙足步行機(jī)器人而言，理論上可供選擇的步態(tài)有無(wú)數(shù)種。但是，步態(tài)規(guī)劃 必須保證以下兩個(gè)原則 [18]： 1．所規(guī)劃的步態(tài)必須滿足設(shè)定的目標(biāo)。 2．機(jī)器人按照規(guī)劃步態(tài)行走時(shí)必須始終保持自身的穩(wěn)定。 同時(shí)，所規(guī)劃的步態(tài)還應(yīng)符合人類(lèi)的行走習(xí)慣，并使控制盡可能簡(jiǎn)單。人類(lèi) 行走步態(tài)是幾千年演化的結(jié)果，是自然界中最合理的行走方式，符合人類(lèi)的行走 習(xí)慣的步態(tài)不僅能使機(jī)器人保持穩(wěn)定，而且能使其所消耗的能量減少到最低程度。 此外，機(jī)器人的行走必須加以人為的控制，如果規(guī)劃的步態(tài)存在控制上的困難甚 至難以實(shí)現(xiàn)，顯然意義不大。 3.2 步態(tài)設(shè)計(jì) 2010 年中國(guó)機(jī)器人大賽雙足競(jìng)步機(jī)器人組比賽規(guī)則交叉足印項(xiàng)目要求 : 機(jī)器 人通過(guò)步行的方式從起點(diǎn)線走到終點(diǎn)線（相距 200cm，限寬 60cm）。競(jìng)賽開(kāi)始時(shí)先 走出 3 步距離、立正、然后臥下、向前翻跟斗 3 次，再起立、向前走出 3 步距離、 12 雙足步行機(jī)器人畢業(yè)論文 [21] 立正、然后臥下（身體向后） 、再向后翻跟斗 3 次、再起立、然后以輕快步履走向 終點(diǎn)，參賽機(jī)器人要在 4 分鐘以?xún)?nèi)完成所有動(dòng)作 。 為了符合比賽的要求，本文將整套動(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ì)。 3.2 ． 1 前三步步態(tài)設(shè)計(jì) 近年來(lái) , 隨著雙足機(jī)器人研究的興起， 人類(lèi)行走步態(tài)的特征成了仿生機(jī)械學(xué)家 研究雙足機(jī)器人的一個(gè)重要依據(jù)。體育研究者和人體運(yùn)動(dòng)信息研究專(zhuān)家對(duì)人體的 運(yùn)動(dòng)做了大量的研究工作。他們讓實(shí)驗(yàn)者穿上緊身衣，并在踝、膝、髖、肩、肘 等關(guān)鍵關(guān)節(jié)貼上亮片標(biāo)志以便于識(shí)別，在實(shí)驗(yàn)者行走過(guò)程中，利用高速攝像機(jī)對(duì) 試驗(yàn)者的行走步態(tài)進(jìn)行連續(xù)拍照，如圖 3-1 所示。通過(guò)大量實(shí)驗(yàn)，獲得不同實(shí)驗(yàn) 者的行走步態(tài)連續(xù)照片，經(jīng)過(guò)分析整理獲得可以指導(dǎo)機(jī)器人步態(tài)規(guī)劃的人類(lèi)行走 步態(tài)數(shù)據(jù)。 圖 3-1 人類(lèi)行走步態(tài) 雙足機(jī)器人步態(tài)研究 [6] 的一個(gè)重要方法就簡(jiǎn)化出雙足機(jī)器人的結(jié)構(gòu)簡(jiǎn)圖。 由于 雙足機(jī)器人的原始模型是一個(gè)高階次、多變量、強(qiáng)耦合、非線性和變結(jié)構(gòu)的復(fù)雜 動(dòng)力學(xué)系統(tǒng) [19] ,要對(duì)它進(jìn)行直接研究甚至是理解都很困難 ,因此必須在某種條件下 進(jìn)行簡(jiǎn)化 ,這種簡(jiǎn)化必須具備真實(shí)性和可復(fù)原性，人類(lèi)通過(guò)交替地以一條腿作為支 13 雙足步行機(jī)器人畢業(yè)論文 撐,向前擺動(dòng)另一條腿 , 并伴以軀干和手臂的 運(yùn)動(dòng)來(lái)實(shí)現(xiàn)靈活的步 行運(yùn)動(dòng) ,其過(guò)程和機(jī)理 是非常復(fù)雜的。 研究證 明[20] :雙足步行機(jī)器人 在平穩(wěn)步行的條件下 , 能夠?qū)崿F(xiàn)上身軀和下肢的運(yùn)動(dòng)解耦 ,并且容 易對(duì)下身軀的各個(gè)關(guān)節(jié)角實(shí)施角度 規(guī)劃,因此可以利用解耦控制分別控制上身軀和下身軀的運(yùn)動(dòng) ,并且對(duì)下身軀的各 個(gè)關(guān)節(jié)角實(shí)施軌跡規(guī)劃。 因此,在分析和模擬人類(lèi)的步行運(yùn)動(dòng)時(shí) ,進(jìn)行了簡(jiǎn)化 ,去掉一 些復(fù)雜的動(dòng)作細(xì)節(jié) ,重點(diǎn)抓住下肢的主要?jiǎng)幼魈攸c(diǎn)和要領(lǐng)。 一個(gè)完整的行走周期分為雙腿支撐階段和單腿支撐階段。在雙腿支撐階段 ,兩 只腳都與地面接觸 ,這個(gè)階段開(kāi)始于前腳的后跟接觸地面 ,結(jié)束于后腳的腳尖離開(kāi) 地面。單腿支撐階段一條腿支撐身體 ,另外一條腿完成步行前移。在單腿支撐階段 , 一只腳固定在地面上而另一只腳從后往前擺動(dòng) ,步行時(shí) ,機(jī)器人交替地進(jìn)入雙腿支 撐階段和單腿支撐階段。 機(jī)器人行走過(guò)程步態(tài)解析如下：初始位置：雙腿直立。 動(dòng)作流程： 雙腿下蹲 抬一腿，直立→邁一腿，下蹲 循環(huán)（ N 步） 邁一腿，下蹲←抬一腿，直立 根據(jù)人類(lèi)行走姿態(tài)，經(jīng)過(guò)簡(jiǎn)化修改設(shè)計(jì)出符合機(jī)器人行走的步態(tài)，設(shè)計(jì)流程圖 如下： 1、前三步步態(tài)設(shè)計(jì)過(guò)程圖 啟動(dòng)步態(tài) 雙腳站 降低 立狀態(tài) 重心 重心擺 到左腿 右腿向前 邁出半步 重心擺到 兩腿中間 重心 右腿向 重 心 重 心 左 腿 重心 行走步態(tài) 擺到 前邁一 擺 到 擺 到 向 前 擺到 兩腿 步 左腿 兩 腿 邁 出 右腿 重心 停止步態(tài) 擺到 右腿 左 腿 向 前 邁 出 半步 重 心 擺 到 兩 腿 中間 重心 雙腳 升高 站立 圖 3-2 前三步步態(tài)設(shè)計(jì)過(guò)程圖 14 雙足步行機(jī)器人畢業(yè)論文 2、前三步步態(tài)設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖 按照上一節(jié)的設(shè)計(jì)思路，將人類(lèi)的行走的步態(tài)進(jìn)一步簡(jiǎn)化，畫(huà)出機(jī)器人腿部三個(gè) 關(guān)節(jié)處個(gè)各舵機(jī)的旋轉(zhuǎn)角度，角度的大小均以自然行走時(shí)的姿勢(shì)為準(zhǔn)。 啟 動(dòng) 步 態(tài) 正視圖 第 一 步 第 二 步 第 三 步 停 止 步 態(tài) 15 雙足步行機(jī)器人畢業(yè)論文 3、前三步程序設(shè)計(jì)流程圖 在前期準(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í)， for 循環(huán)的次數(shù) i=24/0.74=33 ，對(duì)應(yīng)舵機(jī)正轉(zhuǎn)時(shí) position++ ，反轉(zhuǎn)時(shí) position-- ，然后得出行走 步態(tài)的程序流程圖，如下所示： 站立姿態(tài) position[0]-- ； position[1]+=2 ； position[2]++ ； position[3]++ ； position[4]-=2 ； position[5]-- ； position[0]++ ； position[1]-=2 ； position[2]-- ； position[4]+=2 ； position[5]++ ； if((i%2)==0) position[5]++ ； if((i%3)==0) position[5]++ ； position[0]-- ； position[1]+=2 ； position[2]++ ； position[1]-- ； position[4]++ ； position[1]++ ； position[3]-- ； position[4]-- ； position[5]-- ； position[4]+=2 ； position[5]++ ； if((i%2)==0) position[5]++ ； if((i%3)==0) position[4]-- ； position[0]++ ； position[1]++ ； position[2]++ ； position[1]-- ； position[4]++ ； position[3]++ ； position[4]-=2 ； position[5]-- ； position[2]-=7 ； 微調(diào) position[1]-=2 ； position[2]-- ； if((i%2)==0) position[2]-- ； if((i%4)==0) position[2]-- ； position[5]+=5 ； position[0]-- ； position[1]+=2 ； position[2]++ ； position[1]-- ； position[4]++ ； position[1]++ ； position[3]-- ； position[4]-- ； position[5]-- ； position[0]++ ； position[1]-=2 ； position[2]-- ； 結(jié)束 注：程序見(jiàn)附錄 16 雙足步行機(jī)器人畢業(yè)論文 3.2 ． 2 翻跟頭步態(tài)設(shè)計(jì) 機(jī)器人大賽中要求機(jī)器人有翻跟頭的動(dòng)作，為了滿足比賽要求，作者搜集了 人類(lèi)翻跟頭的資料（見(jiàn)下圖） ，人類(lèi)翻跟斗時(shí)動(dòng)作的連貫性和柔韌性是機(jī)器人無(wú)法 比擬的，所以在在動(dòng)作的設(shè)計(jì)上做了大量的改動(dòng)。 一、翻跟頭步態(tài)設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖 翻跟頭的設(shè)計(jì)和前邊的前三步設(shè)計(jì)思路和方法是一樣的，根據(jù)人類(lèi)翻跟頭的相關(guān) 資料，畫(huà)出機(jī)器人簡(jiǎn)化結(jié)構(gòu)模型，并根據(jù)動(dòng)作姿態(tài)確定個(gè)舵機(jī)的旋轉(zhuǎn)角度。人類(lèi) 各個(gè)關(guān)節(jié)部位經(jīng)過(guò)幾千年的演化，其連續(xù)性和柔韌性比機(jī)器人好的多，所以機(jī)器 人翻跟頭會(huì)和人有較大的差別，本文做了大量的改進(jìn)，以適合機(jī)器人的自身 要求。設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖如下： 17 雙足步行機(jī)器人畢業(yè)論文 二、翻跟頭程序設(shè)計(jì)流程圖 在前期準(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) 41 度時(shí)，for 循環(huán)的次數(shù) i=41/0.74=55 ， 對(duì)應(yīng)舵機(jī)正轉(zhuǎn)時(shí) position++ ，反轉(zhuǎn)時(shí) position-- ，然后得出行走步態(tài)的程序流程 圖，如下所示： 開(kāi)始 position[1] -81 度 position[2] -41 度 position[4] 81 度 position[5] 41 度 position[0] -80 度 position[3] 80 度 position[2] 48 度 position[5] -48 度 position[0] 80 度 position[3] -80 度 position[1] 163 度 position[4] -163 度 調(diào)用結(jié)束 position[2] -15 度 position[5] 15 度 position[1] -81 度 position[2] -41 度 position[4] 81 度 position[5] 41 度 position[0] -80 度 position[3] 80 度 position[2] 48 度 position[5] -48 度 position[0] 80 度 position[3] -80 度 注： 程序見(jiàn)附錄 18 雙足步行機(jī)器人畢業(yè)論文 3.2.3 連續(xù)前進(jìn)步態(tài)設(shè)計(jì) 連續(xù)行走步態(tài)設(shè)計(jì)，和前邊的前三步的設(shè)計(jì)方法是一樣的，只是在連續(xù)行走 的設(shè)計(jì)中沒(méi)有停止步態(tài)，其余步態(tài)只是前三步的連續(xù)循環(huán)調(diào)用。故不在做重復(fù)說(shuō) 明。 1、 連續(xù)前進(jìn)步態(tài)設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖 啟 動(dòng) 步 態(tài) 正視圖 邁 出 右 腿 邁 出 左 腿 說(shuō)明： 連續(xù)行走過(guò)程中左右腿交叉前進(jìn)，結(jié)構(gòu)簡(jiǎn)圖與前邊相同，故不重復(fù)呈現(xiàn)。 2、連續(xù)行走程序設(shè)計(jì)流程圖 連續(xù)行走程序設(shè)計(jì)與前邊的前三步的設(shè)計(jì)方法是一樣的，為了實(shí)現(xiàn)連續(xù)行走，在 19 雙足步行機(jī)器人畢業(yè)論文 程序中間設(shè)置了一個(gè) while（1）循環(huán)。其他的設(shè)計(jì)與 3.2.1 相同故不再闡述。設(shè)計(jì) 流程圖如下： 站立姿態(tài) position[0]-- ； position[1]+=2 ； position[2]++ ； position[3]++ ； position[4]-=2 ； 重 position[5]-- ； 復(fù) 執(zhí) 行 position[0]++ ； position[1]-=2 ； position[2]-- ； While （ 1） position[4]+=2 ； position[5]++ ； if((i%2)==0) position[5]++ ； if((i%3)==0) position[5]++ ； position[0]-- ； position[1]+=2 ； position[2]++ ； position[1]-- ； position[4]++ ；  position[1]-- ； position[4]++ ； position[3]++ ； position[4]-=2 ； position[5]-- ； position[2]-=7 ；