1.一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,方法包括以下步驟:
2.根據(jù)權(quán)利要求1所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,步驟s1具體為:
3.根據(jù)權(quán)利要求2所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,ecef坐標(biāo)系下的點(diǎn)云的每個(gè)點(diǎn)為:
4.根據(jù)權(quán)利要求1所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,步驟s2具體為:
5.根據(jù)權(quán)利要求4所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,所述匹配投影點(diǎn)簇對(duì)滿足:
6.根據(jù)權(quán)利要求1所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,步驟s3具體為:
7.根據(jù)權(quán)利要求1所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,步驟s4具體為:
8.根據(jù)權(quán)利要求7所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,所述旋轉(zhuǎn)矩陣rp為:
9.根據(jù)權(quán)利要求1所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,步驟s5具體為:
10.根據(jù)權(quán)利要求9所述的一種基于主輔式激光雷達(dá)和組合導(dǎo)航的道路三維重建方法,其特征在于,所述lm到lf的旋轉(zhuǎn)角β、旋轉(zhuǎn)軸向量k和旋轉(zhuǎn)軸上的一點(diǎn)p0為: