農(nóng)田除草機的結(jié)構(gòu)設(shè)計,農(nóng)田除草機的結(jié)構(gòu)設(shè)計,農(nóng)田,除草機,結(jié)構(gòu)設(shè)計 2007年IEEE的程序 機器人與仿生學國際會議 2007年12月15日-18，三亞，中國 割草機器人多傳感器融合與導航技術(shù)的研究 從明和房波 大連理工大學機械工程學院 大連，116024，中國 congm@dlut.edu.cn 引言——本文提出了一種多傳感器系統(tǒng)從超聲波傳感器和導航相結(jié)合的測量機器人割草機。利用傳感系統(tǒng)使機器人割草機來映射未知的環(huán)境。對于自動割草機器人能在未知的環(huán)境中進行定位和導航執(zhí)行割草任務(wù)是很重要的。由于環(huán)境的復雜性，簡單的一種傳感器是不足夠割草機器人來完成這些任務(wù)。我們開發(fā)了一個配有DSPTMS320F2812作為CPU割草機器人。感測系統(tǒng)集成由超聲波傳感器，紅外傳感器，碰撞傳感器，編碼器，一個溫度傳感器和電子羅盤組成。超聲波測距技術(shù)變換是基于小波變換的精度高來表示的，以提高超聲波傳感器測量精度。仿真研究表明，所提出的多傳感器信息融合的方法是非常有效的對于導航割草機器人。實驗結(jié)果表明，該傳感系統(tǒng)基于相關(guān)的規(guī)定障礙檢測和定位顯示出巨大的潛力，為在動態(tài)工作條件下的割草機器人提供一個強大的高性價比的解決方案。 關(guān)鍵詞——多傳感器融合，超聲波傳感器，割草機機器人，定位，導航。 1.緒論 草坪修剪被許多人認為是一個最枯燥，累人的日常任務(wù)。首先迫切需要執(zhí)行的任務(wù)是能適應環(huán)境的機器人。一些預測表明，割草機器人將是一個最有前途的個人機器人應用，并有重大的市場在世界上。因此，智能化的概念割草機器人（IRM）在1997年度會議的OPEI（ 戶外電力會議設(shè)備研究所）上第一次提出[ 1 ]。該機器人主要面對一般家庭幫助忙碌的人們和乏力的老人們節(jié)省支付雇傭勞動力的報酬，同時消除人們來自噪聲中，花粉和割草刀片的危害。割草機器人是服務(wù)于家庭護理的室外移動機器人，是那種真正的智能機電一體化的環(huán)境清理設(shè)備[ 2 ] [ 3 ]。最重要的是割草機器人為代表的一些地區(qū)覆蓋的環(huán)保機器人不僅用于室內(nèi)地面清潔，如[ 4 ]也在危險的環(huán)境中，例如去地雷，清理輻射點，勘探資源等。與室內(nèi)移動機器人不同，割草機器人得到很大的挑戰(zhàn)。 在整個工作區(qū)域內(nèi)，割草機器人使用傳感器來感知環(huán)境以及識別他們的實時狀態(tài)下的環(huán)境障礙，地圖構(gòu)建，定位和導航。由于環(huán)境的復雜性，一種簡單的傳感器是不足以讓割草機器人來完成這些任務(wù)的。因此有必要結(jié)合來自不同的傳感器上觀察到的傳感器數(shù)據(jù)減少機器人在任何工作環(huán)境工作的不確定性。為來自各種傳感器的信息能合并，傳感器魯棒性和實時性的融合是必需的[ 5 ]。在傳感器出現(xiàn)誤差或失敗的情況下，多融合傳感器融合也可以減少不確定信息，并提高其可靠性。 低成本的傳感系統(tǒng)，說明其低功耗，高性能。超聲波傳感器檢測范圍是0.3m~ 5m，他們提供良好的范圍信息。然而，環(huán)境引起的鏡面漫反射是超聲波傳感器的不確定因素，讓他們不具吸引力。紅外傳感器的檢測范圍是0.02m~ 1m，他們可以檢測在超聲波傳感器的盲區(qū)的障礙。 為了滿足割草機器人低成本和高精度的測距技術(shù)的需求，在研究超聲波測距技術(shù)基于高精度的小波分析變換（WT）的數(shù)據(jù)報道，提高超聲波傳感器的測量精度。測量數(shù)據(jù)從傳感系統(tǒng)集成，實現(xiàn)規(guī)劃最佳的，可靠地，完全覆蓋整個工作計劃的地區(qū)，使割草機器人避免未知的障礙。 最后，通過仿真研究和實驗結(jié)果表明該傳感系統(tǒng)的導航效果，障礙物檢測和割草機器人定位。 2.信息資源管理系統(tǒng)的硬件 IRM采用DSP TMS320F2812作為其CPU，包括四個單元：車輛系統(tǒng)，切割系統(tǒng)，傳感系統(tǒng)和控制系統(tǒng)。傳感系統(tǒng)是用來收集外部動態(tài)信息的工作環(huán)境 避障，地圖構(gòu)建，導航與定位。它也可以用來檢測車輛系統(tǒng)的運動參數(shù)和切削機構(gòu)的工作狀況。該控制器將獲得的信息與數(shù)據(jù)庫進行比較，然后發(fā)出修正后精確的命令讓機器人完成任務(wù)。信息資源管理的硬件，如圖1所示。 IMR硬件概要圖1 機器人必須身體強壯，計算速度快，行動準確和安全。它應該有能力 ，而在全部或大部分的割草期間無需人的干預。IRM由于模塊化設(shè)計，各單元的管理是相對獨立的。模塊化設(shè)計使維護更容易。IRM任何損壞單元都可以直接取代而不影響其它單元的功能。 3.傳感系統(tǒng) A：超聲波傳感器單元 超聲波傳感器可以提供良好的范圍是基于飛行時間（TOF）信息原理，主要是由于其簡單性和成本相對較低，他們已廣泛應用于移動機器人的障礙物回避，地圖構(gòu)建等。這種類型的外部傳感器能很好測量的障礙物的距離。靈敏度函數(shù)的主瓣內(nèi)包含一個20度角，如圖2所示的【6】。大量的試驗結(jié)果表明，傳感器的精度范圍為±2cm。 圖2為超聲波傳感器的典型的強度分布 對于IRM，我們建立了一個傳感器陣列由12超聲波傳感器間隔30度的間隔。超聲波信號可以覆蓋所有的空間，可以要求哪些機器人檢測整個空間的環(huán)境信號。用基于TOF的測量的超聲換能器的經(jīng)典技術(shù)，計算出的距離最近的反射器利用聲音在空氣中的速度從發(fā)射脈沖到回波到達時間。距離D為反映對象的計算 D =（C×T）/ 2 （1） 其中C是聲音的速度，T是飛行時間。該TOF法產(chǎn)生一系列的值時，回波幅度首次超過臨界值后發(fā)送，忽略第二回波從進一步的反射。 超聲波傳感器單元包括一個觸發(fā)脈沖生成單元，一個多通道選擇單元和回聲接收單元。傳感器接口電路設(shè)計發(fā)送和接收超聲波脈沖，捕獲的總是第一個返回的回聲。一個對象相關(guān)的數(shù)據(jù)的范圍要考慮到即使是位于在錐軸離軸。 超聲波頻率通常在40和180千赫之間，而在該系統(tǒng)中超聲波傳感器的頻率使用的是40千赫。光束角度是20度。40千赫PWM脈沖是由通用DSP的定時器單元產(chǎn)生的。驅(qū)動發(fā)射機有效而不帶來大的振動，40千赫的超聲波一次突發(fā)的時間是8周期。當超聲波脈沖發(fā)射時，傳感器將經(jīng)歷“振鈴”。振鈴引起的由所發(fā)送的脈沖可以使接收器檢測到一個錯誤回聲。這個不能夠捕獲解決DSP中斷問題，直到延遲間隔已過。這意味著在延遲的時間間隔那測距儀不能檢測物體距離該傳感器是少于一半的聲音傳播的距離。這是該超聲波傳感器的盲區(qū)，如圖3所示。 圖3超聲波發(fā)射和接收示意圖 B.：.紅外傳感器裝置和其他傳感器 針對超聲波傳感器的盲區(qū)，增加了紅外傳感器。紅外傳感器可以檢測在20cm內(nèi)的障礙，這彌補了超聲波傳感器由于失明問題所造成的區(qū)域的問題。 這個單元有16個紅外傳感器。每個紅外搜索器范圍有6度，是靈敏度函數(shù)主要的圓錐曲線的視圖。該傳感器具有一個高精度測量范圍，有效測量范圍是一個目標到一米左右。一些測試表明，該傳感器的測距精度在±1cm左右。 為了節(jié)省DSP的資源，16個紅外傳感器采用DSP TMS320F2812的數(shù)據(jù)接口代替IO接口。這種結(jié)構(gòu)也可以同時讀取傳感器的狀態(tài)，以確保該系統(tǒng)的時間性能。傳感器接口電路用于發(fā)送和接收紅外脈沖并總是捕獲第一個回波來處理其振幅。 割草機器人在室外環(huán)境中工作時，其溫度變化迅速。溫度的變化會影響聲音的速度。因此，溫度傳感器用于保證超聲波傳感器的精度。碰撞傳感器是一組敏感的樣本，采用它是為了防止意外的碰撞造成的損害。由于潮濕的環(huán)境會危害IRM電路，濕度傳感器被引入用于檢測濕度環(huán)境。雖然這些傳感器不完全是 一個自主割草機器人機必要的，但他們可以提供有益的功能，讓工作更具有效性和安全性。 4.導航技術(shù) A. 映射 正如圖4所示，基準方向的X定義和機器人的坐標為，。關(guān)于內(nèi)置電子羅盤對于機器人的幫助，角，這是從第一個傳感器得來的角度，可容易衡量。實際上，如果只在角（標題的機器人角）的測量，從其他傳感器的角度可以發(fā)現(xiàn) 角是我們的世界坐標中心。該超聲波傳感器組的最大環(huán)數(shù)為n，半徑為R（在我們的系統(tǒng)中，n = 12和R = 0.25m）。該環(huán)的原點到中心之間的距離是r，并且該向中心的基準角度是Ω。根據(jù)參考位置機器人的中心是（，）。這個距離是從原點到通過兩個傳感器數(shù)據(jù)檢測的二維平面稱之為。 現(xiàn)在讓我們用DMI測量值來分別表示從超聲波和紅外傳感器得到的數(shù)據(jù)，用于精確距離。這些值之間會有一個誤差 在這項工作中，我們自然假設(shè)是一個均勻隨機變量在（W，W）范圍內(nèi)。在這里，W表示最大距離測量誤差。這里的問題是，給定的，，r ，，，，，和，，，，，估計占用的坐標細胞和（或等價的）以最有效的方法。涉及檢測對象的方程可以寫為 圖4所示機器人在X-Y段的位置 由于對象涉及機器人的方程被寫為 如果我們定義的位置為：=，，，，，然后我們有 將插入到中， 在這里我們有N個這樣的方程。我們把它們矩陣形式 如果我們引入新的矩陣 ，然后（10）， 可以寫為 在這里，如果我們進行最小二乘法估計，我們得到 因此，我們用最小二乘法估計找到最好的位置。 B. 仿真研究 基于傳感器導航系統(tǒng)已經(jīng)進行了測試在顯示該傳感器融合方法的有效性的兩種環(huán)境分別如圖5和圖6所示。割草機是一個結(jié)構(gòu)化的實驗室初步測試如圖5所示。開始在（0.3m，0.5m，0°），一個虛擬的機器人在虛擬廣場走廊一次。墻在人工環(huán)境中是由真正的地圖表示的。 全車是獨立的。它有一個最大的運行速度是0.4米/秒。實驗室面積調(diào)查出在10cm精度優(yōu)于1cm為佳。提取映射，提出了一開始的目標。機器人位置和方向是由電子羅盤成立[ 8 ]。 圖5數(shù)據(jù)采集與導航在結(jié)構(gòu)化環(huán)境中的結(jié)果 圖5中的結(jié)果顯示的映射質(zhì)量和該傳感器融合方法的有效性。在測試中，我們發(fā)現(xiàn)，在估計的位置的平均誤差（ε）在環(huán)境中的障礙是在[ 0.2 ，0.2]米范圍內(nèi)。 在模擬中，我們看到，在（11）中，實際上應該得到的是不滿足 。在可以為位置更好的估計的情況下可以表示為 在這種情況下，估計角不會改變但估計距離是縮放到它的最佳估計。 因此，對于位置，距離估計是和以前一樣，而最小二乘估計的作品只對角 。仿真結(jié)果表明，這種方法產(chǎn)生更精確的結(jié)果。 圖6仿真結(jié)果的墻下行為 墻后，被選定為初值問題域是因為它建立一個相當簡單的問題評價[ 9 ]。它這也奠定了更為復雜的基礎(chǔ)的問題領(lǐng)域，如迷宮的穿越，映射和用于草坪修剪和吸塵全覆蓋路徑規(guī)劃。墻上的仿真結(jié)果—圖6所示的行為后和實驗結(jié)果在圖6表明，該IRM有能力在非結(jié)構(gòu)化的環(huán)境中執(zhí)行它的割草任務(wù)。 在圖5中傳感器的程序?qū)Ш椒抡嫒缦隆? 5 . 超聲波測距技術(shù)基于小波變換 遺憾的是，由于環(huán)境的復雜性和噪聲的影響，實際接收到的多回波具有隨時間變化的特性，并且是一個典型的非平穩(wěn)信號。此外，在超聲波脈沖回聲混合噪聲是非高斯白噪聲，但噪聲，和與目標回波相關(guān)。TOF法不能在這樣的條件下直接使用。引用廣義相關(guān)方法估計時間延遲的[ 10 ]，我們把提出了廣義自相關(guān)方法基于小波變換的時延估計[ 11 ]出現(xiàn)在圖7。 圖7基于小波變換的廣義自相關(guān)延遲估計 其中（t）是母小波和（t）是女兒小波。該系數(shù)α是規(guī)模（或縮放 因素）和（τ）是時間位移。小波變換的信號x（t）是y（t）。實際上這是一個過濾過程使用大量的帶通濾波器的超聲回波等于的Q值，這相當于的白化濾波器對廣義相關(guān)方法的時間延遲的估計，為了消除輸入噪聲的影響做以下處理。可以找到，作為 由于傅里葉變換關(guān)系自相關(guān)函數(shù)之間和他的力譜： 我們獲得的廣義自相關(guān)函數(shù)是： 最后，檢測到的峰值來完成TOF的估計和計算實際的超聲波速度。 圖8嘈雜的超聲回波 圖9基于小波去噪的回聲 圖10自相關(guān)函數(shù) 圖11峰值檢測 嘈雜的超聲回波信號如圖8所示，和利用小波變換去噪后的超聲回波顯示 圖9。很明顯，該噪聲混入的超聲波回波經(jīng)WT操作后得到有效地消除作。自動去除噪聲的超聲波回波的相關(guān)運算如圖10所示。圖11顯示了包絡(luò)線，通過希爾伯特變換。正如我們可以看到，如果每一個峰的橫坐標點確定，TOF估計可計算?？紤]的超聲回波衰減和高精度的要求在實踐中的需求，只有前4回波被用來估計TOF。在TOF估計的值是，，，，，，這是對稱于X軸。使用這種方法，估計超聲波速度可以計算出來。 到目前為止，障礙檢測和定位系統(tǒng)成功實現(xiàn)。運用該方法，障礙物檢測和定位系統(tǒng)已成功實施。 基于廣義自相關(guān)法小波變換，提出了實現(xiàn)實時超聲波速度測量，該方法可以消除溫度，濕度和風力的影響，超聲波速度測量可以在機器人工作的動態(tài)條件下完成。在這種傳感系統(tǒng)的基礎(chǔ)上，廣義自相關(guān)方法顯示出巨大潛力提供用于割草機器人一個強大的解決方案在動態(tài)的工作條件下。 6. 實驗結(jié)果 我們利用超聲波傳感器測量機器人和平面之間的距離。測量結(jié)果和實際距離如表一所示： 表一 超聲波傳感器的實驗數(shù)據(jù)（單位：厘米） 從表一中，我們可以看到，超聲波傳感器測量誤差在3%。 然后，基于廣義自相關(guān)法小波變換，提出了實現(xiàn)實時超聲波速度測量。 通過上述方法，我們再次測量機器人和平面對象距離的。測量結(jié)果與實際距離顯示在表二中。 表二 超聲波傳感器的基于小波變換的數(shù)據(jù)（單位：厘米） 基于小波變換的實驗結(jié)果表明，使用上述的測量誤差技術(shù)是小于1% 為5m范圍區(qū)域內(nèi)，這種傳感系統(tǒng)的障礙物檢測和定位擁有巨大的潛力，能作為—個強大的解決方案用提高于割草機器人性價比在動態(tài)工作條件下。 7. 結(jié)論 在本文中，我們提出了一個多傳感器系統(tǒng)結(jié)合超聲波傳感器測量用于割草機器人導航。該傳感系統(tǒng)具有低成本，低功耗，高性能，使割草機器人機能映射未知環(huán)境。其有效性是通過仿真研究和實驗結(jié)果得到的。 使用不同種類的傳感器集成在傳感系統(tǒng)可以克服超聲波傳感器的盲區(qū)和多傳感器融合的鏡面反射的缺陷。 一種高精度超聲波測距技術(shù)的方法基于小波變換已被引入到改善更多的超聲波傳感器的測量精度準確的感官信息。該系統(tǒng)應用于割草機器人，證明了實驗的可靠性和實時性。 今后的工作將著眼于應用所提出的跟蹤技術(shù)的多傳感器融合方案應用于在非結(jié)構(gòu)化環(huán)境中的機器人割草機控制全覆蓋路徑規(guī)劃[ 12 ]。 參考文獻