智能移動(dòng)機(jī)器人

《智能移動(dòng)機(jī)器人》由會(huì)員分享，可在線閱讀，更多相關(guān)《智能移動(dòng)機(jī)器人（8頁(yè)珍藏版）》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。

1、智能移動(dòng)機(jī)器人 近年來(lái)，隨著機(jī)器人研究的不斷發(fā)展，機(jī)器人技術(shù)開(kāi)始源源不斷地向人類活動(dòng)的各 個(gè)領(lǐng)域滲透，結(jié)合這些領(lǐng)域的應(yīng)用特點(diǎn)，各種各樣的具有不同功能的機(jī)器人被研制出來(lái), 并且在不同的應(yīng)用領(lǐng)域都得到了廣泛的應(yīng)用。 本文主要設(shè)計(jì)一個(gè)配置機(jī)械手的智能移動(dòng)機(jī)器人，可以調(diào)速、轉(zhuǎn)彎、抓取物體。涉 及到雙目攝像頭定位、激光測(cè)距、電機(jī)控制、壓力傳感器等技術(shù)。 一、系統(tǒng)總體結(jié)構(gòu)圖 機(jī)器人系統(tǒng)主要由機(jī)械系統(tǒng)、驅(qū)動(dòng)控制系統(tǒng)、視覺(jué)系統(tǒng)、傳感器系統(tǒng)、上位機(jī)系統(tǒng)、 電源系統(tǒng)以及人機(jī)交互系統(tǒng)等組成。 系統(tǒng)總體結(jié)構(gòu)圖如下： A 圖1系統(tǒng)總體結(jié)構(gòu)圖 智能機(jī)器人平臺(tái)采用了主從結(jié)構(gòu)的分布式處理方式，由上位機(jī)

2、系統(tǒng)來(lái)協(xié)調(diào)控制各個(gè) 子模塊系統(tǒng)。各個(gè)子系統(tǒng)都有自己的數(shù)據(jù)處理機(jī)制，數(shù)據(jù)處理都在本模塊的 DSP處理器 中完成。上位機(jī)只是負(fù)責(zé)數(shù)據(jù)融合、任務(wù)分解、策略選擇制定、協(xié)調(diào)控制各子模塊等工 作。當(dāng)上位機(jī)需要某個(gè)模塊的數(shù)據(jù)時(shí)，子模塊向上位機(jī)提供該模塊經(jīng)過(guò)處理以后的數(shù)據(jù)。 由于大量的數(shù)據(jù)處理都在各個(gè)子模塊中完成， 上位機(jī)得到的都是經(jīng)過(guò)處理后的小量數(shù)據(jù)， 大大減少了上位機(jī)的負(fù)擔(dān)。采用這種方式既提高了上位機(jī)的效率，又增加了系統(tǒng)的穩(wěn)定 性，方便系統(tǒng)的維護(hù)。 二、機(jī)械手 該機(jī)械手的設(shè)計(jì)仿照人類手臂的構(gòu)造，總共有五個(gè)自由度，包括抬手臂轉(zhuǎn)動(dòng)關(guān)節(jié)， 肩轉(zhuǎn)動(dòng)關(guān)節(jié)，肘轉(zhuǎn)動(dòng)關(guān)節(jié)，腕轉(zhuǎn)動(dòng)關(guān)節(jié)，手爪旋轉(zhuǎn)關(guān)節(jié)與手爪開(kāi)閉關(guān)節(jié)。這

3、種多自由度 的設(shè)計(jì)使得機(jī)械手具有較大的靈活度，以適應(yīng)抓取不同目標(biāo)物體的要求。 三、控制系統(tǒng) 1、 感知系統(tǒng) 感知系統(tǒng)也就是傳感器系統(tǒng)，本智能機(jī)器人系統(tǒng)的傳感器系統(tǒng)可以只包含兩個(gè)傳感 器，一個(gè)是測(cè)障、測(cè)距用激光傳感器，一個(gè)是抓物時(shí)壓力感測(cè)的壓力傳感器。 紅外測(cè)距傳感器（簡(jiǎn)稱 PSD： Poison Sensitive Detect。）： 通常采用光學(xué)三角測(cè)量方法來(lái)確定機(jī)器人同物體之間的距離：傳感器的紅外發(fā)光管 發(fā)出紅外光，當(dāng)紅外光沒(méi)有碰到障礙的時(shí)候，紅外光保持前行；當(dāng)紅外光碰到障礙的時(shí) 候，紅外光反射回來(lái)，并進(jìn)入探測(cè)器。這樣，在反射點(diǎn)，發(fā)射器，探測(cè)器之間形成一個(gè) 三角形，探測(cè)器通過(guò)鏡面

