基于有向幾何點和稀疏幀的激光里程計方法、系統(tǒng)、裝置

基本信息

申請?zhí)?/td> CN202011323411.6 申請日 -
公開(公告)號 CN112305554A 公開(公告)日 2021-02-02
申請公布號 CN112305554A 申請公布日 2021-02-02
分類號 G01S17/08(2006.01)I;G06T7/70(2017.01)I 分類 測量;測試;
發(fā)明人 梁爽;曹志強(qiáng);王誠鵬;李忠輝;亢晉立;譚民 申請(專利權(quán))人 北京能創(chuàng)科技有限公司
代理機(jī)構(gòu) 北京市恒有知識產(chǎn)權(quán)代理事務(wù)所(普通合伙) 代理人 郭文浩;尹文會
地址 100190北京市海淀區(qū)中關(guān)村東路95號
法律狀態(tài) -

摘要

摘要 本發(fā)明屬于服務(wù)機(jī)器人技術(shù)領(lǐng)域,具體涉及一種基于有向幾何點和稀疏幀的激光里程計方法、系統(tǒng)、裝置,旨在解決激光里程計方法中幀圖匹配效率較低的問題。本發(fā)明方法包括:獲取周圍環(huán)境在激光雷達(dá)傳感器當(dāng)前幀坐標(biāo)系下的原始三維點云數(shù)據(jù);構(gòu)建第一有向幾何點集、第一環(huán)境有向幾何點集;將第一有向幾何點集、第一環(huán)境有向幾何點集轉(zhuǎn)換到世界坐標(biāo)系中,得到第二有向幾何點集、第二環(huán)境有向幾何點集;計算第二有向幾何點集中的點在第二環(huán)境有向幾何點集中的候選關(guān)聯(lián)點,并確定出最佳關(guān)聯(lián)點;構(gòu)建位姿優(yōu)化函數(shù),并求解得到激光雷達(dá)傳感器當(dāng)前幀坐標(biāo)系到世界坐標(biāo)系的優(yōu)化后位姿;更新稀疏幀的有向幾何點集。本發(fā)明提高了幀圖匹配的效率。??