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

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

    汽車測(cè)試網(wǎng)

  • 公眾號(hào)
    • 汽車測(cè)試網(wǎng)

    • 在線課堂

    • 電車測(cè)試

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

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