4、反射，將紅外光射入一個(gè)線性 CCD中，由CCD測(cè)量反射光的 角度，并由角度的大小來(lái)計(jì)算障礙物的距離。本機(jī)器人系統(tǒng)配置 4路PSD傳感器，分別 以接近于90度的角度間距安裝于機(jī)器人的前、后、左、右四個(gè)方向上和機(jī)械臂抓手的手 掌內(nèi)。 圖2 PSD傳感器位置示意圖 壓力傳感器： 測(cè)得與物體接觸的壓力值返回給 DSP分析處理：是否繼續(xù)抓緊動(dòng)作。裝在機(jī)械臂抓 手的每個(gè)手指上。 傳感器系統(tǒng)結(jié)構(gòu)圖 壓力傳感器1 DSP 激光傳感器5（手掌） 激光傳感器3 （左） 壓力傳感器5 ——> 激光傳感器4 （右） 圖3傳感器系統(tǒng)結(jié)構(gòu) 2、 控制器：Arm9 ARM9

5、系列微處理器主要應(yīng)用于無(wú)線設(shè)備， ARM9系列處理器可為要求苛刻、成本 敏感的嵌入式應(yīng)用提供可靠的高性能和靈活性。 嵌入式系統(tǒng)（ES）是計(jì)算機(jī)技術(shù)、通信技術(shù)、半導(dǎo)體技術(shù)、微電子技術(shù)、語(yǔ)音圖像數(shù) 據(jù)傳輸技術(shù)，甚至傳感器等先進(jìn)技術(shù)和具體應(yīng)用對(duì)象相結(jié)合后的系統(tǒng)，其是硬件和軟件 緊密捆綁在一起的系統(tǒng)。將嵌入式系統(tǒng)應(yīng)用于機(jī)器人的設(shè)計(jì)中， 對(duì)機(jī)器人的性能智能化、 網(wǎng)絡(luò)化、小型化都有了明顯提高。 機(jī)器人需要有智能較高的自動(dòng)控制性能與可靠的機(jī)械控制性能的同時(shí)保證。在此以 ARM9處理器為核心，對(duì)基于嵌入式系統(tǒng)的智能機(jī)器人進(jìn)行了設(shè)計(jì)。 攝像頭雙目定位系統(tǒng)： 由雙目立體視覺(jué)技術(shù)計(jì)算出目標(biāo)物在視覺(jué)坐標(biāo)系中

6、的三維坐標(biāo)，并將該坐標(biāo)轉(zhuǎn)換到 機(jī)器人坐標(biāo)系，然后根據(jù)該坐標(biāo)控制機(jī)械手實(shí)現(xiàn)自動(dòng)定位。 人通過(guò)雙眼觀察客觀的三維世界的景物，通過(guò)幾何光學(xué)的投影，像點(diǎn)在左右兩眼視 網(wǎng)膜上的投影位置不同，這種兩眼視網(wǎng)膜上的位置差就稱之為雙目視差 （Bi no cular Disparity），簡(jiǎn)稱視差。人能有物體的遠(yuǎn)近感知，就是因?yàn)橛羞@個(gè)視差，再經(jīng)過(guò)大腦的加 工形成的?；谝暡罾碚摰碾p目立體視覺(jué)，就是運(yùn)用兩個(gè)相同的攝像機(jī)對(duì)同一景物從不 同位置成像，獲得景物的立體圖像對(duì)，通過(guò)各種算法匹配出相應(yīng)像點(diǎn)，從而計(jì)算出視差， 然后采用基于三角測(cè)量的方法恢復(fù)深度信息?，F(xiàn)有的絕大多數(shù)雙目立體視覺(jué)系統(tǒng)均采用 這項(xiàng)原理。 兩個(gè)攝像

7、頭被安裝在機(jī)械手小臂上，用來(lái)充當(dāng)雙目立體視覺(jué)系統(tǒng)的雙目。為實(shí)現(xiàn)機(jī) 械手目標(biāo)自動(dòng)定位的功能。兩攝像頭將攝取的目標(biāo)物的圖像傳遞到圖像采集模塊，由主 控器傳送至上位機(jī)的立體視覺(jué)子系統(tǒng)通過(guò)該兩幅二維圖像，計(jì)算出目標(biāo)物在攝像頭坐標(biāo) 系中的三維坐標(biāo)，將其轉(zhuǎn)換為在機(jī)器人坐標(biāo)系中的三維坐標(biāo)，并將其傳給機(jī)器人本體上 的Arm9，并完成手臂的運(yùn)動(dòng)控制，控制手臂運(yùn)動(dòng)到目標(biāo)物位置，從而實(shí)現(xiàn)自動(dòng)目標(biāo)定位 的功能。系統(tǒng)結(jié)構(gòu)如下圖所示。 目標(biāo)物體 7V 抓取 機(jī)械手 V； 圖4雙目定位系統(tǒng)配置圖 3、 驅(qū)動(dòng)系統(tǒng) 輪速控制驅(qū)動(dòng)： 驅(qū)動(dòng)系統(tǒng)主要是電機(jī)的驅(qū)動(dòng)。電機(jī)是移動(dòng)機(jī)器人的動(dòng)力源泉，目前移動(dòng)機(jī)器人領(lǐng)域

8、 應(yīng)用較多的是步進(jìn)電機(jī)和直流電機(jī)兩種。 步進(jìn)電動(dòng)機(jī)是一種將電脈沖信號(hào)轉(zhuǎn)換成機(jī)械角位移模擬量的控制電機(jī)，其輸出的位 移大小與輸入脈沖個(gè)數(shù)成正比且時(shí)間上與脈沖同步，通過(guò)改變脈沖頻率調(diào)節(jié)步進(jìn)電機(jī)轉(zhuǎn) 速。 直流電機(jī)采用PWM控制，只需要通過(guò)軟件改變 pwm波的占空比就可實(shí)現(xiàn)調(diào)速，這對(duì) 提高移動(dòng)機(jī)器人運(yùn)動(dòng)中的靈活性非常有用。 考慮使用嵌入式Arm作為控制器時(shí)設(shè)計(jì)可靠性，驅(qū)動(dòng)電機(jī)就選用直流電機(jī) 直流電機(jī)驅(qū)動(dòng)系統(tǒng)結(jié)構(gòu)如下圖 圖5 Arm控制電機(jī)系統(tǒng)原理 部分電機(jī)控制驅(qū)動(dòng)電路 卜CP3 岀神at TN2 OUT2 IS EH A L29曲 KEH B OUTS IN3 OUT

9、4 EK B DID Ml 電直 M2 電楓 SV 47t^f7L6y_-_ 電機(jī)PWM丄 6 ■&機(jī)if吠* L ? ] 】鼻 電正広疋 10 電機(jī)FWM2 ]1 ±L^LlEE*2 92 電機(jī)正賁1 EH A OUT] 1N4 圖6電機(jī)驅(qū)動(dòng)電路圖 以下是電機(jī)控制系統(tǒng)結(jié)構(gòu)圖: 圖7電機(jī)控制系統(tǒng)結(jié)構(gòu)圖 由于直流電機(jī)的開(kāi)環(huán)控制技術(shù)不能消除轉(zhuǎn)速差率以及不能滿足實(shí)時(shí)性的要求，實(shí)際 中常采用閉環(huán)控制技術(shù)來(lái)調(diào)節(jié)轉(zhuǎn)速。 電機(jī)的閉環(huán)控制系統(tǒng)可以是單閉環(huán)系統(tǒng)（速度閉環(huán)）, 也可以是雙閉環(huán)（速度環(huán)和電流環(huán)）。轉(zhuǎn)速負(fù)反饋單閉環(huán)控制系統(tǒng)可以保證系

