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

《雙足步行機(jī)器人畢業(yè)論文doc版.docx》由會(huì)員分享，可在線閱讀，更多相關(guān)《雙足步行機(jī)器人畢業(yè)論文doc版.docx（31頁珍藏版）》請(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)I31.雙足步行機(jī)器人畢業(yè)論文摘要機(jī)器人技術(shù)代表了機(jī)電一體化的最高成就，是二十世紀(jì)人類最偉大的成果之 一，其中雙足步行機(jī)器人因其體積相對(duì)較小，對(duì)非結(jié)構(gòu)性環(huán)境具有較好的適應(yīng)性， 避障能力強(qiáng)，移動(dòng)盲區(qū)很小等優(yōu)良的品質(zhì)，越來越受到人們的關(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)控制，通過認(rèn)真的研究人類行走方式以及翻跟斗的動(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ì)的可行性和合理性，通過反復(fù)的修改和驗(yàn)證 使得機(jī)器人能順利的完成比賽任務(wù)。關(guān)鍵詞 ：雙足步行機(jī)器人步態(tài)規(guī)劃PWM 控制II雙足步行機(jī)器人畢業(yè)論文ABSTRACTRobotic 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 robotGait planningPWM controlIII雙足步行機(jī)器人畢業(yè)論文目錄摘要 .I.I.ABSTRACTIII目錄IV1緒論11.1 引言11.2 雙足機(jī)器人的研究概況11.2.2 國(guó)內(nèi)研究概況41.3 雙足步行機(jī)器人的步行特點(diǎn)及研究意義51.4 本文研究?jī)?nèi)容及主要工作61.5 試驗(yàn)樣機(jī)的介紹62 舵機(jī)聯(lián)動(dòng)單周期指令算法研究82.1 舵機(jī) PWM信號(hào)介紹82 2 單舵機(jī)拖動(dòng)及調(diào)速算法82.3 算法分析92.46 路 PWM信號(hào)發(fā)生算法解析103 交叉足機(jī)器人行走步態(tài)設(shè)計(jì)123.1 步態(tài)規(guī)劃基本原則123.2 步態(tài)設(shè)計(jì)123.21 前三步步態(tài)設(shè)計(jì)133.22 翻跟頭步態(tài)設(shè)計(jì)173.2.3 連續(xù)前進(jìn)步態(tài)設(shè)計(jì)193.2.4 主程序流程圖：213.2.5 PWM_ 6 流程圖224 實(shí)驗(yàn)驗(yàn)證及結(jié)果分析234.1 實(shí)驗(yàn)調(diào)試過程23IV雙足步行機(jī)器人畢業(yè)論文4.2 實(shí)驗(yàn)演示245 實(shí)驗(yàn)結(jié)論與總結(jié)28參考文獻(xiàn)29致謝30附錄31V雙足步行機(jī)器人畢業(yè)論文1緒論1.1引言近代機(jī)器人學(xué)是最近幾十年新發(fā)展起來的一門綜合性的學(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ì)人類最偉大的成果之一，也是一個(gè)國(guó) 家制造業(yè)水平和綜合實(shí)力的象征。1.2雙足機(jī)器人的研究概況隨著國(guó)內(nèi)外學(xué)者紛紛投入到該領(lǐng)域的研究，機(jī)器人逐漸進(jìn)入到工業(yè)生產(chǎn)和人 類的生活 1 。根據(jù)機(jī)器人的發(fā)展進(jìn)程，通?？煞譃橐韵氯旱谝淮鷻C(jī)器人，主要指只能以“示教-再現(xiàn)”方式工作的機(jī)器人，其只能依靠 人們給定的程序，重復(fù)進(jìn)行各種操作。第二代機(jī)器人是具有一定傳感器反饋功能的機(jī)器人，其能獲取作業(yè)環(huán)境、操 作對(duì)象的簡(jiǎn)單信息，通過計(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ī)器人”研究室，曾開發(fā)出不少擬人機(jī)器人系統(tǒng)2 。例如會(huì)演奏鋼琴的機(jī)器人、雙足步行機(jī)器 人以及電動(dòng)假肢等。該研究室的帶頭人高西淳夫教授說：“人格化機(jī)器人的一個(gè)很 大特征就是它具有與人類相近的結(jié)構(gòu)，機(jī)器人與人類的共存是我們研究開發(fā)的課 題之一”。1雙足步行機(jī)器人畢業(yè)論文當(dāng)今世界，有“機(jī)器人王國(guó)”之稱的日本在雙足步行機(jī)器人研究領(lǐng)域處于絕 對(duì)領(lǐng)先地位，具有代表性的研究機(jī)構(gòu)有加藤實(shí)驗(yàn)室、日本早稻田大學(xué)、日本東京 大學(xué)、日本東京理工學(xué)院、日本機(jī)械學(xué)院、松下電工、本田公司和索尼公司等3 。日本早稻田大學(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 雙足步行機(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ì)步行方式的程序控制方法，通過對(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ī)器人 36 ，增加 了跺關(guān)節(jié)力矩控制，將一個(gè)步行周期分為單腳支撐期和轉(zhuǎn)換期。1986 年，又成功 研制了 WL-12(R) 雙足機(jī)器人，該機(jī)器人通過軀體運(yùn)動(dòng)來補(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)的角度和角速度 )、重力傳感器、六維力 /力矩傳感器和視覺傳感器等，利用 這些傳感器感受機(jī)器人的當(dāng)前狀態(tài)和外界環(huán)境的變化，并基于這些傳感器對(duì)下肢 各關(guān)節(jié)的運(yùn)動(dòng)作出調(diào)整，實(shí)現(xiàn)動(dòng)態(tài)步行。72000 年 11 月日本本田公司又推出了新型雙足步行機(jī)器人ASIMO （圖 1-1）， ASIMO 擁有 34 個(gè)自由度，是目前最先進(jìn)的雙足機(jī)器人。ASIMO 身高 1.2 米， 體重 52 公斤。它的行走速度是0-6km/h，行走平穩(wěn)，增加了語音識(shí)別功能，具有 聽說看的能力，可實(shí)時(shí)識(shí)別人的姿態(tài)與運(yùn)動(dòng)，并進(jìn)行交互。由于采用了新開發(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ī)器人選手參加的世界杯又向人類走近了一步。該大 賽的目標(biāo)是“在 2050 年之前，制造出能夠戰(zhàn)勝當(dāng)時(shí)世界冠軍隊(duì)的自律型機(jī)器人隊(duì)2雙足步行機(jī)器人畢業(yè)論文伍”，這一夢(mèng)想將由雙足步行機(jī)器人來實(shí)現(xiàn)8 。2005 年 1 月 12 日，由日本產(chǎn)業(yè)技術(shù)綜合研究所的比留川博等人開發(fā)出一臺(tái)取 名“HRP-2”擬人機(jī)器人亮相東京（見圖1-2）。該機(jī)器人身高 154cm，體重 58kg。 研究人員先請(qǐng)民間藝術(shù)家跳舞，用特殊攝像機(jī)拍攝后將畫面輸入電腦，并對(duì)手、 腳、頭、腰等 32 個(gè)部位的動(dòng)作進(jìn)行解析，然后把有關(guān)解析數(shù)據(jù)輸入給機(jī)器人，最 后利用這些數(shù)據(jù)來控制機(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)真正類人的雙足步行機(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 ，即在無任何外界輸入的情況下， 靠重力和慣性力實(shí)現(xiàn)步行運(yùn)動(dòng)。 1989 年，他建立了平面型的雙足步行機(jī)構(gòu)，兩腿為直桿機(jī)構(gòu)，沒有膝關(guān)節(jié)，每條 腿上各有一個(gè)小電機(jī)來控制腿的伸縮，無任何主動(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 年代開始雙足步行機(jī)器人領(lǐng)域的研究和應(yīng)用的。1986 年，我國(guó)開展了“七五”機(jī)器人攻關(guān)計(jì) 劃，1987 年，我國(guó)的“ 863”高技術(shù)計(jì)劃將機(jī)器人方面的研究開發(fā)列入其中。目前 我國(guó)從事機(jī)器人研究與應(yīng)用開發(fā)的單位主要是高校和有關(guān)科研院所等。最初我國(guó) 進(jìn)行機(jī)器人技術(shù)研究的主要目的是跟蹤國(guó)際先進(jìn)的機(jī)器人技術(shù)，隨后取得了一定 的成就。自 1985 年以來，相繼有幾所高校進(jìn)行了這方面的研究并取得了一定的成 果，其中以哈爾濱工業(yè)大學(xué)和國(guó)防科技大學(xué)較為成果顯著。在自然科學(xué)基金和國(guó)家”863”計(jì)劃的支持下，哈爾濱工業(yè)大學(xué)自1985 年開始研制雙足步行機(jī)器人11， 迄今為止己經(jīng)完成三個(gè)型號(hào)的研制工作。1988 年哈工大 HIT-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)彎、上下臺(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)無纜連續(xù)穩(wěn)定的平地行走、連續(xù)上下臺(tái)論階 行走，以及端水、 太極拳和點(diǎn)頭等動(dòng)作。 其平地行走速度為4.2 米/分，步距為 0.35米，跨越臺(tái)階高度75 毫米，跨越速度20 秒/步。國(guó)防科技大學(xué)從198895 年，先后研制成功平面型六自由度雙足機(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)類人型雙足步行機(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ó)家“863” 項(xiàng)目組的驗(yàn)收。這個(gè)機(jī)器人身高 1.58m，體重 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)定行走和太極拳表演，使中國(guó)成為繼日本之后，第 二個(gè)研制出無外接電纜行走，集感知、控制、驅(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ī)器來代替人 的繁重工作，從而發(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)的問題己經(jīng)成為研究熱點(diǎn)。擬人機(jī)器人的 研制工作開始于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ī)器人過分依賴于 周圍環(huán)境，應(yīng)用范圍受限。爬行和蠕動(dòng)式機(jī)器人主要用于管道作業(yè)，具有良好的 靜動(dòng)態(tài)穩(wěn)定性，但速度較低14 。常見的步行機(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)，就可以通過機(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ī)器人的能耗通常低于輪式和履帶式。步行是人 類的一種基本活動(dòng)能力，雙足步行技術(shù)的發(fā)展會(huì)促進(jìn)動(dòng)力型假肢的研制，將有可 能解決截癱病人和小兒麻痹癥患者的行走問題，為康復(fù)醫(yī)學(xué)做出貢獻(xiàn)。對(duì)機(jī)器人 雙足動(dòng)態(tài)行走機(jī)理的深入研究也使我們更深刻地理解人類活動(dòng)的內(nèi)在本質(zhì)，有助 于生物醫(yī)學(xué)工程和體育運(yùn)動(dòng)科學(xué)的發(fā)展。而雙足步行機(jī)器人與傳統(tǒng)的輪式機(jī)器人 相比，最具有挑戰(zhà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ó)各地尤其是部分高校舉辦了各種類 型的機(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ī)器人為主，還沒有出現(xiàn)步行機(jī)器人參賽，由此可見，雙足步行機(jī)器 人的發(fā)展還有一段很長(zhǎng)的路要走。研制雙足步行機(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)。本文的主要任務(wù)就是在大量研讀資料后，認(rèn)真的研究人類行走過程，并通過 的適當(dāng)?shù)恼{(diào)整，完成交叉足競(jìng)步機(jī)器人行走程序的設(shè)計(jì)，完成設(shè)計(jì)后將設(shè)計(jì)好的 程序下載都到實(shí)驗(yàn)樣機(jī)中，驗(yàn)證設(shè)計(jì)程序的可行性和合理性，通過反復(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)的控制板 (見圖 1-3), 該控制 板采用 STC12C5412AD 單片機(jī) ,設(shè)計(jì)合理，擴(kuò)展了 STC12C5412AD 系列單片機(jī)的 所有外接端口 ,具有很好的操作性 .。2、樣機(jī)共有六個(gè) SH14-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)，是有“電子自鎖” 功能。3、該款樣機(jī)全身的機(jī)械結(jié)構(gòu)均采用金屬結(jié)構(gòu)（見圖 1-5），有較強(qiáng)的機(jī)械強(qiáng)度， 樣機(jī)的身高 280mm，肩寬 165mm，胸厚 140mm，質(zhì)量 0.9kg。6雙足步行機(jī)器人畢業(yè)論文圖 - STC12C5412AD 控制板圖 1-4SH14-M-C 舵機(jī)圖 1-5 SHR-TLA機(jī)器人4、機(jī)器人各舵機(jī)與控制口的定義程序中命名定義接口平面命名電路板接口舵機(jī)分布圖position0 P1.0x1舵機(jī)J12position1 P1.1x2舵機(jī)J11position2 P1.2x3舵機(jī)J10position3 P1.3x4舵機(jī)J8position4 P1.4x5舵機(jī)J7position5 P1.5x6舵機(jī)J5圖 1-6 舵機(jī)分布圖7雙足步行機(jī)器人畢業(yè)論文2舵機(jī)聯(lián)動(dòng)單周期指令算法研究2.1舵機(jī) PWM信號(hào)介紹PWM 是 Pulse Width Modulation 縮寫， 中文意思就是脈沖寬度調(diào)制，簡(jiǎn)稱脈 寬調(diào)制。它是利用微處理器的數(shù)字輸出來對(duì)模擬電路進(jìn)行控制的一種非常有效的 技術(shù)，其特點(diǎn)在于他的上升沿與下降沿之間的時(shí)間寬度。我們目前使用的舵機(jī)主 要依賴于模型行業(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)過舵機(jī) 極限參數(shù)實(shí)驗(yàn)，得到應(yīng)該將其劃分為250 份。那么 0.5mS2.5ms 的脈沖寬度為 2mS 即 2000uS，2000uS250=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ì)算說明：舵機(jī)角度= 0.74N；PWM高電平的時(shí)間為：500us + N 8us 或者舵機(jī)角度 /8us+500us； 部分角度對(duì)應(yīng)的N 值和 PWM 值如下：角度04590135185N062125187250PWM0.5ms1ms1.5ms2ms2.5ms表2-1舵機(jī)要求 PWM格式上升沿最少為0.5mS，為 0.5mS-2.5mS 之間；下降沿時(shí)間沒 要求，目前采用0.5mS 就行；也就是說PWM波形可以是一個(gè)周期1mS 的標(biāo)準(zhǔn)8雙足步行機(jī)器人畢業(yè)論文方波，具體格式說明圖例如下圖：0.5msN 0.8usPWM0.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 的脈沖周期，開始執(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)榈停瑫r(shí)n+，循環(huán)上述過程，直到 n5，這時(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è)：其一，是為了將來擴(kuò)充至24 舵機(jī)； 其二，目標(biāo)越快，舵機(jī)的轉(zhuǎn)動(dòng)速度越快；我們以 P0 口得 6 路為 1 組或稱 1 個(gè)單位，連續(xù)發(fā)出目標(biāo)位置，形成連續(xù)的目標(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.0P0.5 為一個(gè)基本單位， 6 位一并。具體如下： P0 口的 6 個(gè)位置各不相同：9雙足步行機(jī)器人畢業(yè)論文（us）P0.0position000500P0.1position10.741508P0.2position27.410580P0.3position33750900P0.4position4741001300P0.5position51111501700端口N 寄存器目標(biāo)位置（度） N 數(shù)值（整數(shù)）PWM寬度表 2-22.46路 PWM信號(hào)發(fā)生算法解析定義數(shù)組： ass6；例如：logic6 ；ass01234512060892012201logic0123450xFE0xFD0xFB0xF70xEF0xDF ass6內(nèi)為 P0 口的 6 路 N數(shù)值，這些數(shù)值是根據(jù)舵機(jī)狀態(tài)定的， 沒有規(guī)律。logic8 內(nèi)為固定的一組邏輯參數(shù)。將數(shù)組 ass 內(nèi)的數(shù)據(jù)由大到小排列，logic 內(nèi)的數(shù)據(jù)也數(shù)之變化，變成：ass01234520112089602012logic5432100xDF0xFE0xFB0xFD0xF70xEF將 N值做減法，求得：ass0=ass0-ass1=81ass1=ass1-ass2=31ass2=ass2-ass3=29ass3=ass3-ass4=40ass4=ass4-ass5=8 ass5=ass5 =12我們將每 6 路輸出的高電平時(shí)間限制在一個(gè)2.5ms 的中斷內(nèi)，開啟中斷。將全部的 6 路輸出置為高電平，并延時(shí)500us 作為目標(biāo)位置為0 的基礎(chǔ)。10雙足步行機(jī)器人畢業(yè)論文循環(huán) 6 次,每次延時(shí) ass 內(nèi)的值個(gè) 8us,再將 P0 口“與”相應(yīng)的邏輯參數(shù) .例如：順序ass51296us0xEF（ 0B10111111）第四位置“0”4ass4864us0XF7（ 0B11111101）第三位置“0”3ass340320us0xFD（ 0B11111011）第一位置“0”1ass229232us0xFB（ 0B01111111）第二位置“0”2ass131248us0xFE（ 0B11111110）第零位置“0”0ass081648us0xDF（ 0B11011111）第五位置“0”5N 差值延時(shí)時(shí)間（N 差值 8us）對(duì)應(yīng) “與”的值相應(yīng)輸出 0 的位相繼變成 低電平的11雙足步行機(jī)器人畢業(yè)論文3交叉足機(jī)器人行走步態(tài)設(shè)計(jì)人形機(jī)器人具有廣闊的應(yīng)用前景,其研制工作得到了各國(guó)的重視,近年來已取 得巨大的進(jìn)展 ,但仍存在大量的理論和技術(shù)問題有待深入研究15 。如何規(guī)劃?rùn)C(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ù)。要實(shí)現(xiàn)和提高機(jī)器人的行走性能，必須研究實(shí)用而有效的步態(tài)規(guī)劃 方法，實(shí)現(xiàn)機(jī)器人的穩(wěn)定步行16。人類在研究人體結(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)。比如，我們?cè)谛凶叩臅r(shí)候會(huì)移 動(dòng)我們的重心，并且前后擺動(dòng)雙手來平衡我們的身體。這些構(gòu)成了人形機(jī)器人行 走的基礎(chǔ)方式，人形機(jī)器人和人類一樣，有髖關(guān)節(jié)，膝關(guān)節(jié)和足關(guān)節(jié)。機(jī)器人中 的關(guān)節(jié)一般用 “自由度 ”來表示。一個(gè)自由度表示一個(gè)運(yùn)動(dòng)可以或者向上，或者向下， 或者向右，或者向左。分散在身體的不同部位，所以骨骼結(jié)構(gòu)因此而生。3.1步態(tài)規(guī)劃基本原則對(duì)雙足步行機(jī)器人而言，理論上可供選擇的步態(tài)有無數(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)符合人類的行走習(xí)慣，并使控制盡可能簡(jiǎn)單。人類行走步態(tài)是幾千年演化的結(jié)果，是自然界中最合理的行走方式，符合人類的行走 習(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ī)器 人通過步行的方式從起點(diǎn)線走到終點(diǎn)線（相距200cm，限寬 60cm）。競(jìng)賽開始時(shí)先 走出 3 步距離、立正、然后臥下、向前翻跟斗3 次，再起立、向前走出3 步距離、12雙足步行機(jī)器人畢業(yè)論文21立正、然后臥下（身體向后） 、再向后翻跟斗3 次、再起立、然后以輕快步履走向 終點(diǎn)，參賽機(jī)器人要在4 分鐘以內(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ì)近年來 , 隨著雙足機(jī)器人研究的興起， 人類行走步態(tài)的特征成了仿生機(jī)械學(xué)家 研究雙足機(jī)器人的一個(gè)重要依據(jù)。體育研究者和人體運(yùn)動(dòng)信息研究專家對(duì)人體的 運(yùn)動(dòng)做了大量的研究工作。他們讓實(shí)驗(yàn)者穿上緊身衣，并在踝、膝、髖、肩、肘 等關(guān)鍵關(guān)節(jié)貼上亮片標(biāo)志以便于識(shí)別，在實(shí)驗(yàn)者行走過程中，利用高速攝像機(jī)對(duì) 試驗(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ù)。圖 3-1人類行走步態(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ù)原性，人類通過交替地以一條腿作為支13雙足步行機(jī)器人畢業(yè)論文撐,向前擺動(dòng)另一條腿 , 并伴以軀干和手臂的 運(yùn)動(dòng)來實(shí)現(xiàn)靈活的步 行運(yùn)動(dòng) ,其過程和機(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ī)劃。 因此,在分析和模擬人類的步行運(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è)階段開始于前腳的后跟接觸地面,結(jié)束于后腳的腳尖離開 地面。單腿支撐階段一條腿支撐身體,另外一條腿完成步行前移。在單腿支撐階段, 一只腳固定在地面上而另一只腳從后往前擺動(dòng),步行時(shí) ,機(jī)器人交替地進(jìn)入雙腿支 撐階段和單腿支撐階段。機(jī)器人行走過程步態(tài)解析如下：初始位置：雙腿直立。 動(dòng)作流程：雙腿下蹲抬一腿，直立邁一腿，下蹲循環(huán)（ N 步） 邁一腿，下蹲抬一腿，直立根據(jù)人類行走姿態(tài)，經(jīng)過簡(jiǎn)化修改設(shè)計(jì)出符合機(jī)器人行走的步態(tài)，設(shè)計(jì)流程圖 如下：1、前三步步態(tài)設(shè)計(jì)過程圖啟動(dòng)步態(tài)雙腳站降低立狀態(tài)重心重心擺 到左腿右腿向前 邁出半步重心擺到 兩腿中間重心右腿向重 心重心左腿重心行走步態(tài)擺到前邁一擺 到擺到向前擺到兩腿步左腿兩腿邁出右腿重心停止步態(tài)擺到 右腿左 腿 向 前 邁 出 半步重 心 擺 到 兩 腿 中間重心雙腳升高站立圖 3-2 前三步步態(tài)設(shè)計(jì)過程圖14雙足步行機(jī)器人畢業(yè)論文2、前三步步態(tài)設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖 按照上一節(jié)的設(shè)計(jì)思路，將人類的行走的步態(tài)進(jìn)一步簡(jiǎn)化，畫出機(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)position0- ； position1+=2 ； position2+ ； position3+ ； position4-=2 ； position5- ；position0+ ； position1-=2； position2- ；position4+=2 ；position5+ ；if(i%2)=0)position5+ ；if(i%3)=0)position5+ ；position0- ； position1+=2 ； position2+ ；position1-；position4+；position1+； position3-； position4- ； position5- ；position4+=2 ； position5+ ； if(i%2)=0)position5+ ；if(i%3)=0)position4-； position0+； position1+ ； position2+ ；position1-；position4+ ；position3+ ； position4-=2 ； position5- ；position2-=7 ； 微調(diào)position1-=2 ； position2- ； if(i%2)=0)position2- ；if(i%4)=0)position2- ；position5+=5 ；position0- ； position1+=2 ； position2+ ；position1- ；position4+ ；position1+； position3-； position4- ； position5- ；position0+ ； position1-=2 ； position2- ；結(jié)束注：程序見附錄16雙足步行機(jī)器人畢業(yè)論文3.2 2翻跟頭步態(tài)設(shè)計(jì)機(jī)器人大賽中要求機(jī)器人有翻跟頭的動(dòng)作，為了滿足比賽要求，作者搜集了 人類翻跟頭的資料（見下圖） ，人類翻跟斗時(shí)動(dòng)作的連貫性和柔韌性是機(jī)器人無法 比擬的，所以在在動(dòng)作的設(shè)計(jì)上做了大量的改動(dòng)。一、翻跟頭步態(tài)設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖 翻跟頭的設(shè)計(jì)和前邊的前三步設(shè)計(jì)思路和方法是一樣的，根據(jù)人類翻跟頭的相關(guān) 資料，畫出機(jī)器人簡(jiǎn)化結(jié)構(gòu)模型，并根據(jù)動(dòng)作姿態(tài)確定個(gè)舵機(jī)的旋轉(zhuǎn)角度。人類 各個(gè)關(guān)節(jié)部位經(jīng)過幾千年的演化，其連續(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)的程序流程 圖，如下所示：開始position1-81 度position2-41 度position481度position541 度position0-80 度position380 度position248 度position5-48 度position080 度position3-80 度position1163度position4-163 度調(diào)用結(jié)束position2-15 度position515 度position1-81度position2-41度position481度position541 度position0-80 度position380 度position248度position5-48 度position080 度position3-80 度注：程序見附錄18雙足步行機(jī)器人畢業(yè)論文3.2.3連續(xù)前進(jìn)步態(tài)設(shè)計(jì)連續(xù)行走步態(tài)設(shè)計(jì)，和前邊的前三步的設(shè)計(jì)方法是一樣的，只是在連續(xù)行走 的設(shè)計(jì)中沒有停止步態(tài)，其余步態(tài)只是前三步的連續(xù)循環(huán)調(diào)用。故不在做重復(fù)說 明。1、 連續(xù)前進(jìn)步態(tài)設(shè)計(jì)結(jié)構(gòu)簡(jiǎn)圖啟 動(dòng) 步 態(tài)正視圖邁 出 右 腿邁 出 左 腿說明： 連續(xù)行走過程中左右腿交叉前進(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)position0- ； position1+=2 ； position2+ ； position3+ ；position4-=2 ；重position5- ；復(fù)執(zhí) 行position0+ ； position1-=2； position2- ；While （ 1） position4+=2 ；position5+ ；if(i%2)=0)position5+ ；if(i%3)=0)position5+ ；position0- ； position1+=2 ； position2+ ；position1-；position4+；position1-；position4+ ；position3+ ； position4-=2 ； position5- ；position2-=7 ；