日本无码免费高清在线|成人日本在线观看高清|A级片免费视频操逼欧美|全裸美女搞黄色大片网站|免费成人a片视频|久久无码福利成人激情久久|国产视频一二国产在线v|av女主播在线观看|五月激情影音先锋|亚洲一区天堂av

  • 手機(jī)站
  • 小程序

    汽車測試網(wǎng)

  • 公眾號
    • 汽車測試網(wǎng)

    • 在線課堂

    • 電車測試

自動駕駛--慣性導(dǎo)航原理

2020-07-31 22:35:50·  來源:每日自動駕駛  
 
慣性導(dǎo)航一般集成在GPS設(shè)備中,都是由供應(yīng)商集成,那在這里有什么討論的必要呢,要知道在車輛行駛中,我們可以拿到GPS的yawrate和speed信號,而且車輛本身還有一
慣性導(dǎo)航一般集成在GPS設(shè)備中,都是由供應(yīng)商集成,那在這里有什么討論的必要呢,要知道在車輛行駛中,我們可以拿到GPS的yawrate和speed信號,而且車輛本身還有一套傳感器獲取yawrate和speed,又因?yàn)楹桔E推算是自動駕駛很重要的一部分,所以理解慣性導(dǎo)航的工作原理,能很好地幫助我們做基于車身的航跡推算。
 
ー 1 ー
慣性導(dǎo)航
目前GNSS+IMU構(gòu)成的組合導(dǎo)航系統(tǒng)是主流的定位系統(tǒng)方案,慣性導(dǎo)航系統(tǒng)是唯一可以輸出完備的六自由度數(shù)據(jù)的設(shè)備、數(shù)據(jù)更新頻率高、是定位信息的融合中心。
慣導(dǎo)中使用的核心算法主要包括3種:1. 慣性導(dǎo)航解算算法;2. 組合導(dǎo)航的卡爾曼濾波器的耦合。3. 環(huán)境特征信息與慣性導(dǎo)航融合。 
                
 
ー 2 ー
硬件及原理
慣性導(dǎo)航系統(tǒng)(INS)是利用慣性傳感器(IMU)測量載體的比力及角速度信息,結(jié)合給定的初始條件,與 GNSS等系統(tǒng)的信息融合,從而進(jìn)行實(shí)時推算速度、位置、姿態(tài)等參數(shù)的自主式導(dǎo)航系統(tǒng)。具體來說慣性導(dǎo)航系統(tǒng)屬于一種推算導(dǎo)航方式。即從一已知點(diǎn)的位置根據(jù)連續(xù)測得的運(yùn)載體航向角和速度推算出其下一點(diǎn)的位置,因而可連續(xù)測出運(yùn)動體的當(dāng)前位置。
            
 
慣性導(dǎo)航系統(tǒng)采用加速度計和陀螺儀傳感器來測量載體的運(yùn)動參數(shù)。其中三個垂直布置的陀螺儀用于測量載體繞自身三個坐標(biāo)軸的轉(zhuǎn)動角速度,同時也敏感地球自轉(zhuǎn)的角速度。
加速度計基于牛頓第二定律,采用電容式、壓阻式或熱對流原理,通過在加速過程中對質(zhì)量塊對應(yīng)慣性力的測量來獲得加速度值。用來測量運(yùn)動體坐標(biāo)系上各軸的加速度。
                    
 
慣導(dǎo)通過對陀螺儀測量的角速度進(jìn)行積分運(yùn)算和坐標(biāo)變換,計算車體的姿態(tài)角(橫滾、俯仰角)和方位角。根據(jù)姿態(tài)角可以計算出重力加速度在各個坐標(biāo)軸上的分量,加速度計測量得的各軸加速度,減去重力加速度分量后積分,得到速度和位置。慣導(dǎo)計算得到的狀態(tài),用于預(yù)測車輛當(dāng)前的位置,再和衛(wèi)星定位接收機(jī)得到的位置(或觀測數(shù)據(jù))進(jìn)行比較。比較的偏差包含了慣導(dǎo)的推算誤差和衛(wèi)星接收機(jī)的定位誤差,通過數(shù)據(jù)融合算法進(jìn)行加權(quán)后,用于修正慣導(dǎo)的預(yù)測,讓慣導(dǎo)的預(yù)測越來越準(zhǔn)確。
ー 3 ー
慣性導(dǎo)航解算算法
通常分以下幾步:
  • 姿態(tài)更新:對陀螺儀輸出的角速度進(jìn)行積分得到姿態(tài)增量,疊加到上次的姿態(tài)上;
  • 坐標(biāo)轉(zhuǎn)換:從IMU載體坐標(biāo)系到位置、速度求解坐標(biāo)系(慣性坐標(biāo)系);
  • 速度更新:需要考慮重力加速度的去除,得到慣性系下的加速度,通過積分得到速度;
  • 位置更新:通過速度積分得到位置。
          
 