10、統(tǒng)穩(wěn)定的條 件下實(shí)現(xiàn)轉(zhuǎn)速無(wú)靜差，但是如果對(duì)系統(tǒng)的動(dòng)態(tài)性能要求較高的話，如快速啟制動(dòng)，單閉 環(huán)系統(tǒng)就很難滿足要求，這是因?yàn)閱伍]環(huán)系統(tǒng)不能完全按照需求來(lái)控制動(dòng)態(tài)過(guò)程的電流 和轉(zhuǎn)矩。為了改善動(dòng)態(tài)性，就要在速度反饋單閉環(huán)控制的基礎(chǔ)上再引入電流反饋來(lái)控制 系統(tǒng)動(dòng)態(tài)過(guò)程中的電流和轉(zhuǎn)矩，系統(tǒng)采用雙閉環(huán)控制系統(tǒng) （外速度環(huán)和內(nèi)電流環(huán)）。 機(jī)械臂伺服電機(jī)驅(qū)動(dòng)： 機(jī)械臂主要由手部和運(yùn)動(dòng)機(jī)構(gòu)組成。手部是用來(lái)抓持目標(biāo)物體，運(yùn)動(dòng)機(jī)構(gòu)使手部完 成各種轉(zhuǎn)動(dòng)、移動(dòng)或復(fù)合運(yùn)動(dòng)來(lái)實(shí)現(xiàn)規(guī)定的動(dòng)作。為了抓取空間中任意位置和方位的物 體,需有五個(gè)自由度，用五個(gè)舵機(jī)來(lái)控制。抬手臂（舵機(jī)1驅(qū)動(dòng)）、轉(zhuǎn)手臂（舵機(jī)2驅(qū)動(dòng)）、 肘轉(zhuǎn)（舵機(jī)3驅(qū)

11、動(dòng)）、腕轉(zhuǎn)（舵機(jī)4驅(qū)動(dòng)）、手爪開(kāi)閉（舵機(jī)5驅(qū)動(dòng)）。 由Arm9產(chǎn)生六路占空比可調(diào)的PWM號(hào)來(lái)控制機(jī)械手的運(yùn)動(dòng)如圖 &利用上位機(jī)與 Arm9通信，改變占空比從而控制機(jī)械臂如圖9。為了使機(jī)械手運(yùn)動(dòng)時(shí)保持一定的連貫性， 同時(shí)刻到達(dá)指定位置，機(jī)械手不同部位運(yùn)動(dòng)的速度應(yīng)該不同，轉(zhuǎn)一個(gè)小角度時(shí)舵機(jī)的速 度應(yīng)該慢一些，從而達(dá)到柔性控制。 圖8改變控制信號(hào)占空比對(duì)應(yīng)舵機(jī)輸出軸轉(zhuǎn)角 舵機(jī)的主體結(jié)構(gòu)有五個(gè)部分：外殼、減速齒輪組、電機(jī)、電位器、控制電路。工作 原理：控制電路接受來(lái)自信號(hào)線的控制信號(hào)，控制電機(jī)轉(zhuǎn)動(dòng)，電機(jī)帶動(dòng)一系列齒輪組， 減速后傳動(dòng)至輸出舵盤(pán)。舵機(jī)的輸出軸和位置反饋電位計(jì)是相連的，舵盤(pán)轉(zhuǎn)

12、動(dòng)的同時(shí)， 帶動(dòng)位置反饋電位計(jì)，電位計(jì)將輸出一個(gè)電壓信號(hào)到控制電路板，進(jìn)行反饋，然后控制 電路板，根據(jù)所在位置決定電機(jī)的轉(zhuǎn)動(dòng)方向和速度，從而達(dá)到目標(biāo)停止。 圖9 Arm9控制舵機(jī)執(zhí)行原理 四、元器件選型 機(jī)器人控制系統(tǒng)主要由兩部分組成， 即以ARM為核心的上位機(jī)和以DSP為核心的下 位機(jī)傳感器、電機(jī)控制器。系統(tǒng)的上位機(jī)由基于 ARM920T內(nèi)核的S3C2440嵌入式開(kāi)發(fā)板 構(gòu)成，下位機(jī)以TMS320F281芯片為核心構(gòu)成分布式的 DSP雙足機(jī)器人的關(guān)節(jié)控制器， 上位機(jī)和下位機(jī)之間通過(guò)CAN總線連接并實(shí)現(xiàn)數(shù)據(jù)通信。 上位機(jī)ARM吐要負(fù)責(zé)系統(tǒng)的初始化、遠(yuǎn)程通信、組織管理、任務(wù)規(guī)劃、

