轉(zhuǎn)自：https://blog.csdn.net/mabingyao/article/details/104821307

主講人：萬(wàn)國(guó)偉 百度自動(dòng)駕駛事業(yè)部研發(fā)工程師

百度的無(wú)人車定位技術(shù)

1. 配置多種傳感器方案的自動(dòng)駕駛汽車成果展示

“探路者”車型：寶馬、北汽、奇瑞、MKZ——慣導(dǎo)和64線激光雷達(dá)，配置都比較高

無(wú)人駕駛微循環(huán)車“阿波龍”：百度×廈門金融——三個(gè)16線激光雷達(dá)，傳感器配置大概10w左右
無(wú)人駕駛物流車“新石器”：百度×創(chuàng)業(yè)公司——一個(gè)激光雷達(dá)，傳感器配置<5w

2. GNSS定位技術(shù)

GNSS定位

GPS（USA）、北斗（CHN）、GLONASS（RUS）、Galileo（EU）、QZSS（JPN）
GPS技術(shù)：
（1）衛(wèi)星星座（設(shè)計(jì)方案）：24顆GPS衛(wèi)星
（2）載波信號(hào)頻率：L1、L2
（3）信號(hào)調(diào)制：載波信號(hào)上調(diào)制有測(cè)距碼（L1–C/A碼和P碼；L2–P碼）和導(dǎo)航電文
（4）系統(tǒng)基本功能：定位（P）、測(cè)速（V）、授時(shí)（T）
（5）測(cè)距：三顆衛(wèi)星交會(huì)兩點(diǎn)，舍棄外部空間點(diǎn)，就可以得到自己的測(cè)繪點(diǎn)，由于鐘差，一般用四顆衛(wèi)星，剔除誤差

載波定位技術(shù)

RTK：所有衛(wèi)星把自己觀測(cè)的數(shù)據(jù)給基站和接收機(jī)，基站根據(jù)多個(gè)衛(wèi)星鐘差計(jì)算出一個(gè)誤差項(xiàng)，誤差項(xiàng)傳遞給車端，車端利用誤差項(xiàng)消除自己的觀測(cè)誤差，最后達(dá)到模糊度的固定。然后整周計(jì)算，最后得到精準(zhǔn)的位置。
（1）基本原理：20km基線/22000km地衛(wèi)距，視徑重疊誤差強(qiáng)相關(guān)
（2）優(yōu)勢(shì)：基本5秒內(nèi)就可以提供cm級(jí)定位精度
（3）劣勢(shì)：建基站、雙向鏈路（4kpbs）
（4）發(fā)展趨勢(shì)：終端低成本化、數(shù)據(jù)協(xié)議5G標(biāo)準(zhǔn)化
PPP：基站將衛(wèi)星發(fā)送的數(shù)據(jù)誤差做分離處理，再傳遞給衛(wèi)星，此時(shí)衛(wèi)星已經(jīng)剔除了誤差，再對(duì)車端定位
（1）基本原理：各項(xiàng)誤差被單獨(dú)分離后終端矯正
（2）優(yōu)勢(shì)：全球均勻布站100+，單向廣播
（3）當(dāng)前劣勢(shì)：建15+min的收斂時(shí)間；接收GEO廣播需授權(quán)
（4）發(fā)展趨勢(shì)：LEO-GNSS增強(qiáng)

GNSS/GPS在無(wú)人車中的作用

GPS授時(shí)：為無(wú)人車提供納秒（ns）級(jí)的授時(shí)精度
HD-MAP制圖
在線定位

存在挑戰(zhàn)

可靠性：不封閉，易受電磁干擾
可用性：城市峽谷和林蔭路效果不好，很難達(dá)到cm級(jí)

3. 激光點(diǎn)云定位技術(shù)

百度激光點(diǎn)云定位算法框架

兩個(gè)模塊：圖像對(duì)齊、SSD-HF。 圖像對(duì)齊用于航向角（yaw）的優(yōu)化，SSD-HF用于（x，y）的優(yōu)化，z從點(diǎn)云地圖中輸出。

定位地圖以數(shù)據(jù)形式存在

