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