在慣性導(dǎo)航中,導(dǎo)航方程的每一次迭代都需要利用上一次的導(dǎo)航結(jié)果作為初始值,因此慣導(dǎo)的初始化是比較重要的部分之一。姿態(tài)對準(zhǔn)是指得到IMU的roll, pitch, yaw。roll, pitch的對準(zhǔn)過程一般稱為調(diào)平。使當(dāng)車靜止時,加速度計測量的比力僅由重力導(dǎo)致,可以通過f=C*g來求解;對于非常高精度的IMU可通過羅經(jīng)對準(zhǔn)的方式,車靜止時,通過測量載體系中的地球自轉(zhuǎn)來確定載體的方位(yaw)。
           
 
ー 4 ー
組合導(dǎo)航的卡爾曼濾波器的耦合
使用Kalman濾波器的耦合,對IMU和GNSS即點(diǎn)云定位結(jié)果進(jìn)行融合。可分為松耦合和緊耦合兩種方法。
松耦合濾波器采用位置、速度量測值和解算的位置速度之差作為組合導(dǎo)航濾波器輸入,也即卡爾曼濾波器的量測量。緊耦合的數(shù)據(jù)包括GNSS的導(dǎo)航參數(shù)、定位中的偽距、距離變化等。
            
 
            
 
以百度阿波羅使用的慣導(dǎo)系統(tǒng)為例,采用了松耦合的方式,并且使用了一個誤差卡爾曼濾波器。慣性導(dǎo)航解算的結(jié)果用于Kalman濾波器的時間更新,即預(yù)測;而GNSS、點(diǎn)云定位結(jié)果用于Kalman濾波器的量測更新。Kalman濾波會輸出位置、速度、姿態(tài)的誤差用來修正慣導(dǎo)模塊,IMU期間誤差用來補(bǔ)償IMU原始數(shù)據(jù)。
         
 
ー 5 ー
環(huán)境特征信息與慣性導(dǎo)航融合
目前常用的GNSS+IMU組合慣導(dǎo)方案在一些場景的定位精度穩(wěn)定性仍不能完全滿足自動駕駛的要求。例如,城市樓宇群、地下車庫等GNSS長時間信號微弱的場景下,依靠GNSS信號更新精確定位穩(wěn)定性不足,因此必須引入新的精確定位更新數(shù)據(jù)源,在組合慣導(dǎo)中引入并融合激光雷達(dá)/視覺傳感定位等環(huán)境信息進(jìn)行融合定位成為必然趨勢。
                
 
以百度阿波羅的多傳感器融合定位系統(tǒng)解決方案為例,慣性導(dǎo)航系統(tǒng)處于定位模塊的中心位置,模塊將IMU、GNSS、Lidar等定位信息進(jìn)行融合,通過慣性導(dǎo)航系統(tǒng)解算修正后最終輸出滿足自動駕駛需求的6個自由度的高精度位置信息。
           
 
版權(quán)聲明:本文為博主「一實(shí)相印」的原創(chuàng)文章,遵循 CC 4.0 BY-SA 版權(quán)協(xié)議,轉(zhuǎn)載請附上原文出處鏈接和本聲明。
本文鏈接:https://blog.csdn.net/zhouyy858/article/details/103270157
 
 
分享到:
 
反對 0 舉報 0 收藏 0 評論 0
滬ICP備11026917號-25