基于聲源定位、ins的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)的制作方法
【技術(shù)領(lǐng)域】
[0001]本實(shí)用新型涉及定位導(dǎo)航與控制技術(shù)專利應(yīng)用技術(shù)領(lǐng)域，尤其涉及一種基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)。
【背景技術(shù)】
[0002]機(jī)器人是當(dāng)代自動(dòng)化技術(shù)和人工智能技術(shù)發(fā)展的典型體現(xiàn)，也代表著制造技術(shù)發(fā)展的新水平。機(jī)器人尤其是極限爬壁工作機(jī)器人的廣泛應(yīng)用，極大地提高了生產(chǎn)力。要提高爬壁機(jī)器人作業(yè)的智能化水平，必須完善機(jī)器人的導(dǎo)航系統(tǒng)，而定位定向是導(dǎo)航的關(guān)鍵問題。
[0003]國(guó)內(nèi)大部分爬壁機(jī)器人的定位和位姿信息僅采用簡(jiǎn)單的姿態(tài)傳感器和航位推算法粗略表示，無(wú)法滿足機(jī)器人在壁面精確作業(yè)的任務(wù)需要。特別是應(yīng)用于飛機(jī)表面蒙皮損傷檢測(cè)的爬壁機(jī)器人的定位控制。因此，需要通過改善機(jī)器人精確定位定向的導(dǎo)航系統(tǒng)來(lái)提尚機(jī)器人的本體智能。
[0004]慣性導(dǎo)航(i ner t i a I nav i gat i on )，是依據(jù)牛頓慣性原理，利用慣性元件(加速度計(jì))來(lái)測(cè)量運(yùn)載體本身的加速的，經(jīng)過積分和運(yùn)算得到速度和位置，從而達(dá)到對(duì)運(yùn)載體導(dǎo)航定位的目的。組成慣性導(dǎo)航系統(tǒng)(INS，Inertial Navigat1n System)的設(shè)備工作時(shí)不依賴外界信息，也不向外界輻射能量，不易受到干擾，是一種自助式定位系統(tǒng)。但慣性導(dǎo)航即使導(dǎo)航狀態(tài)的初始化估計(jì)精度很高，當(dāng)由包含漂移或偏差誤差和噪聲的慣性測(cè)量數(shù)據(jù)，積分求解導(dǎo)航狀態(tài)時(shí)，仍會(huì)有誤差積累。
[0005]聲源定位是指由若干聲源接收裝置按一定的方式布置在空間的不同位置組成陣列，對(duì)采集的聲音信號(hào)進(jìn)行分析和處理在空間定出一個(gè)或多個(gè)聲源坐標(biāo)，得到聲源的位置。但受儀器采樣速度、波速測(cè)量誤差、定位區(qū)域局部結(jié)構(gòu)的影響，要通過聲源定位系統(tǒng)實(shí)現(xiàn)機(jī)器人精確的定位，還需要依靠輔助裝置在必要時(shí)進(jìn)行定位輔助。
[0006]從上述的分析，聲源定位系統(tǒng)、INS (Inertial Navigat1n System)在特殊工作環(huán)境下單獨(dú)應(yīng)用具有較大的局限性，通過對(duì)上述不同感知系統(tǒng)信息的融合處理可以解決兩者對(duì)應(yīng)的缺陷，無(wú)疑可以提高系統(tǒng)導(dǎo)航精度和可靠性。
【實(shí)用新型內(nèi)容】
[0007]本實(shí)用新型所要解決的技術(shù)問題是針對(duì)【背景技術(shù)】中所涉及到的缺陷，提供一種基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)，利用聲源定位子系統(tǒng)對(duì)機(jī)器人攜帶的高低音頻聲源信號(hào)進(jìn)行定位定向，以輔助INS組合定位。該方法可以整合多個(gè)子導(dǎo)航信息，克服了聲源定位系統(tǒng)易受采樣頻率的影響計(jì)INS的導(dǎo)航定位誤差隨時(shí)間延續(xù)不斷增大的缺陷。
[0008]本實(shí)用新型為解決上述技術(shù)問題采用以下技術(shù)方案:
[0009]基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)，包括INS、INS處理單元、低音頻發(fā)聲裝置、高音頻發(fā)聲裝置、麥克風(fēng)聲源接收陣列、信號(hào)調(diào)理模塊和中央處理模塊；
[0010]所述INS通過INS處理單元和中央處理模塊相連，所述麥克風(fēng)聲源接收陣列通過信號(hào)調(diào)理模塊和中央處理模塊相連；
[0011]所述INS用于測(cè)量爬壁機(jī)器人的慣性數(shù)據(jù)并輸出給INS處理單元；
[0012]所述INS處理單元用于根據(jù)接收到的慣性數(shù)據(jù)計(jì)算得到爬壁機(jī)器人的位置數(shù)據(jù)、速度數(shù)據(jù)和姿態(tài)數(shù)據(jù)；
[0013]所述低音頻發(fā)聲裝置、高音頻發(fā)聲裝置對(duì)稱安裝在爬壁機(jī)器人的兩側(cè)，分別用于發(fā)出低音和高音；
[0014]所述麥克風(fēng)聲源接收陣列的連線中心為機(jī)器人重心，用于接收所述低音頻發(fā)聲裝置、高音頻發(fā)聲裝置的聲源模擬信號(hào)，并將其輸出給所述信號(hào)調(diào)理模塊；
[0015]所述信號(hào)調(diào)理模塊用于對(duì)接收到的聲源模擬信號(hào)進(jìn)行放大和偏置，并將其傳遞給所述中央處理模塊；
[0016]所述中央處理模塊包含數(shù)據(jù)采集卡和卡爾曼濾波模塊；
[0017]所述數(shù)據(jù)采集卡用于將經(jīng)過放大和偏置后的聲源模擬信號(hào)轉(zhuǎn)化為聲源數(shù)字信號(hào)，并將其傳遞給所述卡爾曼濾波模塊；
[0018]所述卡爾曼濾波模塊用于根據(jù)接收到的聲源數(shù)字信號(hào)對(duì)機(jī)器人的位置數(shù)據(jù)、速度數(shù)據(jù)、姿態(tài)數(shù)據(jù)進(jìn)行校正，獲得爬壁機(jī)器人的定位導(dǎo)航信息。
[0019]作為本實(shí)用新型基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)進(jìn)一步的優(yōu)化方案，所述麥克風(fēng)聲源接收陣列采用四元十字陣列。
[0020]作為本實(shí)用新型基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)進(jìn)一步的優(yōu)化方案，所述INS包括三軸正交安裝的陀螺儀和三軸正交安裝的加速度計(jì)，所述陀螺儀用于提供三軸角速度測(cè)量值，所述加速度計(jì)用于提供三軸加速度測(cè)量值。
[0021]作為本實(shí)用新型基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)進(jìn)一步的優(yōu)化方案，所述陀螺儀采用光釬陀螺儀。
[0022]作為本實(shí)用新型基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位系統(tǒng)進(jìn)一步的優(yōu)化方案，所述加速度計(jì)采用娃微加速度計(jì)。
[0023]本系統(tǒng)的定位方法如下:
[0024]步驟I)，利用INS獲取爬壁機(jī)器人的慣性數(shù)據(jù)；
[0025]步驟2)，根據(jù)爬壁機(jī)器人的慣性數(shù)據(jù)進(jìn)行導(dǎo)航積分計(jì)算，獲得爬壁機(jī)器人的INS位置數(shù)據(jù)、INS速度數(shù)據(jù)和INS姿態(tài)數(shù)據(jù)；
[0026]步驟3)，并控制高音頻發(fā)聲裝置和低音頻發(fā)聲裝置以IHZ地頻率播放高低頻率聲
■~>V.曰；
[0027]步驟4)，采用麥克風(fēng)四元陣列收集四組高低頻率聲音信號(hào)；
[0028]步驟5)，對(duì)四組高低頻率聲音信號(hào)進(jìn)行放大和偏置后，將其分離為四組高頻率聲音信號(hào)和四組低頻率聲音信號(hào)；
[0029]步驟6)，根據(jù)四組高頻率聲音信號(hào)和四元陣列模型下的幾何定位公式，計(jì)算出高音頻發(fā)聲裝置的位置信息；
[0030]步驟7)，根據(jù)四組低頻率聲音信號(hào)和四元陣列模型下的幾何定位公式，計(jì)算出低音頻發(fā)聲裝置的位置信息；
[0031]步驟8)，根據(jù)高音頻發(fā)聲裝置和低音頻發(fā)聲裝置的位置信息計(jì)算出爬壁機(jī)器人的聲源定位位置數(shù)據(jù)和聲源定位姿態(tài)數(shù)據(jù)；
[0032]步驟9)，對(duì)爬壁機(jī)器人的INS位置數(shù)據(jù)、聲源定位位置數(shù)據(jù)進(jìn)行濾波融合計(jì)算，獲得爬壁機(jī)器人的最終位置數(shù)據(jù)；
[0033]步驟10)，對(duì)爬壁機(jī)器人的INS姿態(tài)數(shù)據(jù)、聲源定位姿態(tài)數(shù)據(jù)進(jìn)行濾波融合計(jì)算，獲得爬壁機(jī)器人的最終姿態(tài)數(shù)據(jù)；
[0034]步驟11)，將爬壁機(jī)器人的最終位置數(shù)據(jù)、INS速度數(shù)據(jù)和最終姿態(tài)數(shù)據(jù)作為其導(dǎo)航定位信息輸出。
[0035]本實(shí)用新型采用以上技術(shù)方案與現(xiàn)有技術(shù)相比，具有以下技術(shù)效果:
[0036]1.通過利用卡爾曼濾波對(duì)INS導(dǎo)航及聲音定位信息進(jìn)行融合，有效的提高了爬壁機(jī)器人組合導(dǎo)航定位的精度；
[0037]2.通過利用聲源定位子系統(tǒng)對(duì)爬壁機(jī)器人攜帶的不同頻率的聲源進(jìn)行定位。由于爬壁機(jī)器人工作區(qū)域環(huán)境模型已知，因此可以通過分析計(jì)算不同聲源的坐標(biāo)得到爬壁機(jī)器人相對(duì)壁面的俯仰角、方位角信息。
【附圖說明】
[0038]圖1是本實(shí)用新型一種組合定位系統(tǒng)組成框圖；
[0039]圖2是本實(shí)用新型組合導(dǎo)航定位系統(tǒng)信息融合算法框圖。
【具體實(shí)施方式】
[0040]下面結(jié)合附圖對(duì)本實(shí)用新型的技術(shù)方案做進(jìn)一步的詳細(xì)說明:
[0041]如圖1所示，本實(shí)用新型公開了一種基于聲源定位、INS的爬壁機(jī)器人導(dǎo)航定位