1034328994兩足機器人課程設(shè)計報告

1、兩足機器人課程設(shè)計報告 目錄目錄1第一章 緒論2第二章：硬件設(shè)計32.1硬件介紹32.1.1傳感器介紹32.1.2舵機介紹52.2結(jié)構(gòu)設(shè)計62.2.1 機器人結(jié)構(gòu)示意圖62.3 驅(qū)動器的選擇72.3.1驅(qū)動方式72.3.2電動機驅(qū)動8第三章 軟件設(shè)計93.1步態(tài)設(shè)計103.2控制策略16第四章 設(shè)計總結(jié)17參考文獻：18第一章 緒論隨著社會的不斷發(fā)展，各行各業(yè)的分工越來越明細，尤其是在現(xiàn)代化的大產(chǎn)業(yè)中，有的人每天就只管擰一批產(chǎn)品的同一個部位上的一個螺母，有的人整天就是接一個線頭，就像電影摩登時代中演示的那樣，人們感到自己在不斷異化，各種職業(yè)病逐漸產(chǎn)生，于是人們強烈希望用某種機器代替自己工作，因

2、此人們研制出了機器人，用以代替人們?nèi)ネ瓿赡切﹩握{(diào)、枯燥或是危險的工作。由于機器人的問世，使一部分工人失去了原來的工作，于是有人對機器人產(chǎn)生了敵意?！皺C器人上崗，人將下崗?！辈粌H在我國，即使在一些發(fā)達國家如美國，也有人持這種觀念。其實這種擔心是多余的，任何先進的機器設(shè)備，都會提高勞動生產(chǎn)率和產(chǎn)品質(zhì)量，創(chuàng)造出更多的社會財富，也就必然提供更多的就業(yè)機會，這已被人類生產(chǎn)發(fā)展史所證明。任何新事物的出現(xiàn)都有利有弊，只不過利大于弊，很快就得到了人們的認可。比如汽車的出現(xiàn)，它不僅奪了一部分人力車夫、挑夫的生意，還常常出車禍，給人類生命財產(chǎn)帶來威脅。雖然人們都看到了汽車的這些弊端，但它還是成了人們?nèi)粘Ｉ钪斜夭?/p>

3、可少的交通工具。英國一位著名的政治家針對關(guān)于工業(yè)機器人的這一問題說過這樣一段話：“日本機器人的數(shù)量居世界首位，而失業(yè)人口最少，英國機器人數(shù)量在發(fā)達國家中最少，而失業(yè)人口居高不下”，這也從另一個側(cè)面說明了機器人是不會搶人飯碗的。機器人技術(shù)建立在多學科發(fā)展的基礎(chǔ)上，具有應用領(lǐng)域廣，技術(shù)新，學科綜合與交叉性強等特點。傳統(tǒng)的機器人技術(shù)涉及機械，電子，自動控制等學科；現(xiàn)代機器人技術(shù)則綜合了更加廣泛的學科和技術(shù)領(lǐng)域，如計算機技術(shù)，仿生學，生物工程，人工智能，材料，結(jié)構(gòu)，微機械，信息工程，遙感等。各種各樣的機器人不但已經(jīng)成為現(xiàn)代高科技的應用載體，而且自身也發(fā)展成為一個相對獨立的研究與交叉應用領(lǐng)域，形成了特有

4、的理論研究和學術(shù)發(fā)展方向，具有鮮明的學科特色。可以預見，機器人技術(shù)將會滲透到未來生活的方方面面，而且從瞬息萬變的社會發(fā)展中已經(jīng)可以切身的感受到-機器人的時代已經(jīng)悄悄來臨。第二章：硬件設(shè)計2.1硬件介紹2.1.1傳感器介紹根據(jù)檢測對象的不同可分為內(nèi)部傳感器和外部傳感器。 a. 內(nèi)部傳感器：用來檢測機器人本身狀態(tài)（如手臂間角度）的傳感器。多為檢測位置和角度的傳感器。 b.外部傳感器：用來檢測機器人所處環(huán)境（如是什么物體，離物體的距離有多遠等）及狀況（如抓取的物體是否滑落）的傳感器。具體有物體識別傳感器、物體探傷傳感器、接近覺傳感器、距離傳感器、力覺傳感器，聽覺傳感器等。 本課題外部僅應用到了紅外接

