亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        基于RBF神經網絡的MIMU姿態(tài)解算算法研究

        2019-12-17 03:32:10姚文凱邢礫文武警工程大學
        數(shù)碼世界 2019年12期
        關鍵詞:數(shù)法卡爾曼歐拉角

        姚文凱 邢礫文 武警工程大學

        1 引言

        最近幾年來由于微慣性測量單元技術以及計算機的技術的不斷進步與發(fā)展,陀螺儀、加速度計和磁傳感器被廣泛應用于定位與導航之中。微型慣性測量單元全稱Miniature Inertial Measurement Unit,它是一種應用十分廣泛的的MEMS,它的陀螺儀、加速度計和磁傳感器能夠應用在確認運動載體的拘役位置、運動速度以及載體的姿態(tài)信息。微慣性器件的主要特點有低成本、體積小、功耗低、全固態(tài)、可靠性高、精度低等。微型慣性測量單元的陀螺儀、加速度計和磁傳感器都有著各自的局限,如果它們進行單獨的工作,會因為它們自身的各自缺陷引起比較大的偏差,從而難以在室內精確的對人的姿態(tài)進行測量。為了提高對采集到的姿態(tài)信息的精度,本文將會將RBF與卡爾曼濾波融合起來構建一個新的濾波模型對人的姿態(tài)信息進行解算,這種算法能夠有效的消除卡爾曼濾波模型本身引起的誤差,從而使的構建的模型以及濾波過程中使用的參數(shù)對最優(yōu)估計值的影響減少以及提高模型對動態(tài)環(huán)境的外來干擾的抗干擾能力。

        2 姿態(tài)解算的常規(guī)方法

        目前比較常見的傳統(tǒng)姿態(tài)更新算法有歐拉角法、方向余弦法、四元數(shù)法幾種。

        2.1 歐拉角法

        在利用歐拉角法實現(xiàn)姿態(tài)角計算的時候,首先需要利用旋轉關系來建立姿態(tài)角的微分方程,然后通過離散方法對所建立的微分方程進行離散化,最后根據(jù)遞推公式來實現(xiàn)對姿態(tài)角的實時計算。但是歐拉角法在俯仰角的大小接近90度的時候會出現(xiàn)計算“奇點”,這個時候微分公式就會出現(xiàn)退化現(xiàn)象。因此,用歐拉角法計算人體的姿態(tài)角存在著比較大的局限性,只適用于水平姿態(tài)角變化不大的情況。

        2.2 方向余弦法

        用方向余弦法對人體的姿態(tài)進行計算的時候可以利用微分方程來直接對姿態(tài)矩陣中的九個元素進行計算,并且計算的時候不會出現(xiàn)利用歐拉角法時候存在的退化現(xiàn)象,能夠實現(xiàn)對全姿態(tài)運載體的計算。但是這種方法要求同時對線性微分方程組中的多個線性方程進行計算,存在著比較大的計算量,難以實現(xiàn)實時計算。

        2.3 四元數(shù)法

        利用四元數(shù)可以實現(xiàn)人的坐標系與參坐標系之間的關系。四元數(shù)可以認為是向量與市屬之間的組合,為了表示方便,這里將采用q來對四元數(shù)進行表示,具體表示方式如公式2-1所示。

        四元數(shù)法算法簡單,但在計算精度方面存在著一定的缺陷,為了提高對人體姿態(tài)信息的計算精度,本文將在四元數(shù)法的基礎上,引入RBF-卡爾曼融合濾波模型來解算姿態(tài)信息。

        3 RBF卡爾曼融合濾波模型算法

        3.1 RBF神經網絡模型

        RBF神經網絡中有輸入層、隱含層和輸出層三個層次,每個層次都有各自的功能。隱含層的神經元激活函數(shù)由徑向基函數(shù)構成。隱含層組成的數(shù)組運算單元中都有一個中心向量c,c和輸入參數(shù)向量的維數(shù)是相同的,在計算非線性激活函數(shù)的時候需要利用到二者之間的歐式距離,具體定義為。因此,隱含層的輸出為非線性激活函數(shù)如公式(3-1)所示。

        其中,bj是一個為正的標量,它表示的是公式(3-1)中高斯函數(shù)的寬度的大小,而m則表示的是整個RBF神經網絡中隱藏節(jié)點的個數(shù)。

        為了計算方便,這里將該基函數(shù)的寬度定義為1,于是就可以得到公式(3-2)所示的神經網絡輸出逼近函數(shù)。

        針對上述RBF神經網絡,通過試驗所測量出來的不同已知姿態(tài)條件下微慣性測量組合輸出電壓作為訓練樣本進行訓練,來實現(xiàn)神經網絡中不同隱藏節(jié)的數(shù)值修正。

        3.2 RBF-卡爾曼融合濾波模型

        在本次研究中,首先先用陀螺儀和加速度計來實現(xiàn)人在運動過程中所安裝的MIMU的角速度以及加速度,并且利用磁力計對測量的角速度和加速度所存在的加速度以及角速度進行校準。然后將獲取到的三種姿態(tài)信息過擴展卡爾曼濾波器進行信息融合得到經過RBF神經網絡進行校準前的姿態(tài)信息。然后將三個傳感器的信息和校準前的姿態(tài)信息反向輸入到建立好的RBF神經網絡中系統(tǒng)中實現(xiàn)神經網絡中的訓練與預測。圖3-1為RBF卡爾曼融合濾波的結構框圖。

        圖3-1 RBF神經網絡模型

        4 仿真分析

        在本次實驗中,為了實現(xiàn)仿真,本次實驗利用一個九軸的IMU模塊以及一個GPS接收模塊在室內進行實驗,其中其中IMU模塊的陀螺儀精度為0.05°/s,加速度計精度為0.01g,GPS模塊的定位精度為2.5m,測速精度為0.1m/s。將二者固定于同一個平臺上并進行仿真運動550s,并實時的記錄在實驗中獲得的數(shù)據(jù),采用前400s的數(shù)據(jù)作為訓練樣本按照設計方案對網絡進行訓練,將后150s的數(shù)據(jù)輸入網絡中預測該時間內的絡參數(shù)誤差,將誤差反饋給RBF神經網絡模型得到修正后的定位導航參數(shù),并與真實軌跡進行對比。為了驗證該方法的優(yōu)越性,進行了單純的卡爾曼濾波的誤差融合進行了對比分析。

        圖4-1 原始數(shù)據(jù)的姿態(tài)角

        圖4-2 經過卡爾曼處理的姿態(tài)角

        圖4-3經過RBF-卡爾曼融合處理的姿態(tài)角

        圖4-1是沒有經過任何處理的姿態(tài)角,圖4-2是經過單純的四元數(shù)-卡爾曼濾波進行濾波后的姿態(tài)角,而圖3-3是經過RBF-四元數(shù)卡爾曼濾波后的姿態(tài)角。從圖4-1、4-2、4-3的對比可以發(fā)現(xiàn),經過卡爾曼濾波進行濾波后的姿態(tài)角比沒有經過處理的姿態(tài)角誤差要小,而融合了RBF神經網絡后的卡爾曼濾波的效果又要比過單純的卡爾曼濾波效果要好。因此,該方案是可行的。

        5 結論

        通過本次實驗發(fā)現(xiàn),如果不采取算法對收集到的數(shù)據(jù)進行處理,那么姿態(tài)角容易受到漂移和噪聲的影響,會產生較大的誤差。但是經過四元數(shù)法和卡爾曼融合處理后的姿態(tài)角受到的影響明顯減弱,說明四元數(shù)法和卡爾曼融合在姿態(tài)角解算過程中起到很重要的作用,而在四元數(shù)法和卡爾曼融合處理的基礎上加入RBF神經網絡控制進行輔助,能夠進一步的使得姿態(tài)角受到的影響明顯減弱。

        猜你喜歡
        數(shù)法卡爾曼歐拉角
        多種方法數(shù)方格
        巧借導數(shù)法,秒破不等式
        《數(shù)花生》教學實錄及課堂評析
        狀態(tài)變換擴展卡爾曼平滑算法在AUV水下航跡修正中的應用
        從CATIA位置矩陣求解歐拉角的計算方法分析
        科技視界(2017年6期)2017-07-01 08:33:34
        一種基于EGI和標準人臉模板的三維人臉點云拼合算法
        軟件導刊(2016年11期)2016-12-22 21:37:36
        趣味數(shù)獨
        基于卡爾曼算法的動力鋰電池SOC估算
        基于卡爾曼預測的逆變焊接電源信號處理方法
        焊接(2016年4期)2016-02-27 13:04:27
        基于擴展卡爾曼估計的飛機防滑剎車系統(tǒng)模糊控制
        99热成人精品免费久久| 久久精品中文字幕| 极品少妇一区二区三区四区| а中文在线天堂| 蜜桃av多人一区二区三区| 在线观看国产白浆一区三区| 中文字幕无码av波多野吉衣| 国产精品美女久久久久久久| 国产午夜精品美女裸身视频69| 青青草视频在线观看绿色| 国产在热线精品视频| 欧美粗大无套gay| 亚洲AV永久无码精品一区二国| 视频区一区二在线观看| 女人被男人爽到呻吟的视频| 成 人 网 站 免 费 av| 日韩中文字幕无码av| 在线观看一区二区三区在线观看| 国产婷婷色一区二区三区在线| 蜜臀av免费一区二区三区| 国产不卡在线免费视频| 亚洲国产中文字幕无线乱码| 国产在线观看无码免费视频| 国产美女在线精品亚洲二区| 男女啪啪免费视频网址| 曰批免费视频播放免费| 丰满熟妇乱又伦| 国产在视频线精品视频二代 | www国产亚洲精品久久麻豆| 欧美日韩亚洲tv不卡久久| 国产精品欧美韩国日本久久| 水蜜桃视频在线观看入口| 国产尤物精品视频| 亚洲网站地址一地址二| 一本久久a久久精品综合| 精品国产一区二区三区av| 国产精品沙发午睡系列990531| 亚洲熟女av超清一区二区三区| av免费一区二区久久| 少妇愉情理伦片高潮日本| 9999毛片免费看|