【正文】 ?( ), , 0 TL m n? P5= ( ), ,2TSL m h??????? P6= ? ?( ), , 0 TL m n?? X Y O X Y 1 2 3 4 5 6 P1= ( ) , , 02TSL m n??? ? ????? P2=? ?( ) , 0 , TL m h?? P3= ( ) , ( ) , 02TSL m n??? ? ? ????? P4=? ?( ) , , TL m n h? P5= ( ) , , 02TSLm??????? P6=? ?( ) , , TL m n h?? 17 （ 4） 6放下后， 5抬起； 則位置矢量： （ 5） 6向后移動(dòng)半步長(zhǎng)，做姿勢(shì)調(diào)整，此時(shí)的位置矢量： Y X O 1 2 3 4 5 6 P1= ( ) , , 02TSL m n??? ? ????? P2=? ?( ) , , TL m S h?? P3= ( ) , ( ) , 02TSL m n??? ? ? ????? P4=? ?( ) , ( ) , TL m n s h?? P5= ( ) , , 02TSLm??????? P6= ( ) , ( ) ,2TSL m n h??? ? ????? S/2 1 2 3 4 5 6 Y X O S/2 P1= ( ) , ,2TSL m n h??? ? ????? P2=? ?( ) , , 0 TL m S?? P3= ( ) , ( ) ,2TSL m n h??? ? ? ????? P4=? ?( ) , , 0 TL m n S?? P5= ( ) , ,2TSL m h??????? P6=? ?( ) , ( ) , 0 TL m n S? ? ? 18 （ 6）六條腿均落地，回到最初的狀態(tài)。此時(shí)的位置矢量： 通過(guò)以分析，可以通過(guò)合理選擇步距，保證機(jī)器人質(zhì)心 的投影點(diǎn)落在穩(wěn)定區(qū)域內(nèi)，完成機(jī)器人的直線行走 。 3. 5“三角步態(tài)”定點(diǎn)轉(zhuǎn)彎步態(tài)設(shè)計(jì) “三角步態(tài)”定點(diǎn)轉(zhuǎn)彎步態(tài)也將步態(tài)周期劃分為 4個(gè)執(zhí)行階段，其擺腿順序也有 2種 :A到 B組或 B組 到 A組。若 A組腿先擺動(dòng)，機(jī)器人右轉(zhuǎn)，若 B組腿先擺動(dòng)，則左轉(zhuǎn)。 下面以 左轉(zhuǎn)運(yùn)動(dòng)步態(tài) 為例子來(lái)分析它的步態(tài)。左轉(zhuǎn) 彎步態(tài)規(guī)劃圖如圖 37所示。 如圖 38(A)所示，機(jī)器人 4,6腿旋轉(zhuǎn) Y角度，此時(shí)， 各 腿的位置矢量為 :(設(shè)旋轉(zhuǎn) y角度后腿部在 X軸上的投影長(zhǎng)度近似為 L)[9]。 O S 1 2 3 4 5 6 X Y P1=? ?( ), , TL m n S h? ? ? P2=? ?( ) , , 0 TL m S?? P3=? ?( ) , ( ) , TL m n S h? ? ? ? P4=? ?( ) , , 0 TL m n S?? P5=? ?( ) , , TL m S h? P6=? ?( ) , ( ) , 0 TL m n S? ? ? 1 2 3 4 5 6 Y X O S P1=? ?( ) , , 0 TL m n S? ? ? P2=? ?( ) , , 0 TL m S?? P3=? ?( ) , ( ) , 0 TL m n S? ? ? ? P4=? ?( ) , , 0 TL m n S?? P5=? ?( ) , , 0 TL m S? P6=? ?( ) , ( ) , 0 TL m n S? ? ? 19 (2)如圖 37(B)所示，機(jī)器人 B組腿作支撐腿， A組抬起，此時(shí)，腿的位置矢量為 : (3)如圖 37 (C) 所示，機(jī)器人 B組腿作支撐腿， A組抬起，做姿態(tài)調(diào)整，位置矢量為 : O 1 2 3 4 5 6 ? X Y 圖 37（ A） 1 2 3 4 5 6 ? X Y O P1=? ?( ), , TL m n h?? P2=? ?( ), si n , 0 TL m L ?? ? ? P3=? ?( ), , TL m n h? ? ? P4=? ?( ), sin , 0 TL m n L ??? P5=? ?( ) , 0 , TL m h? P6=? ?( ), ( sin ), 0 TL m n L ?? ? ? 圖 37（ B） P1=? ?( ), , 0 TL m n?? P2=? ?( ), si n , TL m L h?? ? ? P3=? ?( ), , 0 TL m n? ? ? P4=? ?( ), sin , TL m n L h??? P5=? ?( ) , 0 , 0 TLm? P6=? ?( ), ( sin ), TL m n L h?? ? ? 20 (4)如圖 37 (D)所示， A和 B組腿均落地，作支撐腿，完成旋轉(zhuǎn) y角度動(dòng)作，此時(shí)位置矢量為 : 通過(guò)以上分析，“三角步態(tài)斤定點(diǎn)轉(zhuǎn)彎步態(tài)穩(wěn)定性易滿足，其最大轉(zhuǎn)角計(jì)算考 慮 到 機(jī)械結(jié)構(gòu)和行走地貌的約束?？梢酝ㄟ^(guò)合理選擇旋轉(zhuǎn)丫角度，完成機(jī)器人的定點(diǎn)轉(zhuǎn)彎動(dòng)作。 本章 研究六足機(jī)器人三角行走步態(tài)，分析了機(jī)器人三角步態(tài)穩(wěn)定性和穩(wěn)定裕量的計(jì)算，規(guī)劃了典型直線行走步態(tài)和定點(diǎn)轉(zhuǎn)彎步態(tài)，并對(duì)典型直線行走步態(tài)和定點(diǎn)轉(zhuǎn)彎步態(tài)進(jìn)行了詳細(xì)分析，給出各種步態(tài)動(dòng)作時(shí)落足點(diǎn)的位置矢量表達(dá)式，為機(jī)器人行走奠定基礎(chǔ)。 1 2 3 4 5 6 X Y O P1=? ?( ) , sin , TL m n L h?? ? ? P2=? ?( ), sin , 0 TL m L ??? P3=? ?( ) , ( sin ) , TL m n L h?? ? ? ? P4=? ?( ), sin , 0 TL m n L ??? P5=? ?( ), sin , TL m L h?? P6=? ?( ) , ( sin ) , 0 TL m n L ?? ? ? 圖 37（ C） 1 2 3 4 5 6 P1=? ?( ) , sin , 0 TL m n L ?? ? ? P2=? ?( ), sin , 0 TL m L ??? P3=? ?( ) , ( sin ) , 0 TL m n L ?? ? ? ? P4=? ?( ), sin , 0 TL m n L ??? P5=? ?( ), sin , 0 TL m L ?? P6=? ?( ) , ( sin ) , 0 TL m n L ?? ? ? X Y O 圖 37（ D） 21 第四章 六足仿生機(jī)器人的控制系統(tǒng)設(shè)計(jì) 控制系統(tǒng)的 設(shè)計(jì)主要任務(wù)是完成全方位步態(tài)的軟件設(shè)計(jì)，也就是對(duì) 12個(gè)舵機(jī)的調(diào)度和控制。設(shè)定一個(gè)目標(biāo)功能：在行進(jìn)的過(guò)程中完成避開(kāi)障礙物。在完成的避開(kāi)障礙物的過(guò)程中來(lái)體現(xiàn) 全方位的 六足步態(tài) 。 要避開(kāi)障礙物，首先探測(cè)到障礙物，其次能完成繞開(kāi)障礙物，這就要求機(jī)器人能完成前進(jìn)，后退、左右轉(zhuǎn)彎動(dòng)作。動(dòng)作的協(xié)調(diào)完美性的實(shí)現(xiàn)，要求了在任一時(shí)刻能夠做出 12個(gè)舵機(jī)的同步動(dòng)作控制。 控制系統(tǒng) 的基本結(jié)構(gòu)圖可表示為圖 41 所示 。 通過(guò)上圖可以看出， 12 個(gè)舵機(jī)是需要同時(shí)控制的， 那 么 ， 很顯然我們需要有 12 個(gè)控制信號(hào)來(lái)共同作用，也就意味著要求單片機(jī)產(chǎn)生 12 路的 PPM 波，利用這 12個(gè) PPM 波來(lái)控制舵機(jī)的轉(zhuǎn)動(dòng)角度。在這里我們 可以用 51 單片里的兩個(gè)定時(shí)器來(lái)產(chǎn)生多次中斷的方法獲蔽障 右轉(zhuǎn) 左轉(zhuǎn) 后退 _set_time()有 12個(gè)參數(shù)對(duì)應(yīng) 12 個(gè)舵機(jī)的轉(zhuǎn)動(dòng)角度 舵機(jī)1 舵機(jī)2 舵機(jī)3 舵機(jī)4 舵機(jī)5 舵機(jī)6 舵機(jī)7 舵機(jī)9 舵機(jī)11 舵機(jī)8 舵機(jī)10 舵機(jī)12 圖 41 基本功能框圖 高層 動(dòng)作 前進(jìn) 22 得這樣的控制的信號(hào)。從而完成機(jī)器人的前進(jìn)、后退以及轉(zhuǎn)彎。 在本次設(shè)計(jì)中，整個(gè)系統(tǒng)是以 模塊化的設(shè)計(jì)思想，將對(duì)所有舵機(jī)調(diào)度做成一個(gè)獨(dú)立的模塊，所有的高層動(dòng)作都是通過(guò)調(diào)用底層舵機(jī)控制的模塊來(lái)完成。 中央控制模塊是整個(gè)控制系統(tǒng)的核心， 本次設(shè)計(jì) 采用微處理器 AT89S52為 核心構(gòu)成，負(fù)責(zé)舵機(jī)協(xié)調(diào)動(dòng)作處理，障 礙檢測(cè)數(shù)據(jù)處理 等功能。 微處理器 AT89S52簡(jiǎn)介 AT89S52是一種低功耗、高性能 CMOS 8位單片機(jī) [10]，片內(nèi)含 SKBI SP(Insystem programmable)的可反復(fù)擦寫(xiě) 1000次的 Flash只讀程序存儲(chǔ)器、該器件采用 Atmel公司的高密度、非易失性存儲(chǔ)技術(shù)制造、兼容標(biāo)準(zhǔn) MCS51指令系統(tǒng)及 80C51引腳結(jié)構(gòu) .片內(nèi)集成了通用的 8位 CPU和 ISP Flash為存儲(chǔ)單元，可為眾多嵌入式控制應(yīng)用系統(tǒng)提供高靈活、高性價(jià)比的解決方案。 TA89S52具有如下特點(diǎn) :40個(gè)引腳， 8KB Flash片內(nèi)程序存儲(chǔ)器， 256Bytes的隨機(jī)存儲(chǔ)數(shù)據(jù)存儲(chǔ)器 (RAM)， 32個(gè)外部雙向輸入 /輸出 (I/O)口， 1個(gè) 6向量 2級(jí)中斷結(jié)構(gòu) 。3個(gè) 16位可編程定時(shí)計(jì)數(shù)器， 2個(gè)全雙工串行通信口，看門(mén)狗 (WDT)電路和片內(nèi)時(shí)鐘振蕩器 .此外 ,AT89S52設(shè)計(jì)和配置了振蕩頻率可為 OHz并可通過(guò)軟件設(shè)置的省電模式。在空閑模式下， CPU暫停工作，而 RAM、 定時(shí)計(jì)數(shù)器、串行口、外中斷系統(tǒng)可繼續(xù)工作，掉電模式凍結(jié)振蕩器而保存RAM的數(shù)據(jù)，禁止電路的其他功能直至外中斷激活或硬件復(fù)位。該電路具有 PDIP、 TQFP和PLCC等封 裝形式，以適應(yīng)不同產(chǎn)品的設(shè)計(jì)要求。 常用的 AT89S52封裝 電路為 PDIP形式，其圖如圖 42所示。 23 圖 42 AT89S52封裝圖 AT89S52具有 32個(gè)可編程 I/O端口，其中， P0口和 P1口的前六個(gè)引腳分別接 12個(gè)舵機(jī)，來(lái)控制舵機(jī)的運(yùn)轉(zhuǎn)， P3口前兩個(gè)引腳接觸位開(kāi)關(guān)。如表 41所示。 表 41 I/O引腳分配表 引腳端口 功能分配 接左邊的六個(gè)舵機(jī) 接右邊的六個(gè)舵機(jī) 接觸位開(kāi)關(guān) 舵機(jī)模塊設(shè)計(jì) （ 1）舵機(jī)的 概述 舵機(jī)最早 出現(xiàn)在航模運(yùn)動(dòng)中。在航空模型中，飛行機(jī)的飛行姿態(tài)是通過(guò)調(diào)節(jié)發(fā)動(dòng)機(jī)和各個(gè)控制舵面來(lái)實(shí)現(xiàn)的。舉個(gè)簡(jiǎn)單的四通飛機(jī)來(lái)說(shuō)，飛機(jī)上有以下幾個(gè)地方需要控制： ，來(lái)控制發(fā)動(dòng)機(jī)的拉力（或推力）； （安裝在飛機(jī)機(jī)翼后緣），用來(lái)控制飛機(jī)的橫滾運(yùn)動(dòng)； 24 ，用來(lái)控制飛機(jī)的俯仰角； ，用來(lái)控制飛機(jī)的偏航角； 遙控器有四個(gè)通道，分別對(duì)應(yīng)四個(gè)舵機(jī)，而舵機(jī)又通過(guò)連桿等傳動(dòng)元件帶動(dòng)舵面的轉(zhuǎn)動(dòng)，從而改變飛機(jī)的運(yùn)動(dòng)狀態(tài)。舵機(jī)因此得名：控制舵面的伺服電機(jī)。 不僅在航模飛機(jī)中，在其他的 模型運(yùn)動(dòng)中都可以看到它的應(yīng)用：船模上用來(lái)控制尾舵，車(chē)模中用來(lái)轉(zhuǎn)向等等。由此可見(jiàn)，凡是需要操作性動(dòng)作時(shí)都可以用舵機(jī)來(lái)實(shí)現(xiàn) [11]。 傳統(tǒng)舵機(jī)的控制方式以 20ms 為一個(gè)周期，用一個(gè) 177。 的脈沖來(lái)控制舵機(jī)的角度變化，隨著以 CPU 為主的數(shù)字革命的興起，現(xiàn)在的舵機(jī)已成為模擬舵機(jī)和數(shù)字舵機(jī)并存的局面，但即使是現(xiàn)在的數(shù)字舵機(jī)，其控制接口也還是傳統(tǒng)的 177。 的模擬控制接口，只是控制芯片不再是普通的模擬芯片而已；不能完全發(fā)揮現(xiàn)代數(shù)字化控制的優(yōu)勢(shì)，這在傳統(tǒng)的遙控競(jìng)賽等領(lǐng)域，為了保持產(chǎn)品 的兼容性，不得不保留模擬接口，而在一些新興的領(lǐng)域完全可以采用新型的全數(shù)字接口的純數(shù)字舵機(jī)。純數(shù)字舵機(jī)采用全新的單線雙工通訊協(xié)議，不僅能執(zhí)行普通舵機(jī)的全部功能，還可以作為一個(gè)角度傳感器，監(jiān)測(cè)舵機(jī)的實(shí)際位置，而且可以多個(gè)舵機(jī)并聯(lián)互不影響。在未來(lái)的自動(dòng)化控制領(lǐng)域有著不可估量的優(yōu)勢(shì)。采用純數(shù)字舵機(jī)構(gòu)建的自動(dòng)化控制系統(tǒng)，不僅可以大幅提升系統(tǒng)性能，而且可以降低系統(tǒng)的生產(chǎn)維護(hù)成本，提高產(chǎn)品性價(jià)比，增強(qiáng)市場(chǎng)競(jìng)爭(zhēng)力。 （ 2）舵機(jī)的 結(jié)構(gòu)和控制 一般來(lái)講，舵機(jī)主要由以下幾個(gè)部分組成， 舵盤(pán)、減速齒輪組、位置反饋電位計(jì) 5k、直流 電機(jī)、控制電路板等。 工作原理：控制電路板接受來(lái)自信號(hào)線的控制信號(hào)（具體信號(hào)待會(huì)再講），控制電機(jī)轉(zhuǎn)動(dòng)，電機(jī)帶動(dòng)一系列齒輪組，減速后傳動(dòng)至輸出舵盤(pán)。舵機(jī)的輸出軸和位置反饋電位計(jì)是相連的，舵盤(pán)轉(zhuǎn)動(dòng)的同時(shí)，帶動(dòng)位置反饋電位計(jì)，電位計(jì)將輸出一個(gè)電壓信號(hào)到控制電路板，進(jìn)行反饋，然后控制電路板根據(jù)所在位置決定電機(jī)的轉(zhuǎn)動(dòng)方向和速度，從而達(dá)到目標(biāo)停止。 舵機(jī)的控制一般需要一個(gè) 20ms 左右的時(shí)基脈沖，該脈沖的高電平部分一般~ 范圍內(nèi)的角度控制脈沖部分。以 180度角度伺服為例，那么對(duì)應(yīng)的控制關(guān)系 如表 42所示。 表 42 時(shí)基脈沖與舵機(jī)角度對(duì)應(yīng) 表 脈沖值（ m