1.一種目標(biāo)的定位方法,其特征在于,包括:
獲取目標(biāo)的里程數(shù)據(jù)信息和周圍環(huán)境信息;其中,所述周圍環(huán)境信息至少包括激光數(shù)據(jù)信息和視覺(jué)深度數(shù)據(jù)信息;
根據(jù)所述激光數(shù)據(jù)信息和所述視覺(jué)深度數(shù)據(jù)信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第一分值函數(shù);
基于所述目標(biāo)的里程數(shù)據(jù)信息對(duì)所述第一分值函數(shù)進(jìn)行梯度優(yōu)化處理,確定所述目標(biāo)的第一位置信息。
2.根據(jù)權(quán)利要求1所述的方法,其特征在于,還包括:
根據(jù)確定的所述目標(biāo)的第一位置信息對(duì)所述目標(biāo)中的地圖進(jìn)行更新。
3.根據(jù)權(quán)利要求1或2所述的方法,其特征在于,所述獲取目標(biāo)的里程數(shù)據(jù)信息和周圍環(huán)境信息之前,還包括:
對(duì)所述目標(biāo)的第一位置信息和所述目標(biāo)中的地圖均進(jìn)行初始化,確定對(duì)應(yīng)的第一參考位置信息和參考地圖。
4.根據(jù)權(quán)利要求1所述的方法,其特征在于,所述根據(jù)所述激光數(shù)據(jù)信息和所述視覺(jué)深度數(shù)據(jù)信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第一分值函數(shù),包括:
根據(jù)所述激光數(shù)據(jù)信息及其對(duì)應(yīng)的第一權(quán)重信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第二分值函數(shù);
根據(jù)所述視覺(jué)深度數(shù)據(jù)信息及其對(duì)應(yīng)的第二權(quán)重信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第三分值函數(shù);
對(duì)所述第二分值函數(shù)和所述第三分值函數(shù)進(jìn)行求和運(yùn)算,得到與所述目標(biāo)的第一位置信息相關(guān)的第一分值函數(shù)。
5.根據(jù)權(quán)利要求4所述的方法,其特征在于,所述根據(jù)所述激光數(shù)據(jù)信息及其對(duì)應(yīng)的第一權(quán)重信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第二分值函數(shù),包括:
根據(jù)所述激光數(shù)據(jù)信息和所述目標(biāo)的第一位置信息,計(jì)算得到第一障礙物的第二位置信息;
從當(dāng)前二維地圖中的所有第二障礙物中選擇距離所述第一障礙物最小的第二障礙物;
計(jì)算所述第一障礙物的第二位置信息和所述選擇得到的第二障礙物的第三位置信息之間的第一距離;
為所述第一距離分配第一權(quán)重信息,以得到對(duì)應(yīng)于所述第一距離的第二分值函數(shù)。
6.根據(jù)權(quán)利要求4所述的方法,其特征在于,所述根據(jù)所述視覺(jué)深度數(shù)據(jù)信息及其對(duì)應(yīng)的第二權(quán)重信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第三分值函數(shù),包括:
根據(jù)所述視覺(jué)深度數(shù)據(jù)信息和所述目標(biāo)的第一位置信息,計(jì)算得到第三障礙物的第四位置信息;
從當(dāng)前三維地圖中的所有第四障礙物中選擇距離所述第三障礙物最小的第三障礙物;
計(jì)算所述第三障礙物的第四位置信息和所述選擇得到的第四障礙物的第五位置信息之間的第二距離;
為所述第二距離分配第二權(quán)重信息,以得到對(duì)應(yīng)于所述第二距離的第三分值函數(shù)。
7.根據(jù)權(quán)利要求1所述的方法,其特征在于,所述基于所述目標(biāo)的里程數(shù)據(jù)信息對(duì)所述第一分值函數(shù)進(jìn)行梯度優(yōu)化處理,確定所述目標(biāo)的第一位置信息,包括:
設(shè)置所述目標(biāo)的里程數(shù)據(jù)信息為所述目標(biāo)的第一位置信息的初始值;
按照優(yōu)化方向?qū)λ瞿繕?biāo)的第一位置信息進(jìn)行迭代更新;其中,所述優(yōu)化方向是根據(jù)所述第一分值函數(shù)隨所述第一位置信息的變化情況得到的;
直至迭代至預(yù)設(shè)要求時(shí),確定所述目標(biāo)的第一位置信息;其中,所述預(yù)設(shè)要求包括:所述第一位置信息的變化情況小于預(yù)設(shè)第一閾值和/或所述迭代的次數(shù)大于預(yù)設(shè)第二閾值。
8.根據(jù)權(quán)利要求2所述的方法,其特征在于,所述根據(jù)確定的所述目標(biāo)的第一位置信息對(duì)所述目標(biāo)中的地圖進(jìn)行更新,包括:
根據(jù)所述激光數(shù)據(jù)信息和確定的所述目標(biāo)的第一位置信息,計(jì)算得到第一障礙物的第二位置信息;根據(jù)所述第二位置信息更新當(dāng)前二維地圖中第二障礙物的第三位置信息;對(duì)確定的所述目標(biāo)的第一位置信息至第二障礙物的第三位置信息所連接的直線上的二維地圖進(jìn)行更新;
根據(jù)所述視覺(jué)深度數(shù)據(jù)信息和確定的所述目標(biāo)的第一位置信息,計(jì)算得到第三障礙物的第四位置信息;根據(jù)所述第四位置信息更新當(dāng)前三維地圖中第四障礙物的第五位置信息;對(duì)確定的所述目標(biāo)的第一位置信息至第四障礙物的第五位置信息所連接的直線上的三維地圖進(jìn)行更新。
9.根據(jù)權(quán)利要求8所述的方法,其特征在于,所述根據(jù)確定的所述目標(biāo)的第一位置信息對(duì)所述目標(biāo)中的地圖進(jìn)行更新之前,還包括:
將確定的所述目標(biāo)的第一位置信息代入第一分值函數(shù),得到對(duì)應(yīng)的第一分值;
根據(jù)所述第一分值、所述激光數(shù)據(jù)信息的數(shù)目和所述視覺(jué)深度數(shù)據(jù)信息的數(shù)目,計(jì)算確定的所述目標(biāo)的第一位置信息的置信度;
所述根據(jù)所述第二位置信息更新當(dāng)前二維地圖中第二障礙物的第三位置信息,包括:
基于所述第二位置信息和所述置信度更新當(dāng)前二維地圖中第二障礙物的第三位置信息;
所述根據(jù)所述第四位置信息更新當(dāng)前三維地圖中第四障礙物的第五位置信息,包括:
基于所述第四位置信息和所述置信度更新當(dāng)前三維地圖中第四障礙物的第五位置信息。
10.一種目標(biāo)的定位裝置,其特征在于,包括:
獲取模塊,用于獲取目標(biāo)的里程數(shù)據(jù)信息和周圍環(huán)境信息;其中,所述周圍環(huán)境信息至少包括激光數(shù)據(jù)信息和視覺(jué)深度數(shù)據(jù)信息;
建立模塊,用于根據(jù)所述激光數(shù)據(jù)信息和所述視覺(jué)深度數(shù)據(jù)信息,建立與所述目標(biāo)的第一位置信息相關(guān)的第一分值函數(shù);
確定模塊,用于基于所述目標(biāo)的里程數(shù)據(jù)信息對(duì)所述第一分值函數(shù)進(jìn)行梯度優(yōu)化處理,確定所述目標(biāo)的第一位置信息。