技術(shù)
導(dǎo)讀:高精度電子地圖包含大量的行車(chē)輔助信息。
高精度地圖作為無(wú)人駕駛發(fā)展成熟標(biāo)志的重要支撐,在橫向/縱向精確定位、基于車(chē)道模型的碰撞避讓、障礙物檢測(cè)和避讓、智能調(diào)速、轉(zhuǎn)向和引導(dǎo)等方面發(fā)揮重要作用,是無(wú)人駕駛的核心技術(shù)之一。精準(zhǔn)的地圖對(duì)無(wú)人車(chē)的定位、導(dǎo)航與控制,以及無(wú)人駕駛的安全至關(guān)重要。
與傳統(tǒng)電子地圖不同,高精度電子地圖的主要服務(wù)于對(duì)象是無(wú)人車(chē),或者說(shuō)是機(jī)器駕駛員。和人類(lèi)駕駛員不同,機(jī)器駕駛員缺乏人類(lèi)與生俱來(lái)的視覺(jué)識(shí)別、邏輯分析的能力。例如,人可以很輕松、準(zhǔn)確地利用圖像、GPS定位自己,鑒別障礙物、人、交通信號(hào)燈等,但這些對(duì)當(dāng)前的機(jī)器人來(lái)說(shuō)都是非常困難的任務(wù)。借助高精度地圖能夠擴(kuò)展車(chē)輛的靜態(tài)環(huán)境感知能力,為車(chē)輛提供其他傳感器提供不了的全局視野,包括傳感器監(jiān)測(cè)范圍外的道路、交通和設(shè)施信息。
高精度電子地圖
高精度電子地圖包含大量的行車(chē)輔助信息。這些輔助信息可以分成兩類(lèi),一類(lèi)是道路數(shù)據(jù),如道路車(chē)道線的位置、類(lèi)型、寬度、坡度和曲率等車(chē)道信息;另一類(lèi)是行車(chē)道路周?chē)嚓P(guān)的固定對(duì)象信息,如交通標(biāo)志、交通信號(hào)燈等信息、車(chē)道限高、下水道口、障礙物及其他道路細(xì)節(jié),還包括高架物體、防護(hù)欄、樹(shù)、道路邊緣類(lèi)型、路邊地標(biāo)等基礎(chǔ)設(shè)施信息。
所有上述信息都有地理編碼,因此導(dǎo)航系統(tǒng)可以準(zhǔn)確定位地形、物體和道路輪廓,從而引導(dǎo)車(chē)輛行駛。其中最重要的是對(duì)路網(wǎng)精確的三維表征(厘米級(jí)精度),例如路面的幾何結(jié)構(gòu)、道路標(biāo)示線的位置、周邊道路環(huán)境的點(diǎn)云模型等。有了這些高精度的三維表征,車(chē)載機(jī)器人就可以通過(guò)比對(duì)車(chē)載的GPS、IMU、LiDAR或攝像頭的數(shù)據(jù)精確地確認(rèn)自己當(dāng)前的位置。除此之外,高精度地圖還包含豐富的語(yǔ)義信息,比如交通信號(hào)燈的位置及類(lèi)型、道路標(biāo)示線的類(lèi)型、識(shí)別哪些路面是可以行使的,等等。
通過(guò)對(duì)高精度地圖模型的提取,可將車(chē)輛位置周邊的道路、交通、基礎(chǔ)設(shè)施等對(duì)象及對(duì)象之間的相對(duì)關(guān)系提取出來(lái)。這些能極大地提高車(chē)載機(jī)器人鑒別周?chē)h(huán)境的能力。此外,高精度地圖還能幫助無(wú)人車(chē)識(shí)別車(chē)輛、行人及未知障礙物,因?yàn)橐话愕牡貓D會(huì)過(guò)濾掉車(chē)輛、行人等活動(dòng)障礙物。如果無(wú)人車(chē)在行駛過(guò)程中發(fā)現(xiàn)當(dāng)前高精度地圖中沒(méi)有的物體,這些物體有很大的概率是車(chē)輛、行人或障礙物。因此,高精度地圖可以提高無(wú)人車(chē)發(fā)現(xiàn)并鑒別障礙物的速度和精度。
高精度地圖的特點(diǎn)
相比服務(wù)于GPS導(dǎo)航系統(tǒng)的傳統(tǒng)地圖而言,高精度地圖最顯著的特征是其表征路面特征的精準(zhǔn)性。一般情況下,傳統(tǒng)地圖只需要做到米量級(jí)的精度即可實(shí)現(xiàn)基于GPS的導(dǎo)航,但高精度地圖需要至少10倍以上的精度,即達(dá)到厘米級(jí)的精度才能保證無(wú)人車(chē)行駛的安全。
此外,高精度地圖還需要有比傳統(tǒng)地圖更高的實(shí)時(shí)性。由于道路路網(wǎng)每天都會(huì)有變化,比如道路整修、道路標(biāo)志線磨損及重漆、交通標(biāo)示改變等。這些改變需要及時(shí)反映在高精度地圖上以確保無(wú)人車(chē)行駛安全。要做到實(shí)時(shí)的高精度地圖有很高的難度,但隨著越來(lái)越多有多種傳感器的無(wú)人車(chē)行駛在網(wǎng)路中,一旦有一輛或幾輛無(wú)人車(chē)發(fā)現(xiàn)了路網(wǎng)的變化,通過(guò)和云端的通信,就可以把路網(wǎng)更新信息告訴其他人的無(wú)人車(chē),使得其他無(wú)人車(chē)變得更加聰明和安全。
(1)數(shù)據(jù)特征類(lèi)型
和傳統(tǒng)地圖相似,高精度地圖也具有分層的數(shù)據(jù)結(jié)構(gòu)。底層是一個(gè)基于紅外線雷達(dá)傳感器建立的精密二維網(wǎng)格。一般這個(gè)二維網(wǎng)格的精度保證在5x5厘米左右,可以行駛的路面、路面障礙物,以及路面在激光雷達(dá)下的反光強(qiáng)度都被存儲(chǔ)于相應(yīng)的網(wǎng)格中。無(wú)人車(chē)載行駛的過(guò)程中,通過(guò)比對(duì)其紅外線雷達(dá)搜集到的數(shù)據(jù)及其內(nèi)存中的高精二維網(wǎng)格,就能確定車(chē)輛在路面的具體位置。
除了底層的二維網(wǎng)格表征外,高精度地圖還包含很多有關(guān)路面的語(yǔ)義信息。在二維網(wǎng)格參照系的基礎(chǔ)上,高精度地圖一般還包含道路標(biāo)識(shí)線的位置及特征信息,以及相應(yīng)的車(chē)道特征。由于車(chē)載的傳感器可能會(huì)因?yàn)閻毫犹鞖狻⒄系K物,以及其他車(chē)輛的遮擋不能很可靠地分析出車(chē)道信息,高精度地圖中的車(chē)道信息特征能幫助無(wú)人車(chē)更準(zhǔn)確可靠地識(shí)別道路標(biāo)識(shí)線,并理解相鄰車(chē)道之間是否可以安全并道。
高精度地圖還會(huì)標(biāo)明道路標(biāo)示牌、交通信號(hào)燈等相對(duì)于二維網(wǎng)格的位置。這些信息有如下兩方面的作用。
(1)提前預(yù)備無(wú)人車(chē),告訴無(wú)人車(chē)在某些特定的位置檢測(cè)相應(yīng)的交通標(biāo)志牌或交通信號(hào)燈,提高無(wú)人車(chē)的檢測(cè)速度。
(2)在無(wú)人車(chē)沒(méi)有成功檢測(cè)出交通標(biāo)志牌或信號(hào)燈的情況下,確保行車(chē)的安全。
(2)數(shù)據(jù)量估計(jì)
無(wú)人車(chē)使用的高精度地圖是個(gè)2D的網(wǎng)格,數(shù)據(jù)主要由激光雷達(dá)產(chǎn)生,由于激光雷達(dá)的精度大約是5厘米左右,所以地圖的最高精度可以達(dá)到美國(guó)網(wǎng)格5厘米x5厘米。在如此高的精度下,如何有效地管理數(shù)據(jù)是高精度地圖的一個(gè)大挑戰(zhàn)。首先,為了盡量讓地圖在內(nèi)存里面,我們要盡量去掉不需要的數(shù)據(jù)。一般的激光雷達(dá)可覆蓋方圓100米的范圍,假設(shè)每個(gè)反光強(qiáng)度可以用一個(gè)字節(jié)記錄,那么每一次激光雷達(dá)掃描可以產(chǎn)生4MB的數(shù)據(jù)。這樣的掃描會(huì)包括公路旁邊的樹(shù)木及房屋,但是無(wú)人車(chē)的行駛并不需要這些數(shù)據(jù),我們只需要記錄公路表面的數(shù)據(jù)即可。假設(shè)路面的寬度為20米,那么我們可以通過(guò)數(shù)據(jù)處理把非公路表面的數(shù)據(jù)過(guò)濾掉,這樣每次掃描的數(shù)據(jù)量會(huì)下降到0.8MB。在過(guò)濾數(shù)據(jù)逇基礎(chǔ)上,我們可以使用無(wú)損的壓縮算法,比如LASzip去壓縮地圖數(shù)據(jù),可以達(dá)到超過(guò)10倍的壓縮率。經(jīng)過(guò)這些處理后,一個(gè)1TB的硬盤(pán)就可以存下全中國(guó)超10萬(wàn)公路的高精度地圖數(shù)據(jù)。
高精度地圖的制作
傳統(tǒng)的電子地圖主要依靠衛(wèi)星圖片產(chǎn)生,然后依靠GPS定位,這種方法可以達(dá)到米級(jí)精度,而高精地圖需要達(dá)到厘米級(jí)精度,僅僅靠衛(wèi)星與GPS是不夠的。因此,高精地圖的制作涉及多種傳感器,由于制作的數(shù)據(jù)量很大,通常我們會(huì)使用數(shù)據(jù)采集車(chē)收集數(shù)據(jù),然后通過(guò)線下處理把各種數(shù)據(jù)融合產(chǎn)生高精度地圖。
高精度地圖的制作是一個(gè)多傳感器融合的過(guò)程,包括以下傳感器。
(1)陀螺儀(IMU):一般會(huì)使用6軸運(yùn)動(dòng)處理組件,包含了3軸加速度和3軸陀螺儀。
(2)輪測(cè)距器(Wheel Odometer):可以通過(guò)輪測(cè)距器推算無(wú)人車(chē)的位置。在汽車(chē)的前輪通常安裝了輪測(cè)距器,會(huì)分別記錄左輪與右輪的總轉(zhuǎn)數(shù)。
(3)GPS):GPS接收機(jī)的任務(wù)就是確定四顆或更多衛(wèi)星的位置,并計(jì)算出它與每顆衛(wèi)星之間的距離,然后用這些信息使用三維空間的三邊測(cè)量法推算出自己的位置。
(4)LiDAR:光學(xué)雷達(dá)通過(guò)首先向目標(biāo)物體發(fā)射一速激光,然后根據(jù)接收-反射的時(shí)間間隔確定目標(biāo)物體的實(shí)際距離。根據(jù)距離及激光的角度,通過(guò)簡(jiǎn)單的幾何變化可以推導(dǎo)出物體的位置信息。
高精度地圖制作流程,過(guò)程中涉及了多個(gè)傳感器與多計(jì)算步驟。首先,陀螺儀(IMU)及輪測(cè)距器(Wheel Odometer)可以高頻率地給出當(dāng)前無(wú)人車(chē)的位置預(yù)測(cè),但是由于陀螺儀及輪測(cè)距器的精度原因,給出的位置可能會(huì)有一定程度的偏差。為了糾正這些偏差,我們可以使用傳感器融合技術(shù)(比如使用Kalman Filter)結(jié)合GPS與LiDAR的數(shù)據(jù)算出當(dāng)前無(wú)人車(chē)的準(zhǔn)確位置。然后根據(jù)當(dāng)前的準(zhǔn)確位置與激光雷達(dá)的掃描數(shù)據(jù),我們可以把新的數(shù)據(jù)加入地圖中。
下面的公式是個(gè)高度簡(jiǎn)化的高精地圖計(jì)算模型,Q代表優(yōu)化方程,z代表激光雷達(dá)掃描出的點(diǎn),h方程預(yù)測(cè)最新掃描點(diǎn)的位置與反光度,m掃描到的點(diǎn)在地圖中的位置,x代表無(wú)人車(chē)當(dāng)前的位置。這個(gè)方程的目的是通過(guò)最小J求出測(cè)量出的點(diǎn)在地圖中的準(zhǔn)確位置。在這個(gè)計(jì)算模型中,m與x開(kāi)始都是未知的,所以我們可以先通過(guò)多傳感器的融合求出無(wú)人車(chē)的位置x,然后求出測(cè)量點(diǎn)在地圖中的準(zhǔn)確位置m。
J = Q(z-h(m,x))