【正文】 ,BC,CA的垂線，設(shè), ,d1=0M2ONd3=P則dl,d2,d3為機(jī)器人質(zhì)心投影與支撐三角形各邊的距離。第三章 六足仿生機(jī)器人的步態(tài)分析和設(shè)計六足步行機(jī)器人的步態(tài)是多樣的，其中三角步態(tài)(或交替三角步態(tài)、3+3步態(tài))步態(tài)是六足步行機(jī)器人實(shí)現(xiàn)步行的典型步態(tài) [8]。(3 )Q 1/ 2: 機(jī)體移動較快時，六條腿有同時為擺動相的時刻，即六條腿同時在空中，處于騰空狀態(tài)，顯然此交替過程要求機(jī)體機(jī)構(gòu)具有彈性和消振功能，否則難以實(shí)現(xiàn)。“六足綱”昆蟲的運(yùn)動原理 步態(tài)的參數(shù)描述“六足綱”昆蟲體的腿可以看作兩狀態(tài)器件:腿的懸空相和腿的支撐相。于是以McGhee等人為代表的對多足機(jī)器人的遠(yuǎn)動步態(tài)進(jìn)行了研究并提出了方案。自主式移動機(jī)器人按人預(yù)先設(shè)置的任務(wù)命令，根據(jù)己知的環(huán)境信息進(jìn)行路徑規(guī)劃，同時在行進(jìn)過程中不斷獲取周圍的局部環(huán)境信息，自主地做出判斷和決策，隨時調(diào)整移動機(jī)器人的運(yùn)行路徑并執(zhí)行相應(yīng)的動作和操作。 移動機(jī)器人概述移動機(jī)器人是機(jī)器人學(xué)的一個重要分支，其研究始于60年代末期，斯坦福研究院的Nils Nilssen和Charles Rosen等人，在1966年至1972年中研制出了取名為Shakey的自主式移動機(jī)器人。它不僅具有比第二代機(jī)器人更加完善的環(huán)境感知能力，而且還具有邏輯思維、判斷和決策能力，可根據(jù)作業(yè)要求與環(huán)境信息自主地進(jìn)行工作。這些裝置大多由時鐘機(jī)構(gòu)驅(qū)動，用凸輪和杠桿傳遞運(yùn)動。1920年，（漢語前譯為“勞伯”）這個名詞。 機(jī)器人的定義和基本組成 機(jī)器人的定義由于研究的側(cè)重點(diǎn)不同，對于機(jī)器人的定義，國際上目前尚未有明確的統(tǒng)一標(biāo)準(zhǔn)。目的是研究應(yīng)用人工智能技術(shù)，在復(fù)雜環(huán)境下機(jī)器人系統(tǒng)的自主推理、規(guī)劃和控制。整個過程不需人為參與，由機(jī)器人自主進(jìn)行。隨后，國內(nèi)外的眾多學(xué)者便開始研究多足機(jī)器人的運(yùn)動步態(tài)和控制。腿的懸空相(Transfer phase)指腿抬離地面的階段，懸空相狀態(tài)記為“1”。三角步態(tài) (或交替三角步態(tài)、3+3步態(tài))，是Q =1/2時的波形步態(tài)，運(yùn)動時六條腿成兩組三角形交替支撐邁步前進(jìn)。該步 態(tài) 是 將機(jī)器人的6條腿分為2組，腿5為A組，分別為Al,A2, A3，腿6為B組，分別為B1, B2, B3，步行過程2組腿交替地擺起、放下。直線AB方程為: (Y12)X= +垂線OM的方程為： ()21由上兩式解得直線AB和直線OM的交點(diǎn)M (XM ，YM)的坐標(biāo)為: 22(Y1)X)=[+(]22(X)1Y)M=[+(]則：dl= = O2XY?同理，可以求得d2= , d3= 。22第四章 六足仿生機(jī)器人的控制系統(tǒng)設(shè)計控制系統(tǒng)的設(shè)計主要任務(wù)是完成全方位步態(tài)的軟件設(shè)計，也就是對12個舵機(jī)的調(diào)度和控制。常用的AT89S52封裝電路為PDIP形式，其圖如圖42所示。 工作原理：控制電路板接受來自信號線的控制信號（具體信號待會再講），控制電機(jī)轉(zhuǎn)動，電機(jī)帶動一系列齒輪組，減速后傳動至輸出舵盤。安裝在機(jī)器人的前部，做成兩個長長的觸角，用來探測前方是否有障礙物。圖 48 舵機(jī)的控制脈沖圖30圖 49 控制脈沖程序流程圖流程圖說明：初始化部分：設(shè)定定時器初值，定時時間為舵機(jī)脈沖寬度時間 t。 TH1=(b/256)。 /*判斷脈寬是否在正常范圍之內(nèi)*/ } 程序中的 162540 等數(shù)字為定時器初值。如圖 410（b）是 8 個舵機(jī)在一個周期內(nèi)電平變化 16 次。定時器重置初值，定時時間為() flag1++,break 結(jié)束中斷程序flag1=5 時：p02=1。定時器在計數(shù)時不占用 CPU 時間，且兩個定時器可以并行工作，所以兩個定時器在忽略中斷執(zhí)行時間時，對電機(jī)控制幾乎是并行的。但如果要控制12 個之多的舵機(jī)，顯然是不夠現(xiàn)實(shí)的。 /*設(shè)定定時器初始計數(shù)值*/ EA=1。=1：將控制引腳端口置高電平。圖 44 微動開關(guān)安裝位置圖left, right 分別為左邊和右邊的探測障礙物的傳感器。 舵機(jī)的控制一般需要一個20ms 左右的時基脈沖，該脈沖的高電平部分一般~ 范圍內(nèi)的角度控制脈沖部分。如表41所示。在完成的避開障礙物的過程中來體現(xiàn)全方位的六足步態(tài)。六足仿生機(jī)器人直線行走步態(tài)示意圖如圖36所示。機(jī)器人步態(tài)的規(guī)劃包括:步態(tài)穩(wěn)定性分析，直行步態(tài)規(guī)劃與分析，定點(diǎn)轉(zhuǎn)彎步態(tài)規(guī)劃與分析等。身體左側(cè)的前、后足及右側(cè)的中足為一組，右側(cè)的前、后足和左側(cè)的中足為另一組，分別組成兩個三角形支架。運(yùn)動周期T指周期步態(tài)中某一腿運(yùn)動一個完整循環(huán)所需要的時間。同時，在國內(nèi)，中科院沈陽自動化研究所、清華大學(xué)、等單位也先后展開了機(jī)器人的研究，并取得了較大的成果。按輪數(shù)的多少又可分為二輪、三輪、四輪式三種。70年代末，隨著計算機(jī)的應(yīng)用和傳感器技術(shù)的發(fā)展，移動機(jī)器人研究又出現(xiàn)了新的高潮。 機(jī)器人的基本組成：1. 機(jī)械本體機(jī)器人的機(jī)械本體機(jī)構(gòu)基本上分為兩大類：一類是操作本體機(jī)構(gòu)，它類似人的手臂和手腕，配上各種手爪與末端操作器后可進(jìn)行各種抓取動作和操作作業(yè)，工業(yè)機(jī)器人主要采用這種結(jié)構(gòu)。1950年美國作家阿西莫夫提出了機(jī)器人學(xué)（Robotics）這一概念，并提出了所謂的“機(jī)器人三原則”，即： ；，但不和（1）矛盾的指令；（1）、（2）原則不相矛盾的前提下，機(jī)器人可維護(hù)自身不受傷害。 機(jī)器人的發(fā)展歷史早在三千多年前的西周時代，我國就出現(xiàn)了能歌善舞的木偶，稱為“倡者”，這可能是世界上最早的“機(jī)器人”。第二代機(jī)器人已進(jìn)入了使用化，在工業(yè)生產(chǎn)中得到廣泛應(yīng)用。一般還有一個以上的串行通訊接口，以完成磁盤數(shù)據(jù)存儲、遠(yuǎn)程控制及離線編程、雙機(jī)器人協(xié)調(diào)等工作。不具備任何自主性。研發(fā)人員開始紛紛研究多足機(jī)器人的模型和樣機(jī)，并一步步攻關(guān)一個個難題。 本章小結(jié)本章主要是對機(jī)器人有一各概況，著重介紹了機(jī)器人的發(fā)展及國內(nèi)外的一些機(jī)器人的發(fā)展成果，并交代了本次設(shè)計的設(shè)計背景，為后續(xù)的設(shè)計指明了方向。行走系統(tǒng)采用波形步態(tài)時，度范圍內(nèi)都采用波形步態(tài). 三角步態(tài)運(yùn)動原理 “六足綱”昆蟲的三角步態(tài)運(yùn)動原理機(jī)體運(yùn)動根據(jù)有荷因數(shù)(dutyf actor)的大小可分為3種情況:(1 )Q = 1 /2 : 在三擺動腿著地的同時，另外三支撐腿立即抬起，即任意時刻同時具有支撐相和擺動相。機(jī)器人腿部的實(shí)物如圖22所示：11圖22機(jī)器人腿部實(shí)物 本章小結(jié)本章主要分析了“六足綱”昆蟲的遠(yuǎn)動步態(tài)以及原理。在實(shí)際控制中，要合理選擇機(jī)器人的跨步和轉(zhuǎn)角，以保證點(diǎn)O1 落在穩(wěn)定區(qū)域內(nèi)。20O123456?XY圖 37（A）(2)如圖37(B)所示，機(jī)器人B組腿作支撐腿，A組抬起，此時，腿的位置矢量為:123456?XYOP1=??(),TLmnh??P2= si0?P3=??(),TP4= sinLm??P5=??(),0ThP6= si??圖 37（B ）(3)如圖37 (C) 所示，機(jī)器人B組腿作支撐腿，A組抬起，做姿態(tài)調(diào)整，位置矢量為:P1=??(),0TLmn??P2= sih?P3=??(),TP4= sinLm??P5=??(),0TP6= ,sih??21123456XYOP1=??(),sin,TLmh???P2= 0P3=??(),(si),T?P4= nLm?P5=??(),si,Th?P6= ()0?圖 37（C）(4)如圖37 (D)所示，A和B組腿均落地，作支撐腿，完成旋轉(zhuǎn)y角度動作，此時位置矢量為:123456P1=??(),sin,0TLm???P2=P3=??(),(si),T?P4= n0Lm?P5=??(),si,T?P6= ()?XY O圖 37（D ）通過以上分析，“三角步態(tài)斤定點(diǎn)轉(zhuǎn)彎步態(tài)穩(wěn)定性易滿足，其最大轉(zhuǎn)角計算考慮到機(jī)械結(jié)構(gòu)和行走地貌的約束。3個16位可編程定時計數(shù)器，2個全雙工串行通信口，看門狗(WDT),AT89S52設(shè)計和配置了振蕩頻率可為OHz并可通過軟件設(shè)置的省電模式。在未來的自動化控制領(lǐng)域有著不可估量的優(yōu)勢。當(dāng)碰觸到障礙物時，常開點(diǎn)閉合、常閉合點(diǎn)斷開。舵機(jī)實(shí)現(xiàn)的是一種定位功能，它的定位功能和較大力矩承受能力適合行走機(jī)器人的關(guān)節(jié)設(shè)計。d=b。amp。33AT89S52 單片機(jī)有三個定時器，其中定時器 0 和定時器 1 兩個為常用定時器。定時器重置初值，定時時間為 p00 高電平持續(xù)時間t1，flag1++,break 結(jié)束中斷程序flag1=2 時：p00=0。下面是本設(shè)計的 12 個舵機(jī)控制流程圖（圖 411） 。設(shè) P0 端口上接有 8 個舵機(jī)。EX0=1PX0=0。詳細(xì)程序如下：include define uchar unsigned chardefine uint unsigned int uint a,b,c,d。圖 45 硬件設(shè)計仿真圖 控制系統(tǒng)軟件設(shè)計軟件設(shè)計主要任務(wù)是完成全方位的步態(tài)的軟件設(shè)計，也就是對 12 個舵機(jī)的調(diào)度和控制。為此，必須提高機(jī)器人對當(dāng)前感知環(huán)境的快速理解識別及實(shí)時避障的能力。舉個簡單的四通飛機(jī)來說，飛機(jī)上有以下幾個地方需要控制： ，來控制發(fā)動機(jī)的拉力（或推力）； 25（安裝在飛機(jī)機(jī)翼后緣），用來控制飛機(jī)的橫滾運(yùn)動； ，用來控制飛機(jī)的俯仰角； ，用來控制飛機(jī)的偏航角； 遙控器有四個通道，分別對應(yīng)四個舵機(jī)，而舵機(jī)又通過連桿等傳動元件帶動舵面的轉(zhuǎn)動，從而改變飛機(jī)的運(yùn)動狀態(tài)。控制系統(tǒng)的基本結(jié)構(gòu)圖可表示為圖 41 所示。17 步態(tài)動作分析對直線行走步態(tài)規(guī)劃圖具體分析，其不同步態(tài)時刻的各點(diǎn)位置矢量如下:（1）如圖36(A)所示，5腿抬起向前，初始位置不做分析，由于前面已經(jīng)提到當(dāng)較小時，可設(shè)旋轉(zhuǎn) 角度后腿部在X軸上的投影長度近似為L。 六足步行機(jī)器人坐標(biāo)定義六足步行機(jī)器人機(jī)械簡圖如圖32所示，定義地面坐標(biāo)系 及XOY與機(jī)身平行，Z軸O?與機(jī)身垂直:機(jī)身坐標(biāo)系 ，坐標(biāo)原點(diǎn)與機(jī)器質(zhì)心重合。這就是典型的三角步態(tài)行走法，其行走軌跡并非是直線，而是呈“之”字形的曲線前進(jìn)。腿行程 (leg stroke)，指支撐相時足端相對于機(jī)體移動的距離。圖12Gengh機(jī)器人同樣，在國內(nèi)也漸漸出現(xiàn)了一批設(shè)計和生產(chǎn)仿生機(jī)器人公司和個人，圖13是德普施科技有限公司的DRROB系列高級機(jī)器人產(chǎn)品 [5]。足式移動方式具有主動隔振能力，允許機(jī)身運(yùn)動軌跡和足運(yùn)動軌跡解禍，足式步行機(jī)器人的研究已成為機(jī)器人學(xué)中一個引人注目的研究領(lǐng)域。如美國國防高級研究計劃局的“戰(zhàn)略計算與生存能力”工程，日本能產(chǎn)省的“極限環(huán)境下作業(yè)的機(jī)器人”發(fā)展計劃、歐洲共同體的“尤里卡”計劃，以及我國的“863”高科技計劃中，都把有害環(huán)境如核工廠和戰(zhàn)場使用的移動機(jī)器人作為重要的研究內(nèi)容。 2. 驅(qū)動伺服單元機(jī)器人本體機(jī)械結(jié)構(gòu)的動作是依靠關(guān)節(jié)機(jī)器人的關(guān)節(jié)驅(qū)動，而大多數(shù)機(jī)器人是基于閉環(huán)控制原理進(jìn)行的。70年代，隨著計算機(jī)技術(shù)、現(xiàn)代控制技術(shù)、傳感技術(shù)、人工智能技術(shù)的發(fā)展，機(jī)器人得到了迅速發(fā)展。它將機(jī)構(gòu)學(xué)、電子技術(shù)、控制理論、計算機(jī)技術(shù)、傳感器技術(shù)和人工智能等相關(guān)學(xué)科融合為一體，不斷吸收其他學(xué)科諸如材料、能源科學(xué)的最新成果，形成了一門獨(dú)立的高科技學(xué)科——機(jī)器人學(xué)。這種機(jī)器人被稱作第一代機(jī)器人。3通常的機(jī)器人采用主計算機(jī)與關(guān)節(jié)驅(qū)動伺服計算機(jī)兩級計算機(jī)控制，有時為了實(shí)現(xiàn)智能控制，還需對包括視覺等各種傳感器信號進(jìn)行采集、處理并進(jìn)行模式識別、問題求解、任務(wù)規(guī)劃、判斷決策等，這時空間的示教點(diǎn)將由另一臺計算機(jī)上級計算機(jī)根據(jù)傳感信號產(chǎn)生，形成三級計算機(jī)系統(tǒng)。另外，隨著生產(chǎn)自動化技術(shù)的發(fā)展，移動機(jī)器人在柔性自動化制造生產(chǎn)線上和無人化工廠中也得到了廣泛的應(yīng)用。(四)按功能和用途來分:醫(yī)療機(jī)器人，軍用機(jī)器人，助殘機(jī)器人，清潔機(jī)器人等。對六足仿生機(jī)器人控制系統(tǒng)的硬件電路和軟件流程給出詳細(xì)介紹，并進(jìn)行相關(guān)測試，驗證整體設(shè)計方案的正確性和可靠性.論文主要內(nèi)容有:以自行設(shè)計的六足仿生機(jī)器人為研究對象，分析其機(jī)械結(jié)構(gòu)，按照“六足綱”昆蟲的運(yùn)動原理，進(jìn)行步態(tài)分析，確定機(jī)器人的步態(tài)規(guī)劃?；爻虝r間tr，指腿在懸空相的持續(xù)時間。整個腿有大腿和小腿組成，通過髖關(guān)節(jié)的正交電機(jī)的驅(qū)動，實(shí)現(xiàn)了豎直方向的抬起和水平方向的移動。? (31)（32）14 六足機(jī)器人的穩(wěn)定性分析 穩(wěn)定性分析步行機(jī)器人任一時刻姿態(tài)圖如圖34所示。下面以左轉(zhuǎn)運(yùn)動步態(tài)為例子來分析它的步態(tài)。 控制系統(tǒng)的硬件設(shè)計中央控制模塊是整個控制系統(tǒng)的核心，本次設(shè)計采用微處理器AT89S52為核心構(gòu)成，負(fù)責(zé)舵機(jī)協(xié)調(diào)動作處理，障礙檢測數(shù)據(jù)處理等功能。 的脈沖來控制舵機(jī)的角度變化，隨著以 CPU 為主的數(shù)字革命的興起，現(xiàn)在的舵機(jī)已成為模擬舵機(jī)和數(shù)字舵機(jī)并存的局面，但即使是現(xiàn)在的數(shù)字舵機(jī)，177。接觸式傳感器一般用微動開關(guān),當(dāng)機(jī)器人接觸到物體時間可以從產(chǎn)生電位的變化中檢測到。也就是，給舵機(jī)提供一定寬度的脈沖，它的輸出軸就會保持在一個相對的角度上，無論外界的轉(zhuǎn)矩怎樣變化，直到給它提供一個另外寬度的脈沖信號，它才會改變輸出角度到新的對應(yīng)位置上。 a=1620。 /*20850 代表 20 ms，為一個周期的時間*/ TH0=(c/256)。具體的實(shí)現(xiàn)方法有兩種，一種是采用延時方法來產(chǎn)生脈沖，另外一種是用定時器的方法。flag1 ,flag2 為兩個標(biāo)志位。所以初始化的時候，將所有電機(jī)的位置定在 90 度的位置。不論