5、近傳感器，所以這里只對它進行介紹。紅外接近傳感器俗稱光電開關(guān)。它是利用被檢測無對光線的遮擋或反射有同步回路選通電路，從而選擇物體有無的。光電開關(guān)將輸入電流在發(fā)射器上轉(zhuǎn)換為光信號射出，接受其再根據(jù)接收到的光線的強弱或有無目標物體進行探測。工作原理如下圖所示。多數(shù)光電開關(guān)選用的是波長接近可見光的紅外線光波型，因此也稱為紅外開關(guān)。由于紅外線是不可見光，紅外探頭體積小巧，隱蔽性非常高，所以各種規(guī)格的紅外開關(guān)，紅外測距傳感器廠常用于安放保衛(wèi)領(lǐng)域。在好萊塢電影里，我們常常看到金庫，博物館里有一條條紅色的光線，達到門應用各種手段避開這些光線，最終盜得各種財寶。實際上紅外線是不可見的，電影里采用了普通紅色光線

6、冒充紅外線，以烘托緊張的故事情節(jié)，我們對此大可以笑而過，不可收到她的誤導。圖2.1.1（a）紅外接近傳感器工作原理光電開關(guān)可以分類如下：1.漫反射是光電開關(guān)：它是一種集發(fā)射器和接收器于一體的傳感器，當有被檢測物體被檢測物體經(jīng)過時，物體將光電開關(guān)發(fā)射器發(fā)射的足夠量的光線反射到接收器，于是光電開關(guān)便產(chǎn)生了開關(guān)信號。當被檢測物體的表面光亮或其反光率極高時，漫反射式的光電開關(guān)是首選的檢測模式。2.經(jīng)反射式的光電開關(guān)：它集發(fā)射器與接收器于一體，光電開關(guān)發(fā)射器發(fā)出的光線經(jīng)過反射鏡反射回接收器，當被檢測物體經(jīng)過且完全阻斷光線時，光電開關(guān)就產(chǎn)生了檢測開關(guān)信號。3.對射式光電開關(guān)：它包含了在結(jié)構(gòu)上相互分離且光軸

7、相對放置的接收器和發(fā)射器，發(fā)射器發(fā)出的光線直接進入接收器，當被檢測物體進入發(fā)射器與接收器之間且阻斷光線時，光電開關(guān)就產(chǎn)生可開關(guān)信號。當檢測物體為不透明時，對射式開關(guān)是最可靠的檢測裝置。4.槽式光電開關(guān)：它通常采用標準的u字型結(jié)構(gòu)，其發(fā)射器和接收器分別位于u型槽的兩邊，并形成一光軸，當被檢測物體經(jīng)過u型槽且阻斷光軸時，光電開關(guān)就產(chǎn)生了開關(guān)量信號。槽式光電開關(guān)比較適合檢測高速運動的物體，并且它能分辨透明與半透明物體，使用安全可靠。5.光纖式光電開關(guān)：它采用塑料或玻璃光線傳感器來引導光線，可以對距離遠的被檢測物體進行檢測，通常光線傳感器分為對射式和漫反射式。本設(shè)計所使用的紅外光電開關(guān)型號為e18-b

8、0，規(guī)格數(shù)據(jù)為：vcc：5v。工作電流：小于100ma。輸出形式：npn三極管oc輸出。封裝形式：工程塑料。圖2.1.1（b）紅外接近傳感器紅外接近傳感器是開關(guān)量傳感器，接io0io11的任意一個接口都可以通過northstar進行疏枝讀取和編程。由于輸出是開關(guān)量，只能判斷在測量距離內(nèi)有無障礙物，不能給出障礙物的實際距離。但是該傳感器帶有一個靈敏度調(diào)節(jié)旋鈕，可以調(diào)節(jié)傳感觸發(fā)的距離。2.1.2舵機介紹舵機，顧名思義，是控制多面的電機。舵機的出現(xiàn)最早是作為遙控模型控制多面、油門等機構(gòu)的動力來源，但是由于舵機具有很多優(yōu)秀的特性，在制作機器人時也時常能看到它的應用。舵機最早出現(xiàn)在航模運動中。在航空模型

