機械創(chuàng)新設計課程設計模板

機械創(chuàng)新設計課程設計資料內(nèi)容僅供參考，如有不當或者侵權，請聯(lián)系本人改正或者刪除。機械創(chuàng)新設計課程設計-第2學期題目:仿人二足步行機器人爬樓梯行走機構設計小組成員:班級:指導教師:成績:日期:年6月目錄摘要 第一章 緒論 11.1. 前言 11.2. 二足仿生機器人的概念 11.3課題來源 21.4設計目的 21.5技術要求 21.6設計意義 31.7設計范圍 41.8國內(nèi)外的發(fā)展狀況和存在的問題 41.8.1.國外發(fā)展狀況 41.8.2.國內(nèi)發(fā)展狀況 81.8.3.存在的問題 101.9.具體設計 101.9.1.設計指導思想 101.9.2.應解決的主要問題 101.9.3.本設計采用的研究計算方法 101.9.4.技術路線 10第二章 仿人二足步行機器人爬樓梯行走機構步態(tài)規(guī)劃 122.1引言 122.2仿人二足步行機器人爬樓梯行走機構的步行概念 122.3步行過程設定 132.4雙足機器人步態(tài)穩(wěn)定性分析 152.4.1步行穩(wěn)定性判據(jù) 152.4.2零力矩點定義 162.4.3穩(wěn)定步態(tài)的條件 172.4.4小結 182.5雙足機器人步態(tài)規(guī)劃 192.5.1引言 192.5.2雙足機器人步行過程分析 192.5.3髖關節(jié)規(guī)劃 202.5.4髖關節(jié)軌跡對ZMP的影響 21第三章 二足機器人的機構分析 233.1四連桿機構的設計 233.1.1設計參數(shù) 233.2二足機器人主體設計 243.2.1腿部的設計 243.2.2大腿 253.2.3小腿 253.2.4腳 263.2.5其他輔助連桿 26第四章 總結 274.1.設計小結 274.2設計感受 274.3課程設計見解 27參考文獻 28謝辭 30摘要人類社會的發(fā)展,各種各樣的機器人正漸漸的走進我們的視野,有很多的地方都用到了機器人,在機器人的領域里越來越多的人開始愛好上了機器人。能更好的適應環(huán)境和地形是仿生機器人的優(yōu)點,很多人的工作能夠由機器人代替完成,科學價值和實際應用價值是很重要的。類人機器人一直是機器人領域的研究熱點,是當前科技發(fā)展最活躍的領域之一。它匯集了機械、電子、通訊、自動控制、仿生等諸多學科最新的研究成果,代表了機電一體化的最高成就,反映了一個國家智能化和自動化研究的水平。雙足行走是類人機器人最基本也是最難實現(xiàn)的功能,因而以實現(xiàn)雙足步行為目標的兩足步行機器人研究是智能型類人機器人研究的基礎。本文以實現(xiàn)仿人二足步行機器人爬樓梯行走機構為研究目標,對實現(xiàn)此功能的相關技術展開了研究。主要分析了人類行走動作,在自由度配置、步態(tài)規(guī)劃以及穩(wěn)定性分析的基礎上對仿人二足步行機器人爬樓梯行走機構進行了設計。關鍵詞:仿人二足爬樓梯行走機構,步態(tài)規(guī)劃,機構設計,四桿機構,CATIA

