自動(dòng)駕駛之心多傳感器標(biāo)定全棧系統(tǒng)學(xué)習(xí)教程
2.由于每種傳感器的采樣頻率不一致,如lidar通常為10Hz,camera通常為25/30Hz,不同傳感器之間的數(shù)據(jù)傳輸還存在一定的延遲,那么可以通過(guò)尋找相鄰時(shí)間戳的方法找到最近鄰幀,如果誤差很大,可以采用硬同步觸發(fā),調(diào)整傳感器的固有頻率來(lái)達(dá)到一致性
3. 時(shí)間軟同步,分為幀率具有整數(shù)倍數(shù)關(guān)系的傳感器之間和非整數(shù)倍關(guān)系傳感器之間的時(shí)間對(duì)齊,整數(shù)倍的比較好處理,非整數(shù)倍的可以用內(nèi)插外推法,主要利用兩個(gè)傳感器幀上的時(shí)間標(biāo)簽,計(jì)算出時(shí)間差,然后通過(guò)包含有運(yùn)動(dòng)信息的目標(biāo)幀與時(shí)間差結(jié)合,推算出新的幀時(shí)各個(gè)目標(biāo)的位置,并于原有的兩幀 之間建立新的幀。
4. 空間同步,也就是不同傳感器坐標(biāo)系下的測(cè)量值轉(zhuǎn)換到同一坐標(biāo)系下,通俗理解為傳感器在整車坐標(biāo)系下的標(biāo)定參數(shù),其中一部分就是運(yùn)動(dòng)補(bǔ)償,比如純估計(jì)補(bǔ)償,用括ICP(Iterative Closest Point,迭代最近點(diǎn)算法)以及其相關(guān)的變種(VICP)來(lái)線性補(bǔ)償,但這是基于勻速運(yùn)動(dòng)假設(shè)基礎(chǔ)上的
5.運(yùn)動(dòng)補(bǔ)償方法之里程計(jì)輔助方法,是利用IMU信息對(duì)激光數(shù)據(jù)中每個(gè)激光點(diǎn)對(duì)應(yīng)的傳感器位姿進(jìn)行求解,即求 解對(duì)應(yīng)時(shí)刻傳感器的位姿,然后根據(jù)求解的位姿把所有激光點(diǎn)轉(zhuǎn)換到同一坐標(biāo)系下,然后封裝成 一幀激光數(shù)據(jù),發(fā)布出去(可以理解為激光點(diǎn)云 的去畸變)
1)通過(guò)IMU與點(diǎn)云數(shù)據(jù)時(shí)間對(duì)齊,然后對(duì)每個(gè)點(diǎn)進(jìn)行速度補(bǔ)償,通過(guò)時(shí)間戳進(jìn)行線性插值,然后將所有點(diǎn)云數(shù)據(jù)轉(zhuǎn)換到初始點(diǎn)云的IMU坐標(biāo)下
2)與上一幀的去完畸變的點(diǎn)云數(shù)據(jù)進(jìn)行幀間匹配,計(jì)算激光姿態(tài)。并通過(guò)計(jì)算的姿態(tài)對(duì)每個(gè)點(diǎn)云進(jìn)行線性補(bǔ)償,將所有的點(diǎn)云數(shù)據(jù)根據(jù)時(shí)間戳轉(zhuǎn)換到最 后一個(gè)點(diǎn)云數(shù)據(jù)時(shí)間戳下,即完成了里程計(jì)方法的補(bǔ) 償