9、中，飛行機的飛行姿態(tài)是通過調(diào)節(jié)發(fā)動機和各個控制舵面來實現(xiàn)的。不僅在航模飛機中，在其他的模型運動中都可以看到它的應用，如船模上用它來控制舵，車磨重用他來轉(zhuǎn)向等。一般來講，多極主要由舵盤、減速齒輪組、位置反饋點危機、直流電機、控制電路板等幾部分組成。 舵機是一種位置伺服的驅(qū)動器，轉(zhuǎn)動范圍一般不能超過1800，適用于那些角度不斷變化并可以保持的驅(qū)動當中，如機器人的關(guān)節(jié)、飛機的舵面等。不過也有一些特殊的舵機，轉(zhuǎn)動范圍可達到5圈之多，主要用于模型帆船的收帆，俗稱帆舵。2.2結(jié)構(gòu)設(shè)計 機器人的機械、電氣和控制結(jié)構(gòu)千差萬別。這次的雙足追光機器人有眼利用的是紅外接近傳感器，手臂利用兩個舵機來驅(qū)動，雙足用四個舵

10、機驅(qū)動。把手臂、雙足、和眼睛固定在控制器上。2.2.1 機器人結(jié)構(gòu)示意圖圖2.2.1 機器人結(jié)構(gòu)示意圖 2.2.2 完成的機器人圖2.2.2 完整機器人2.3 驅(qū)動器的選擇2.3.1驅(qū)動方式 驅(qū)動方式有三種：液壓式、氣動式、電動式。 液壓驅(qū)動方式的輸出力和功率更大，能構(gòu)成伺服機構(gòu)，常用于大型機器人關(guān)節(jié)的驅(qū)動。氣動式驅(qū)動多用于開關(guān)控制和順序控制的機器人。本次課程設(shè)計采用的是電動機驅(qū)動。2.3.2電動機驅(qū)動 電動機驅(qū)動可分為普通交流電動機驅(qū)動，交直流伺服電動機驅(qū)動和步進電動機驅(qū)動。中型或重型機器人。伺服電動機和步進電動機輸出力矩相對小，控制性能好，可實現(xiàn)速度和位置的精確控制，適用于中小型機器人。交

11、、直流伺服電動機一般用于閉環(huán)控制系統(tǒng)，而步進電動機則主要用于開環(huán)控制系統(tǒng)，一般用于速度和位置精度要求不高的場合。直流伺服電動機結(jié)構(gòu)和原理與普通直流電動機的結(jié)構(gòu)和原理沒有根本區(qū)別。按照勵磁方式的不同，直流伺服電動機分為永磁式直流伺服電動機和電磁式直流伺服電動機。永磁式直流伺服電動機的磁極由永久磁鐵制成，不需要勵磁繞組和勵磁電源。電磁式直流伺服電動機一般采用他勵結(jié)構(gòu)，磁極由勵磁繞組構(gòu)成，通過單獨的勵磁電源供電。 按照轉(zhuǎn)子結(jié)構(gòu)的不同，直流伺服電動機分為空心杯形轉(zhuǎn)子直流伺服電動機和無槽電樞直流伺服電動機?？招谋无D(zhuǎn)子直流伺服電動機由于其力能指標較低，現(xiàn)在已很少采用。無槽電樞直流伺服電動機的轉(zhuǎn)子是直徑較

12、小的細長型圓柱鐵芯，通過耐熱樹脂將電樞繞組固定在鐵芯上，具有散熱好、力能指標高、快速性好的特點?？刂品绞剑?直流電動機的控制方式有兩種：一種稱為電樞控制，在電動機的勵磁繞組上加上恒壓勵磁，將控制電壓作用于電樞繞組來進行控制；一種稱為磁場控制，在電動機的電樞繞組上施加恒壓，將控制電壓作用于勵磁繞組來進行控制。交流伺服電機的結(jié)構(gòu)交流伺服的電動機結(jié)構(gòu)主要可分為兩部分，即定子部分和轉(zhuǎn)子部分。其中定子的結(jié)構(gòu)與旋轉(zhuǎn)變壓器的定子基本相同，在定子鐵心中也安放著空間互成90度電角度的兩相繞組。其中一組為激磁繞組，另一組為控制繞組，交流伺服電動機一種兩相的交流電動機。 交流伺服電動機使用時，激磁繞組兩端施加恒定的