（1）定位地圖每個(gè)格子的大小是128m×128m，每個(gè)各自拿出來(lái)得到反射值地圖塊和高度值地圖塊。
（2）反射值地圖塊：反射值可以理解為灰度值，圖中有車道線等，再分成1024×1024，每個(gè)小格子的大小為12.5cm，存儲(chǔ)了反射值、反射值方差。
（3）高度值地圖塊：存放高度z

輸入預(yù)測(cè)位姿+實(shí)時(shí)點(diǎn)云數(shù)據(jù)。輸出用于進(jìn)行進(jìn)一步融合定位

定位
----- x，y方向的定位
（1）SSD—Sum of Squared Difference（平方差總和）
每個(gè)激光點(diǎn)有對(duì)應(yīng)的顏色值或高度值，地圖上找一個(gè)對(duì)應(yīng)點(diǎn)，二者相減，再求平方，再把所有點(diǎn)誤差加起來(lái)。

（2）HF—直方圖濾波器
在一個(gè)范圍內(nèi)每一個(gè)點(diǎn)都計(jì)算SSD值，最后把這個(gè)值轉(zhuǎn)換成一個(gè)概率，得到一個(gè)分布圖，紅色表示響應(yīng)度高，藍(lán)色表示概率低，綠色是過(guò)渡。
----- 航向角優(yōu)化——基于LK算法
（1）不做航向角優(yōu)化直接匹配，會(huì)發(fā)現(xiàn)有比較大的x，y方向的偏差，這在無(wú)人車系統(tǒng)中造成的威脅是很大的。
（2）基于LK算法的框架，對(duì)顏色值和高度值進(jìn)行優(yōu)化，一般情況下誤差很小，可以采用這個(gè)方法。若誤差很大，這個(gè)方法不適用。
----- 反射值與高度值自適應(yīng)融合
由于地面變化，在單一的反射值匹配和高度值匹配時(shí)可能不能得到很好的直方圖，這時(shí)，通過(guò)自適應(yīng)算法分別給反射值匹配和高度值匹配一個(gè)權(quán)重，最后融合到一個(gè)直方圖中去。對(duì)比匹配結(jié)果如下圖：

4. 視覺(jué)定位技術(shù)

視覺(jué)定位是通過(guò)識(shí)別圖像中具有語(yǔ)義信息的穩(wěn)定特征，并于地圖匹配來(lái)獲得車輛的位置和朝向。
特點(diǎn)：
（1）攝像頭技術(shù)成熟，結(jié)構(gòu)化地圖尺寸小，有利于降低系統(tǒng)生產(chǎn)成本。
（2）車道線，路燈等道路元素穩(wěn)定性高，不易變動(dòng)，地圖生命周期較長(zhǎng)。
（3）配置靈活，根據(jù)識(shí)別算法性能，可以使用不同的特征組合，易于拓展。
算法流程：

（1）3D特征地圖離線生成，是基于視覺(jué)的全局定位算法基礎(chǔ)。
（2）圖像特征檢測(cè)及匹配是定位算法的核心，IMU和輪速計(jì)信息在這個(gè)環(huán)節(jié)用于估計(jì)車輛運(yùn)動(dòng)。
（3）最后的數(shù)據(jù)融合可以將GPS、視覺(jué)定位和IMU數(shù)據(jù)整合，優(yōu)化定位結(jié)果，并提供高頻輸出。

5. 捷聯(lián)慣性導(dǎo)航技術(shù)

捷聯(lián)慣性導(dǎo)航系統(tǒng)

概述

初始條件：已知的初始速度、位置、姿態(tài)
輸入數(shù)據(jù)：慣性測(cè)量元件測(cè)量到的載體相對(duì)于慣性空間角運(yùn)動(dòng)和線運(yùn)動(dòng)參數(shù)。
解算方法：捷聯(lián)慣性導(dǎo)航解算，IMU數(shù)據(jù)積分
輸出結(jié)果：實(shí)時(shí)的載體速度、位置和姿態(tài)
優(yōu)點(diǎn)：
（1）自主性、隱蔽性
（2）三維速度、位置和姿態(tài)
（3）輸出頻率高
（4）短時(shí)間精度高
缺點(diǎn)：誤差隨時(shí)間累積

