1.一種實時網(wǎng)格地圖重建方法,其特征在于,包括以下步驟:
2.根據(jù)權(quán)利要求1所述的實時網(wǎng)格地圖重建方法,其特征在于,采用以下方式確定點云數(shù)據(jù)中每個三維點所屬的體素單元:
3.根據(jù)權(quán)利要求2所述的實時網(wǎng)格地圖重建方法,其特征在于,采用以下公式計算每個三維點所屬體素單元的編號:
4.根據(jù)權(quán)利要求1所述的實時網(wǎng)格地圖重建方法,其特征在于,采用以下方式判斷所述體素單元的類型:
5.根據(jù)權(quán)利要求1所述的實時網(wǎng)格地圖重建方法,其特征在于,采用以下方式確定所述體素單元的表面重建方向:
6.根據(jù)權(quán)利要求1所述的實時網(wǎng)格地圖重建方法,其特征在于,對于每個表面重建方向,基于所述體素單元的三維點采用高斯過程估計得到重建點,包括:
7.根據(jù)權(quán)利要求1所述的實時網(wǎng)格地圖重建方法,其特征在于,對于每個表面重建方向,基于所述體素單元的三維點采用高斯過程估計得到重建點,包括:
8.根據(jù)權(quán)利要求6或7所述的實時網(wǎng)格地圖重建方法,其特征在于,基于所述觀測點在所述表面重建方向上的值采用以下公式得到所述網(wǎng)格點在所述表面重建方向上的數(shù)值:
9.根據(jù)權(quán)利要求6所述的實時網(wǎng)格地圖重建方法,其特征在于,對重建點進行三角化得到該表面重建方向的重建結(jié)果,包括:
10.根據(jù)權(quán)利要求2所述的實時網(wǎng)格地圖重建方法,其特征在于,采用以下公式將當前時刻的點云數(shù)據(jù)轉(zhuǎn)換到世界坐標系得到世界坐標系下當前時刻的點云數(shù)據(jù):