13、激磁電壓uf，控制繞組兩端施加控制電壓uk。當定子繞組加上電壓后，伺服電動機很快就會轉(zhuǎn)動起來。 通入勵磁繞組及控制繞組的電流在電機內(nèi)產(chǎn)生一個旋轉(zhuǎn)磁場，旋轉(zhuǎn)磁場的轉(zhuǎn)向決定了電機的轉(zhuǎn)向，當任意一個繞組上所加的電壓反相時，旋轉(zhuǎn)磁場的方向就發(fā)生改變，電機的方向也發(fā)生改變。 為了在電機內(nèi)形成一個圓形旋轉(zhuǎn)磁場，要求激磁電壓uj和控制電壓uk之間應有90度的相位差，常用的方法有： 1） 利用三相電源的相電壓和線電壓構(gòu)成90度的移相 2） 利用三相電源的任意線電壓3） 采用移相網(wǎng)絡(luò) 4） 在激磁相中串聯(lián)電容器（二）交流伺服電機的優(yōu)良特性1 控制精度高 步進電機 步進的步距角一般為18。(兩相)或072。(五相

14、)，而交流伺服電機的精度取決于電機編碼器的精度。以伺服電機為例，其編碼器為l6位，驅(qū)動器每接收2 =65 536個脈沖，電機轉(zhuǎn)一圈，其脈沖當量為360/65 536=0，0055 ；并實現(xiàn)了位置的閉環(huán)控制從根本上克服了步進電機的失步問題。 2 矩頻特性好 步進電機的輸出力矩隨轉(zhuǎn)速的升高而下降，且在較高轉(zhuǎn)速時會急劇下降，其工作轉(zhuǎn)速一般在每分鐘幾十轉(zhuǎn)到幾百轉(zhuǎn)。而交流伺服電機在其額定轉(zhuǎn)速(一般為2000r/min或3000r/rain)以內(nèi)為恒轉(zhuǎn)矩輸出，在額定轉(zhuǎn)速以e為恒功率輸出。 3 加速性能好 步進電機空載時從靜止加速到每分鐘幾百轉(zhuǎn)，需要200400ms：交流伺服電機的加速性能較好由于電樞控制的

15、特性好，電樞控制中回路電感小，響應快，在自動控制系統(tǒng)中多采用電樞控制。在會追光的雙足機器人中，我們選用的是，電動機驅(qū)動。 第三章 軟件設(shè)計3.1步態(tài)設(shè)計雙足機器人前進分為五步，第一步，左足前進，右手臂朝后；第二步，左足恢復中位狀態(tài)，手臂也恢復中位狀態(tài)；第三步，右足朝前，左手臂朝后；第四步，右足和左手臂恢復中位；第五步，重復第一步，實現(xiàn)循環(huán)。追光的步態(tài)設(shè)計：在獲取了兩側(cè)的光強數(shù)值后，便可以開始設(shè)計程序的邏輯框架。將情況分為3種：狀況一，左側(cè)光比右側(cè)光強；狀況二，左側(cè)光比右側(cè)弱，狀況三，左右側(cè)光強近似相等。這三種情況在邏輯上較好區(qū)分，并且覆蓋了所有可能出現(xiàn)的狀態(tài)。在程序的主程序里，用三個條件來區(qū)分

16、這三種情況。作為左右光強比較的中間變量，對兩側(cè)光強的差值diff進行計算：diff=left-right,三種狀況的區(qū)分將圍繞差值diff進行：狀況一，左側(cè)光強比右側(cè)光強：diff50狀況二，左側(cè)光強比右側(cè)光弱：diff50狀況三，左側(cè)光強與右側(cè)光接近相等：diff=50在判斷條件里，使用50這個數(shù)值，是考慮到不同的光強傳感器采集同樣的光照強度數(shù)據(jù)可能存在著差異，因此給出一個區(qū)間而不是一個數(shù)據(jù)在控制器運行的過程中，如果在短時間內(nèi)向多個舵機發(fā)送大量的控制指令，會造成總線的擁堵，導致舵機收到新指令的時間延后，最直觀的表現(xiàn)就是指令發(fā)送和舵機運動之間存在一個延時。為了保持舵機數(shù)據(jù)總線的流暢，讓舵機有時