慣性測(cè)量單元IMU

組成單元：陀螺儀、加速度計(jì)
輸出元素
（1）加速度計(jì)能夠測(cè)量出載體相對(duì)于慣性空間所受的力
（2）陀螺儀能夠測(cè)量出載體沿陀螺儀軸向的旋轉(zhuǎn)角速度或旋轉(zhuǎn)增量
功能
IMU是慣性導(dǎo)航系統(tǒng)的基礎(chǔ)，直接決定了慣性導(dǎo)航系統(tǒng)所能達(dá)到的精度。

捷聯(lián)慣性導(dǎo)航系統(tǒng)——初始對(duì)準(zhǔn)

把載體坐標(biāo)系或者說(shuō)IMU坐標(biāo)系與世界坐標(biāo)系（也可以叫導(dǎo)航坐標(biāo)系）對(duì)應(yīng)起來(lái)，要對(duì)準(zhǔn)位置和姿態(tài)
對(duì)準(zhǔn)方式不同：
高精度IMU：
（1）精度等級(jí)：陀螺儀零偏<1°/h，加速度計(jì)零偏<1mg
（2）特點(diǎn)：能夠敏感到地球自轉(zhuǎn)角速度（15°/h）
（3）原理：重力矢量與地球自轉(zhuǎn)矢量不共線、Kalman濾波速度匹配精對(duì)準(zhǔn)
（4）典型IMU：光纖和激光IMU
低等級(jí)IMU：
（1）精度等級(jí)：陀螺儀零偏>1°/h，加速度計(jì)零偏>1mg
（2）特點(diǎn)：無(wú)法敏感到地球自轉(zhuǎn)角速度（15°/h）、測(cè)量噪聲大、存在隨機(jī)開(kāi)機(jī)零偏等誤差
（3）原理：加速度計(jì)水平對(duì)準(zhǔn)、航向粗對(duì)準(zhǔn)（外部輔助，磁強(qiáng)計(jì)，gps速度等）、Kalman濾波速度匹配精對(duì)準(zhǔn)
（4）典型IMU：MEMS以及消費(fèi)級(jí)IMU
（5）航向優(yōu)化方式：雙天線，或者得到車行駛起來(lái)的速度，或直接使用dps速度

捷聯(lián)慣性導(dǎo)航系統(tǒng)——解算
捷聯(lián)解算框圖

6. 組合導(dǎo)航技術(shù)

組合導(dǎo)航系統(tǒng)

概述

系統(tǒng)組成：兩種或兩種以上非相似的導(dǎo)航系統(tǒng)（如GNSS、SINS等）
必要條件：可以對(duì)同一信息進(jìn)行測(cè)量（如GNSS、SINS都可以計(jì)算出載體的位置速度信息）
融合方法：以SINS的誤差方程作為Kalman濾波的狀態(tài)方程，GNSS等其他系統(tǒng)與SINS的誤差作為觀測(cè)量進(jìn)行SINS的誤差估計(jì)，并對(duì)SINS進(jìn)行矯正。
優(yōu)點(diǎn)：
（1）協(xié)同：超越單一子系統(tǒng)的性能，彌補(bǔ)各個(gè)單一子系統(tǒng)的缺點(diǎn)
（2）優(yōu)勢(shì)互補(bǔ)：充分發(fā)揮各個(gè)子系統(tǒng)的優(yōu)勢(shì)
（3）余度：提高系統(tǒng)的穩(wěn)定性

百度組合導(dǎo)航系統(tǒng)——系統(tǒng)框圖
注意：從SINS模塊輸出的原因：高頻輸出

總結(jié)

以上是生活随笔為你收集整理的三、Apollo自定位技术详解（百度无人车定位技术）的全部?jī)?nèi)容，希望文章能夠幫你解決所遇到的問(wèn)題。

如果覺(jué)得生活随笔網(wǎng)站內(nèi)容還不錯(cuò)，歡迎將生活随笔推薦給好友。