緒論前言步行機器人已經(jīng)被廣泛應用于各個領域,且二足機器人的動作近似人類,更能于現(xiàn)今的工作環(huán)境相配合。一般二足機器人可步行于高危險性的工作環(huán)境,跨越障礙物,上下樓梯,能補足人類體能的限制,可用于探測、救災、搬運、服務等行業(yè),或代替肢體殘障者的雙腳等。此兼具高靈活性及工作穩(wěn)定的兩大特點,在有危險及枯燥頻繁的任務環(huán)境中扮演不可或缺的角色。此次主要研究目標是二足機器人爬樓梯機構的設計,以及對它的步態(tài)的規(guī)劃。二足仿生機器人的概念現(xiàn)階段,機器人的研究應用領域不斷拓寬,其中仿人機器人的研究和應用受到普遍的關機器人的研究應用領域不斷拓寬,其中仿人機器人的研究和應用受到普遍的關注,并成為智能機器人領域中最活躍的研究熱點之一。仿人二足機器人爬樓梯的設計變營運而生。研究與人類外觀特征類似,具有人類智能,靈活性,并能夠與人交流,不斷適應環(huán)境的仿人機器人一直是人類的夢想之一。仿人機器人的研究在很多方面已經(jīng)取得了突破,如關鍵的機械單元,基本行走能力,整體運動,動態(tài)視覺等,可是離我們理想中的要求還相去甚遠,還需要在更為具體的某些行動進行研究,仿人二足機器人爬樓梯設計獎機器人的行動具體到爬樓梯動作上,,能夠更加適合人類的生活和工作環(huán)境,代替人類完成各種作業(yè),能夠在很多方面拓展人類的能力,如圖所示圖1.1仿生二足機器人1.3課題來源本課題來源于機械創(chuàng)新設計課程的研究課題。之前我們學習了有關機械原理的基本概念,基本理論,以及相關的計算方法,老師帶領我們深入淺出的學習了機械方面的知識,使我們了解包括機構結構分析,運動分析,力分析以及動力學分析,對于常見的機構,例如,連桿機構,凸輪機構,齒輪機構的等也有了深入的認知。在王老師開設的機械創(chuàng)新設計課程上我們選擇了這個課題,來將學習到的知識付諸于實踐。1.4設計目的本設計主要是利用機械原理相關知識合理設計機械腿的相關尺寸及機構來實現(xiàn)爬樓梯的功能。1.5技術要求1.電機的選擇和控制原理;2.運動學的分析和仿真;3.連桿機構,傳動機構的設計;4.穩(wěn)定性,重心轉(zhuǎn)移。1.6設計意義雙足機器人是一種非常典型的仿人機器人,國外早在60年代末就開始了雙足機器人的研究開發(fā)。1968年,美國通用公司試制了一臺名為”Rig”的操縱型雙足機器人,揭開了雙足機器人研究的序幕。隨著雙足機器人在各個領域的應用日趨廣泛,各個國家在該領域相繼投入巨資開展研究。自20世紀90年代開始,雙足機器人的研究已從模仿人類腿部行走發(fā)展到全方位擬人階段,相繼誕生了P3,ASIMO等機器人。步行是人類最基本的行為方式,雙足機器人具備人類的基本結構,具有類人的步行能力。雙足步行機器人在外形上具有人類特征,適合用于人類生活的環(huán)境,為人們提供方便,因此具有廣闊的市場前景。雙足機器人與其它多足機器人相比具有體積較小、重量輕、動作靈活、迅速,而且更接近于人類步行的特點,因此它們對環(huán)境有最好的適應性,在日常生活中更具有廣泛的應用前景。步行運動是雙足機器人實現(xiàn)基本類人動作的關鍵,能夠為仿人機器人的機構設計、優(yōu)化提供理論指導和技術支持。對雙足機器人步態(tài)規(guī)劃進行研究,規(guī)劃合理的步態(tài)并控制機器人穩(wěn)定的跟蹤步態(tài)實現(xiàn)穩(wěn)定的步行運動成為雙足機器人技術研究的重點。穩(wěn)定的步態(tài)是雙足機器人實現(xiàn)行走功能的基礎．有了穩(wěn)定的步態(tài)才能顯現(xiàn)它的靈活性和更強的適應能力,也才能使機器人其它的很多功能得以實現(xiàn)。另外,技術發(fā)展的角度看,步態(tài)規(guī)劃研究會對傳統(tǒng)的機械機構、傳動方式和控制方法產(chǎn)生一定影響,從而促進仿生學及其它領域的相關研究與應用,能夠更多的了解和掌握人類的步行特征,并為人類的服務,如人造假肢。1.7設計范圍一直以來移動型機器人的運動方式大致上包括,輪式,履帶式,足式等。履帶式爬樓梯的裝置原理類似于履帶裝甲運兵車,原理較為簡單,技術也比較成熟,而且傳動效率比較高,行走重心波動很小,運動平穩(wěn)?？墒沁@類裝置重量大,運動不夠靈活,爬樓梯時在樓梯邊緣會造成巨大的壓力,對樓梯有一定的損壞,轉(zhuǎn)彎不方便等問題,有很大的限制。輪組式,輪組式爬樓梯裝置按輪組中使用小輪的個數(shù)可分為兩輪式,三輪式,以及四輪式。單輪組式結構穩(wěn)定性較差,在爬樓梯中需要有人協(xié)助才能實現(xiàn)。而雙輪組式雖然能實現(xiàn)自主爬樓,但由于其體積龐大且偏重,影響了她的適用范圍。步行式,其爬樓梯的執(zhí)行機構由鉸鏈桿件機構組成。上樓梯時,先將負重抬高,在向前移動,如此重復這過程。步行式爬樓梯裝置模仿人類爬樓的動作,符合本組研究課題,因此采用這個方案。步行式爬樓梯裝置爬樓梯時運動平穩(wěn),適合不同尺寸的樓梯,較為便捷?？墒撬龑Σ僮鞯囊蠛芨?設計研究很復雜,運動幅度不大,動作緩慢。1.8國內(nèi)外的發(fā)展狀況和存在的問題1.8.1.國外發(fā)展狀況從上世紀60年代開始。各國學者對兩足步行機器人從理論和實踐上進行了較長時間的研究工作,在理論研究上得豐碩的成果。1973年,日本加麟一郎從工程角度研制出世界上第一臺真正意義上的仿人形機器人WABOT-1,可用日語與人交流,實現(xiàn)靜態(tài)行走,可依據(jù)命令移動身體去抓取物體。1986年．美籍華人郯元芳博士研制了美國第一臺真正意義上的類人雙足步行機器人SO-2,實現(xiàn)平地前進和左右側行;1987年該機器人實現(xiàn)動態(tài)步行,在1990年,SD-2能走斜坡。圖1.8.1HONDA機器人P1,P2,P3經(jīng)過研究．日本HONDA公司于1996年12月成功研制出第一臺取足步行機器凡P1,之后相繼推出p2、p3,希望機器人”能與人共存、同人協(xié)作,不受用途限制,并能完成一些人所不能完成的任務”,如圖LI。P-2是世界上首臺無纜自主式兩足機器人。P-2型機器人經(jīng)過陀螺儀、加速度傳感器及六個腳底壓力倍感器把地面的信息傳給機器的控制單元進行判斷,進而平衡身體。P-2的出現(xiàn)標志著一個嶄新的兩足機器時代的到來。i1月12日HONDA公司開發(fā)出代表當今雙足步行機器人最高研究水平的ASIMO(AdvancedStepinInnovativeMobility),如圖1.8.2,高120厘米．重52千克,菇34個自由度,采用Honda自行開發(fā)的處理器、Vxwocks操作系統(tǒng)．驅(qū)動元件采用伺服電機Harmonic減速器、鐐氫電池作為動力源,行走速度O到1.6千米／小時,步距可調(diào)．并采用先進的I—WALK技術和預測移動控制技術,實時預測下一個移動動作并提前改變重心,可完成8宇行走和上下臺階動作。圖1.8.2ASIMO機器人12月9日．日本川田工業(yè)和產(chǎn)業(yè)技術綜合研究所、安川電機以及清水建設公布了能夠在建筑工埴等與工人共同作業(yè)的類人型機器HRP-2。HRP-2的外形尺寸為高154cm．質(zhì)量為58KG,與真人相仿。全身共有32個自由度,具體為6×2(腿部)+6×2(手臂)+2(腰部)+2(頭部)+2×2(手指)=32,能夠很均衡地雙足步行。HRP-2手臂有6個自由度(肩3,肘1,腕2),工作能力根強,機器人能夠與工人一起用”手”抓起建筑材料進行搬運。腰部有2個自由度．俯仰自由度是專門為俯身工作設置的。大腿固定在臂部兩側外伸的懸臂上,從而腿部的靈活性增加．能夠做出走”一字步”和兩腿交錯行走等步行動作。HRP-2不論仰臥還是俯臥倒地后都能夠自行站起,能夠在地面爬行進入較小的工作空間,還能夠做敲鼓、跳舞等表演。研究人員先請民間藝術家跳舞,用特殊攝像機拍攝后將畫面輸入電腦,井對手、腳、頭、腰等32個部位的動作進行解析,再把解析數(shù)據(jù)輸給HRP-2,最后利用這些數(shù)據(jù)來控制HRP-2的手腳等關節(jié)動作,從而使得HRP-2能夠和人一樣動作連貫地翩翩起舞。圖1.8.3HRP-2機器人9月．日本Sony公司推出SDR-4X是當前最先進的小型兩足機器人。SDR-4X身高0.5m,體重5kg,具有38個自由度,能夠以0.9km／h的速度行走,并能在行走中轉(zhuǎn)身。該機器人可根據(jù)家中環(huán)境的變化調(diào)節(jié)自身行為．不但能夠識路辨人、存儲信息,還可跳舞、唱歌,與人類進行更豐富的交流。與該公司底發(fā)布的SDR-3X機器人相比,SDR-4X的運動和反應功能有了極大改進。由于安裝了多種傳感系統(tǒng)、行為控制軟件以及靈活的機械行走裝置,牽引其每個關節(jié)的小型執(zhí)行器的功能均得到改進。新型的綜合適應控制系統(tǒng)能夠經(jīng)過各路傳感器采集到的信息,對機器人身上的38個關節(jié)進行實時控制,使其在坎坷路面上行走自如。經(jīng)過姿勢平衡系統(tǒng)抵御外界壓迫,能根據(jù)環(huán)境變化調(diào)整運動步伐。如前行或拐彎,它的雙手各有5只靈活的手指,靈活的關節(jié)控制還可使其在自身跌倒時將損害降低到最低程度。另外,SDR-4X的積CCD彩色攝像頭可進行影像識別,如判定目標方位,確定接近目標的路線。識別10多個人的臉部特征。除此之外,SDR-4X身上還安裝了帶有記憶功能的交流和運動控制系統(tǒng)。經(jīng)過內(nèi)置無線局域網(wǎng)。機器人能夠與電腦相連接并獲取同步數(shù)據(jù),識別眾多詞匯。如果主人將音樂和歌詞輸入給它,它就可動情地唱山美妙的歌。若主人經(jīng)過其內(nèi)置的軟件系統(tǒng)與電腦連接。設計一系列動作,如舞蹈,機器人還能做出復雜而人性化的動作。圖1.8.4SDR-4X機器人1.8.2.國內(nèi)發(fā)展狀況國內(nèi)在兩足步行機器人領域的研究起步較晚,長沙國防科技大學于11月研制出中國首臺兩足步行機器人—先行者。先行者身高1.4m,體重20kg,共有17個自由度,能夠完成原地扭動、平地前進、后退、左右側行和左右轉(zhuǎn)彎等動作。哈爾濱工業(yè)大學自1985-研制出雙足步行機器人:HIT-I、HIT-II和HIT-III,HIT-III實現(xiàn)了步距200毫米的靜態(tài)/動態(tài)步行,最快步行周期為3.2-4秒/步,能夠完成前/后、側行、轉(zhuǎn)彎、上/下臺階及上斜坡等動作。圖1.8.5HIT-I、HIT-II機器人北京理工大學于12月研制出仿人機器人BRI-01,是當前國內(nèi)最先進的兩足步行機器人。機器人高1.6米,重80千克,具有32個自由度,步速1千米/時,步距33厘米;能根據(jù)自身的平衡狀態(tài)和地面高度變化,實現(xiàn)未知路面的穩(wěn)定行走。清華大學于4月9日研制出具有自主知識產(chǎn)權的仿人機器人THBIP-I樣機。THBIP-I共32個自由度。實現(xiàn)無纜連續(xù)穩(wěn)定的平地行走、連續(xù)上下臺階行走,以及端水、太極拳和點頭等動作。圖1.8.6THBIP-I1.8.3.存在的問題綜上所述,國外在這方面的研究已經(jīng)有100多年的歷史了,成果較多,可是大多都結構復雜,造價昂貴,遠遠超出人民的經(jīng)濟承受能力。國內(nèi)的研究相對較晚,雖然也誕生了很多專利,但由于受到體積,重量,穩(wěn)定性級安全問題還沒有產(chǎn)品真正投入使用。1.9.具體設計1.9.1.設計指導思想面向社會應用需求,基于機械創(chuàng)新設計課程的課題要求,根據(jù)之前學習到的機械原理等知識,力求推動大學生設計創(chuàng)新能力,提高機器人應用實際的實際操控力,達到我們機械創(chuàng)新設計的目的。1.9.2.應解決的主要問題1.重心對于機器人行走穩(wěn)定性的影響,對機體質(zhì)心及其穩(wěn)定性;2.二足行走機構的設計;3.兩腿之間運動時的協(xié)調(diào)配合,以及周期的確定;4.運動學分析:建立合理得運動學模型,從而對不同運動階段進行分析。1.9.3.本設計采用的研究計算方法本設計主要經(jīng)過分析仿人二足步行機器人爬樓梯行走機構步態(tài)運動,結合高等代數(shù)、機械原理等相關知識以及利用互聯(lián)網(wǎng)資源對仿人二足步行機器人爬樓梯行走機構進行合理的分析與設計。1.9.4.技術路線1.收集國內(nèi)外仿人二足步行機器人爬樓梯行走機構的相關資料,分析并消化,總結出我們自己的方法;2.仿人二足步行機器人爬樓梯行走機構的步態(tài)規(guī)劃,選擇合適的步態(tài),并穩(wěn)定性分析,行走步態(tài)設計;3.機構設計和運動學分析,繪制仿人二足步行機器人爬樓梯行走機構的機構原理圖;針對運動特征設計相應機構,改進運動機構完成設計。4.根據(jù)腿的二維平面設計示意圖進行三維設計,并用CATIA軟件進行機構行走仿真,動態(tài)模擬分析。研究手段研究結果成果集成網(wǎng)上資料查閱收集確定基本思路步態(tài)分析查閱機械原理基礎知識機構設計仿人二足步行機器人爬樓梯行走機構動態(tài)模擬分析機器人機構可行性分析仿人二足步行機器人爬樓梯行走機構步態(tài)規(guī)劃2.1引言步態(tài)是指在步行運動過程中,機器人各關節(jié)在時間和空間上的一種協(xié)調(diào)關系。合理的步態(tài)規(guī)劃是機器人穩(wěn)定步行的基礎。步態(tài)規(guī)劃不但是兩足機器人實現(xiàn)基本擬人動作的關鍵,而且能夠為兩足機器人機構設計與優(yōu)化提供理論指導。沒有行走步態(tài)的規(guī)劃,兩足機器人最基本的步行功能也就無從實現(xiàn),就失去了兩足步行機器人靈活性、適應能力強等優(yōu)勢。而擬人機器人的其它功能,也會受到極大的影響。仿人機器人步態(tài)規(guī)劃不但取決于地面條件、下肢結構、控制的難易程度,而且必須滿足運動平穩(wěn)性、速度、機動性和功率等要求。2.2仿人二足步行機器人爬樓梯行走機構的步行概念為了便于對仿人二足步行機器人爬樓梯行走機構進行步態(tài)規(guī)劃,首先定義一些有關兩足步行的基本概念。步態(tài):在步行運動過程中,機器人各關節(jié)運動在時序和空間上的一種協(xié)調(diào)關系以及機器人相對環(huán)境的時空關系。一般由各關節(jié)角運動軌跡和質(zhì)心軌跡來描述。步距:在步行運動中,機器人左右腳落地位置間的縱向距離?？绺?擺動腿在擺動過程中腳底離地面的最大距離,用于衡量機器人跨越樓體高度的大小。步行周期:是指機器人周期性行走過程中,同一只腳順序兩次著地所用的時間。每個周期內(nèi)左右腿各向前邁步一次,又可分為三個階段,雙腳支撐期、左腳支撐期和右腳支撐期。步速:是衡量機器人步行能力的一個重要指標,是指機器人單位時間內(nèi)相對步行環(huán)境所移動的距離。單腳支撐:機器人僅有一只腳與地面相接觸,起支撐作用,另一只腳處于擺動狀態(tài)。2.3步行過程設定因本文所述的仿人二足步行機器人爬樓梯行走機構設計目標是實現(xiàn)爬樓梯功能,鑒于機器人行走場地具有良好的環(huán)境,在不影響機器人主要功能的前提下做出如下設定:(1)機器人在行走過程中處于靜力學平衡的狀態(tài),即機器人行走方式為靜態(tài)步行;(2)由于樓梯的臺階具有較為良好的水平性,我們設定機器人腳底面相對于臺階表面始終保持平行狀態(tài);(3)設定機器人以直線狀態(tài)行走;(4)機器人在直線行走過程中,髖關節(jié)相對于地面的高度始終保持不變;(5)由于本機器人左右腿的關節(jié)的對稱性,在以后的討論中僅考慮右腿的運動情況,左腿的情況與右腿類似。仿人二足步行機器人爬樓梯行走機構機械圖如下圖所示:XY平面投影定義的大腿長為R1,小腿的長度為R2。由上圖能夠看出,仿人二足步行機器人爬樓梯行走機構髖關節(jié)向上旋轉(zhuǎn)了θh角度的時候,其中大腿在Y軸方向提升高度,仿人二足步行機器人爬樓梯行走機構大腿Y方向提升高度能夠經(jīng)過下圖計算:根據(jù)圖中所示,得到計算的表示式子:H=R1因此能夠確定的是髖關節(jié)電機旋轉(zhuǎn)θh角度時候在Z軸的方向上提升高度的函數(shù)關系。由圖2-5可見仿人二足步行機器人爬樓梯行走機構髖關節(jié)向著前面轉(zhuǎn)動θ1的時候立足位置點在Y軸的方向上前進了半步長為?x,仿人二足步行機器人爬樓梯行走機構腿部X圖2-5腿在Y方向上前進的示意圖因此說能夠得出來?x=R1cosθ1+R2cosφ2sinφ1,由表示能夠確定髖關節(jié)向前轉(zhuǎn)動θ2.4雙足機器人步態(tài)穩(wěn)定性分析2.4.1步行穩(wěn)定性判據(jù)雙足機器人步行運動過程中,兩只腳交替的與地面,發(fā)生間歇性的相互作用,即交替的出現(xiàn)左腳單支撐,雙腳支撐和右腳單支撐的狀態(tài),周期性的不斷前進。雙足機器人步態(tài)研究的重點就在于如何維持支撐腳與地面的相對瞬時固定,使機器人的運動過程中保持穩(wěn)定步行而不發(fā)生翻倒或滑倒。當前衡量雙足步行機器人穩(wěn)定性有兩個主要的指標:一個是整個機器人的重心在地面投影點(CenterofGravity,簡稱COG),COG對應的是靜態(tài)穩(wěn)定性;另一個是零力矩點(ZeroMomentPoint,簡稱ZMP)如圖2．2所示,ZMP對應于動態(tài)穩(wěn)定性M。靜態(tài)穩(wěn)定性只有在機器人運動非常緩慢時才適用,大多數(shù)情況,機器人運動具有一定的速度,需考慮它的動態(tài)穩(wěn)定性。因此,研究者們己經(jīng)采用了動態(tài)穩(wěn)定性,最普遍的是采用零力矩點(ZMP)作為雙足機器人步態(tài)穩(wěn)定性判定標準。2.4.2零力矩點定義零力矩點(zero．momentpoint,縮寫為ZMP)有關雙足機器人各部位動態(tài)控制的概念,它首先由南斯拉夫?qū)W者Miomir．Vukobratovic在1968年1月莫斯科第三屆理論與應用力學全聯(lián)盟代表大會上提出,在她后來的研究工作中和發(fā)表的論文中,Miomir．Vukobratovic等人致力于ZMP的研究工作,1972年,VukobratovicheStepanenko在一篇關于雙足機器人控制的論文開頭定義了零力矩點?，F(xiàn)在經(jīng)過幾十年的研究發(fā)展,ZMP的表述方法主要有兩種:1．ZMP指地面上滿足地面反力的合力矩對x,Y軸分量為零的那一點,即T(Tx,Ty,Tz)表示由地面反力繞某一點產(chǎn)生的合力矩在ZMP點滿足Tx=0,Ty=0,Tz=0,如圖2.4.2所示。2．ZMP指重力和慣性力的合力在地面上的投影,在這一點上合力矩為零。能夠證明這兩種表述方式是一致的,雙足機器人穩(wěn)定步行時,其ZMP具有如下性質(zhì):ZMP始終位于支撐腿的腳掌所組成的凸形有效支撐區(qū)域內(nèi),以保證ZMP的條件,滿足ZMP穩(wěn)定性原則p6朝。ZMP概念的引入,為雙足機器人的動態(tài)步行運動分析和規(guī)劃提供了一個重要的依據(jù)。圖2-2重心地回投影及ZMP根據(jù)零力矩點的定義,不論哪一種步行方式,零力矩點必須落在機器人支撐腳構成的區(qū)域的一定范圍內(nèi)才能保證它的穩(wěn)定。2.4.3穩(wěn)定步態(tài)的條件對于一個給定步態(tài),如果其在雙足步行機器人上是可復現(xiàn)的,則稱這一步態(tài)是穩(wěn)定的;反之,則稱這一步態(tài)是不穩(wěn)定的。顯然,當ZMP始終落在腳掌支撐面內(nèi)時,這一步態(tài)是穩(wěn)定的,也是可復現(xiàn)的;若ZMP超出腳掌支撐面,則這一步態(tài)是不穩(wěn)定的,也是不可復現(xiàn)的。機器人行走時支撐腳與地面的接觸面為支撐面,雙腳支撐面為兩腳所構成的凸多邊形的面積。雙足機器人動態(tài)步行的穩(wěn)定性問題是步態(tài)規(guī)劃的關鍵問題,借助理論力學工具,推導出穩(wěn)定步行需滿足的動力學條件。為了將ZMP的性質(zhì)運用于動態(tài)步行的步態(tài)分析與設計中,首先得分析ZMP與步態(tài)軌跡之間的聯(lián)系。機器人的行走方式能夠劃分為靜態(tài)行走和動態(tài)行走兩種方式。靜態(tài)行走是指在行走過程的任意瞬間,機器人都處于靜平衡狀態(tài),即重心在地面的投影始終處于支撐面內(nèi)。靜態(tài)行走的速度較慢,各桿件運動的速度和加速度都很小。擺動腿著地時腳掌和地面的相對速度可看作近似為零,不發(fā)生碰撞,且行走過程中損失的能量很小,因而在連續(xù)行走中對其運動控制不考慮慣性力的影響。靜態(tài)穩(wěn)定性忽略機器人的動態(tài)性能,采用重心(COG)作為穩(wěn)定性標準,因此這種穩(wěn)定性只有在機器人運動非常緩慢時才適用。此時,Zi=Xi=YiXZMP=XC=i=1nmiXii=1式(2．10)中:XC,Y式(2．10)中:mi—各部分的質(zhì)量;Xi,Yi動態(tài)行走與靜態(tài)行走有很大的不同。動態(tài)行走的速度快,機器人處于動平衡狀態(tài),即動態(tài)行走不要求重心COG始終位于支撐面內(nèi),而是要求零力矩點ZMP始終位于支撐面內(nèi)。動態(tài)行走時,機器人各桿件的運動速度和加速度都較大,僅以質(zhì)心是否在支撐面內(nèi)不能決定系統(tǒng)的穩(wěn)定性,動態(tài)行走時ZMP坐標為:XZMP=-MyYZMP=-MxFz在高速動態(tài)行走中,由于慣性力的作用,系統(tǒng)的質(zhì)心和ZMP點不可能始終保持重合,當質(zhì)心COG落到支撐面之外,即出現(xiàn)靜不穩(wěn)定期,如果ZMP點仍處在支撐面內(nèi),就能夠保持系統(tǒng)的動態(tài)穩(wěn)定性。在兩足機器人的動態(tài)行走過程中,即使重心滿足靜態(tài)穩(wěn)定條件而ZMP在穩(wěn)定區(qū)域之外,整個雙足機器人系統(tǒng)也是不穩(wěn)定的,在其運動控制中需要充分考慮慣性力的影響,始終保持系統(tǒng)的動力學平衡關系。由上述推導可知,實現(xiàn)穩(wěn)定的步態(tài)規(guī)劃須滿足以下條件:1．由于地面與支撐腳為單面約束,即地面反力Fgz=-Fz≥0→以保證機器人在行走中不會騰空,產(chǎn)生跑或者跳的動作。2．等效力與地面的交點P(XZMP-lab以保證機器人在步行中不會繞x軸傾覆,式中乙為后腳掌的長度,0為前腳掌的長度,彬為腳掌內(nèi)側的寬度,w,為腳掌外側的寬度。從節(jié)能的角度考慮,靜態(tài)步行的驅(qū)動力矩主要克服重力矩,而動態(tài)步行能夠有效地利用重力和慣性力進行重心的移動。毫無疑問,動態(tài)步行的驅(qū)動力矩比靜態(tài)步行的驅(qū)動力矩要小,而且能夠?qū)崿F(xiàn)高速行走。要保證雙足機器人的動態(tài)步行穩(wěn)定,必須保證零力矩在行走過程中始終落在支撐區(qū)域內(nèi)。ZMP越靠近支撐域的中心,機器人的動態(tài)穩(wěn)定性越好,當ZMP與支撐域中心重合,機器人步行穩(wěn)定裕度最大,抗顛覆能力最強,ZMP位置能夠經(jīng)過控制關節(jié)力矩的方法進行間接控制。2.4.4小結本節(jié)首先分析雙足機器人的構造特點,建立雙足機器人七連桿模型。接著介紹了用雙足機器人穩(wěn)定性判據(jù)的類型,闡述了零力矩點的定義及推導過程,并分別就機器人靜態(tài)步行和動態(tài)步行展開分析,得出兩種不同運動情況下各自的步行穩(wěn)定判斷條件,隨后研究了雙足機器人穩(wěn)定步行的條件,為后面章節(jié)的步態(tài)規(guī)劃和步態(tài)優(yōu)化及實驗奠定基礎。2.5雙足機器人步態(tài)規(guī)劃2.5.1引言雙足機器人的步態(tài)規(guī)劃,是指機器人行走過程中其各組成部分運動軌跡的規(guī)劃。步態(tài)是指機器人步行運動過程中,機器人各關節(jié)運動在時序和空間上的一種協(xié)調(diào)關系,一般由各關節(jié)運動的一組軌跡函數(shù)來描述。雙足機器人步行運動過程能夠分為三個階段:起步、周期步行和停步。這三個階段各不相同,但有著緊密的聯(lián)系,起步之后緊接著就是周期步行,周期步行之后是停步,周期步行的軌跡具有周期重復性。2.5.2雙足機器人步行過程分析雙足機器人的步態(tài)規(guī)劃就是規(guī)劃機器人的行走步態(tài),水平地面的基本行走步態(tài)有前向步行、側向步行和轉(zhuǎn)向步行。轉(zhuǎn)向步行包含了前向步行和側向步行,是最復雜的步行。本文主要以前向周期步行作為步態(tài)規(guī)劃的重點,將前向步態(tài)分解如圖2.5.1所示,圖中以左腿首先作為支撐腿,右腿作為擺動腿為例分解,若右腿首先作為支撐腿,左腿作為擺動腿只需將圖中左右調(diào)換即可。曲腿下蹲邁左腿側向移動重心(向左)側向移動重心()雙腿直立邁右腿圖2.5.1前向步態(tài)分析框圖在雙足機器人整個步行過程中,假設身軀始終保持直立,因此左、右髖關節(jié)在Z軸上的位置函數(shù)是相同的。人在平地上向前行走是雙腳支撐期和單腳支撐周期性交替出現(xiàn)不斷前進的過程。每一步可分為雙腳支撐期和單腳支撐期,雙腳支撐期指從前腳跟接觸地面到后腳尖離開地面的時間段,即圖2.5.2中OA、CD階段,雙腳都跟地面接觸。單腳支撐期指從一只腳離開地面到它再次跟地面接觸的時間段,在這段時間里,只有一只腳與地面接觸即圖3．2中AC時段。雙足機器人的前向運動過程可分為:OA雙腳支撐(左腳在前,右腳在后)_AC單腳支撐(左腳支撐,右腳擺動)一CD雙腳支撐(右腳在前,左腳在后)_DF單腳支撐(右腳支撐,左腳擺動)_0A雙腳支撐(左腳在前,右腳在后)一?從第F狀態(tài)起,就是不斷重復OF的過程,而OC的過程,與CF的過程相比,只是左右狀態(tài)互換,因此只要把OC時段的步態(tài)確定了,機器人整個步行運動周期的步態(tài)就能夠完全確定。圖2.5.2雙足機器人步行過程示意圖2.5.3髖關節(jié)規(guī)劃假定髖關節(jié)在步行過程中高度H不變,髖關節(jié)的位置對ZMP的影響很大,對機器人能否保持穩(wěn)定步行起到至關重要的作用。初次規(guī)劃的軌跡不一定能使機器人穩(wěn)定,因此在髖關節(jié)軌跡規(guī)劃時設幾個可調(diào)參數(shù),經(jīng)過調(diào)節(jié)參數(shù)使機器人保持穩(wěn)定。如圖2.5.5所示,d。表示擺動腳落地時髖關節(jié)到支撐腿踝關節(jié)的距離,d。表示擺動腳抬起時髖關節(jié)到支撐腿踝關節(jié)的距離。dxeddd圖2.5.5dxs2.5.4髖關節(jié)軌跡對ZMP的影響雙足機器人的很大部分質(zhì)量集中于上半身,故上半身的位置對ZMP的影響大,而髖關節(jié)是離上半身最近的可控自由度,故本文主要分析髖關節(jié)位置對ZMP的影響。建立機器人步行時腳掌的受力模型,如圖2.5.6所示。圖2.5.6腳掌受地面作用力分布圖根據(jù)文獻[19]中對ZMP的定義,可得x方向的ZMP為:Px=x式中．dε為足底每單位長度上地面作用力的鉛垂分量,ε為dε的X坐標,Px,為地面作用力的壓力中心,即ZMP,x1兩個可調(diào)參數(shù)dxs,dxe,如圖2.5.5所示,用來調(diào)節(jié)髖關節(jié)在擺動腿離地和落地時刻髖關節(jié)中心的位置。當dxs變小時,髖關節(jié)向支撐腳后方移動,致使支撐腳所受地面作用力分布向后端偏移,由公式(2.14)可知ZMP將隨之向腳跟移動。反之,若dxs變大,則髖關節(jié)前移,從而使支撐腳所受地面作用力分布前移,導致ZMP也向腳尖移動,使穩(wěn)定裕度變小。同理,當d二足機器人的機構分析3.1四連桿機構的設計機器人設計過程中,腿部采用了四桿機構。在前期時參考了不少有關腿部機構的資料,這個機構的選擇很重要,主要原因如下:(1)執(zhí)行機構決定了整個系統(tǒng)的復雜度,機構越復雜,涉及到的工作和配合越多,制作的精度就不容易保證。(2)執(zhí)行機構關系到運動的最終狀態(tài),決定運行的姿態(tài)。(3)執(zhí)行機構最終保證整個機器人系統(tǒng)功能的實現(xiàn)。3.1.1設計參數(shù)(1)連桿尺寸lAB=160mm,lBC=160mm,lCD=220mm,l圖3.1.1機構原理圖(2)估算機身高度設置為H=400mm,在正前方運行時,左腿和右腿之間不會發(fā)生相互干涉,為了保證兩腿之間有足夠的距離,兩髖關節(jié)之間的距離為125mm。3.2二足機器人主體設計用三維軟件CATIA畫出總設計圖如下:3.2.1腿部的設計腿部結構是機器人身體里主要的部分,根據(jù)仿生學的知識,人腿部結構大致為:髖關節(jié),和膝關節(jié),還有踝關節(jié)和腳。本文采用曲柄搖桿機構實現(xiàn)其直線行走和爬樓梯功能的。兩組腿交替的變換使機身能向前運動,她們每組都支撐機體的重量,并在負重的狀態(tài)下使機體的前行,因此適應的剛性和承載能力是非常重要的,因此對承載能力有著限制。圖3.2.1腿3.2.2大腿3.2.3小腿3.2.4腳3.2.5其它輔助連桿總結4.1.設計小結經(jīng)過這次機械原理課程設計,綜合運用了機械原理及其它課程的理論知識。將理論與實際結合在了一起,培養(yǎng)了我們團隊合作以及解決機械工程有關的實際問題,最重要的是讓我們從所學專業(yè)中找到了樂趣。在本次機械原理的課程設計訓練中鞏固學習了機械原理設計基礎、CAD二維制圖軟件和CATIA三維軟件,也學會了怎樣從前人設計中取得經(jīng)驗以及處理數(shù)據(jù)的能力。4.2設計感受在機械原理課程設計過程中,我們經(jīng)過對已有文獻的查閱結合我們自己所學的專業(yè)知識。將理論和實踐完美的結合在了一起,使我們更深刻的理解了我們的專業(yè)知識。從中學到了很多知識,并認識到團隊協(xié)作的重要性。在設計過程中我們遇到了很多困難和挫折但經(jīng)過努力以及我們不畏困難,不拋棄,不抱怨等都是我們學到的精神品質(zhì)。經(jīng)過這次設計我們認識到,機械是精準、系統(tǒng)、經(jīng)驗化的學科,對于問題不能粗略的概括和認識,容不得半點偏差。面對茫然不知所措的問題時要冷靜,耐心對待。再設計過程中我們不斷領悟機械學科及行業(yè)精髓,對所學專業(yè)有了濃厚的興趣,激發(fā)了我們的學習熱情當然讓我們對將來的職業(yè)也充滿了希望。在設計過程中培養(yǎng)了我們的自學能力,這是我們步入社會所必備的素質(zhì)。現(xiàn)實企業(yè)中越來越強調(diào)團隊協(xié)作,這次設計是我們小組在老師指導下共同努力的結果,沒有良好的團隊協(xié)作能了我們是不可能完成本次機械原理課程設計的。這種團隊意識使我們步入社會必備的技能,這對我們即將步入社會的大學生有著重大意義。4.3課程設計看法機械原理課程設計,對于我們將