13、任務(wù)調(diào)度以 及與下位機(jī)DSP的通訊等任務(wù)。ARM上運(yùn)行有實(shí)時(shí)操作系統(tǒng)，負(fù)責(zé)多任務(wù)的調(diào)度和任務(wù) 的執(zhí)行，并通過(guò)CAN總線向下位機(jī)DSP控制器發(fā)送有特定數(shù)據(jù)格式的控制指令和控制參 數(shù)。同時(shí)，ARM還接收下位機(jī)DSP$制器返回的機(jī)器人各個(gè)傳感器及狀態(tài)、位置參數(shù)、 姿態(tài)等相關(guān)參數(shù)。上位機(jī)ARM將這些接收到的數(shù)據(jù)進(jìn)行處理，結(jié)合預(yù)期的機(jī)器人抓取動(dòng) 作規(guī)劃對(duì)機(jī)器人的下一個(gè)抓取動(dòng)作做出相應(yīng)的指示，保證機(jī)器人的實(shí)際運(yùn)動(dòng)狀況和預(yù)期 規(guī)劃的運(yùn)動(dòng)在允許的偏差范圍內(nèi)保持一致，從而達(dá)到預(yù)期的目的以實(shí)現(xiàn)機(jī)器人平穩(wěn)的運(yùn) 動(dòng)和做出各種預(yù)期的抓取動(dòng)作姿態(tài)。下位機(jī)各 DSF控制器主要負(fù)責(zé)接收來(lái)自上位機(jī)的控 制指令和控制參數(shù)，按規(guī)定

14、的協(xié)議進(jìn)行轉(zhuǎn)換、解釋，并結(jié)合固化在 DSFg制器中的控制 算法完成對(duì)機(jī)器人電機(jī)的控制。DSF在執(zhí)行運(yùn)動(dòng)控制指令的同時(shí)還將機(jī)器人實(shí)際運(yùn)動(dòng)情況 反饋給上位機(jī)ARM9與上位機(jī)進(jìn)行信息交換，以便上位機(jī)根據(jù)當(dāng)前的運(yùn)動(dòng)狀態(tài)決策下一 步的抓取指令和參數(shù)。下位機(jī)DSF控制器在接收到上位機(jī)發(fā)送來(lái)的控制參數(shù)之后應(yīng)該迅 速做出響應(yīng)，結(jié)合控制算法給驅(qū)動(dòng)器發(fā)送控制指令，同時(shí)通過(guò)光電編碼器等傳感器件反 饋回來(lái)的信號(hào)再對(duì)控制指令（或者PWM波序列）做相應(yīng)的調(diào)整。 機(jī)器人移動(dòng)機(jī)構(gòu)采用三輪結(jié)構(gòu)（一驅(qū)動(dòng)輪+兩隨動(dòng)輪）。驅(qū)動(dòng)輪采用12V的DC伺服電 機(jī)，驅(qū)動(dòng)輪的直徑12cm隨動(dòng)輪的直徑15cm。移動(dòng)機(jī)構(gòu)的平面最大移動(dòng)速度達(dá)到 1.14 米/秒。 機(jī)械臂控制舵機(jī)為了減小機(jī)器人本身重量可以采用輝盛 SG909G它機(jī)，其扭矩： 1.6kg ? cm(4.8V)工作電壓：3.5V — 6V,可以增加電壓(例如 6V)來(lái)增大扭矩，來(lái)加大 可抓取的物體重量，要達(dá)到要求抓取 2Kg物體還得通過(guò)實(shí)驗(yàn)獲得數(shù)據(jù)來(lái)確定。