17、間執(zhí)行接收到的指令，同常在兩次發(fā)送指令之間添加延時追光機器人的程序邏輯如下圖：while(1)獲取光強傳感ad值 執(zhí)行一個左轉(zhuǎn)完整動作左邊比較亮執(zhí)行一個右轉(zhuǎn)完整動作右邊比較亮執(zhí)行一個前進完整動作左右亮度接近圖3.1（a）程序邏輯由程序流程圖得出的程序如下： 圖3.1（b）程序流程圖- 17 -程序代碼如下：#include apps/systemtask.huint8 servo_mapping10 = 1,2,3,4,5,6,7,8,9,10;int main() int diff = 0; int left = 0; int right = 0; mfinit(); mfinitservo

18、mapping(&servo_mapping0,10); mfsetportdirect(0x00000fff); mfsetservomode(1,0); mfsetservomode(2,0); mfsetservomode(3,0); mfsetservomode(4,0); mfsetservomode(5,0); mfsetservomode(6,0); mfsetservomode(7,0); mfsetservomode(8,0); mfsetservomode(9,0); mfsetservomode(10,0); while (1) left = mfgetad(0); ri

19、ght = mfgetad(1); diff = left - right; if (diff=-50)&(diff50) mfsetservopos(1,512,512); mfsetservopos(2,512,512); mfsetservopos(3,512,512); mfsetservopos(4,512,512); mfsetservopos(5,480,512); mfsetservopos(6,512,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfse

20、tservopos(10,512,512); mfservoaction(); delayms(2000); mfsetservopos(1,512,512); mfsetservopos(2,480,512); mfsetservopos(3,512,512); mfsetservopos(4,512,512); mfsetservopos(5,520,512); mfsetservopos(6,650,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfsetservop

21、os(10,512,512); mfservoaction(); delayms(2000); /forward 1 mfsetservopos(1,512,512); mfsetservopos(2,480,512); mfsetservopos(3,600,512); mfsetservopos(4,512,512); mfsetservopos(5,520,512); mfsetservopos(6,650,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfsetse

22、rvopos(10,512,512); mfservoaction(); delayms(2000); /2 mfsetservopos(1,512,512); mfsetservopos(2,512,512); mfsetservopos(3,512,512); mfsetservopos(4,512,512); mfsetservopos(5,480,512); mfsetservopos(6,512,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfsetservop

23、os(10,512,512); mfservoaction(); delayms(2000); if (diff-50) mfsetservopos(1,512,512); mfsetservopos(2,512,512); mfsetservopos(3,512,512); mfsetservopos(4,512,512); mfsetservopos(5,480,512); mfsetservopos(6,512,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfset

24、servopos(10,512,512); mfservoaction(); delayms(2000); mfsetservopos(1,512,512); mfsetservopos(2,480,512); mfsetservopos(3,512,512); mfsetservopos(4,512,512); mfsetservopos(5,520,512); mfsetservopos(6,650,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfsetservopo

25、s(10,512,512); mfservoaction(); delayms(2000); /forward 1 mfsetservopos(1,512,512); mfsetservopos(2,480,512); mfsetservopos(3,600,512); mfsetservopos(4,512,512); mfsetservopos(5,520,512); mfsetservopos(6,650,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfsetser

26、vopos(10,512,512); mfservoaction(); delayms(2000); /2 mfsetservopos(1,512,512); mfsetservopos(2,512,512); mfsetservopos(3,512,512); mfsetservopos(4,512,512); mfsetservopos(5,480,512); mfsetservopos(6,512,512); mfsetservopos(7,512,512); mfsetservopos(8,512,512); mfsetservopos(9,512,512); mfsetservopos(1