【技術實現步驟摘要】
本專利技術涉及一種地圖構建方法，具體涉及一種結合了慣性導航單元與激光雷達的室內平面地圖構建方法。
技術介紹
基于激光雷達的室內地圖構建在機器人領域應用越來越廣發。常見的有3d激光雷達和2d激光雷達。3d激光雷達掃描整個環境的3d模型，2d激光雷達至于機器人底部，掃面平面底圖。上述兩種方法都是依據關鍵幀拼接技術實現底圖構建。這種底圖構建方法由于對傳感器的位置估計是通過相鄰兩針的拼接得到的位移變化，在室內大范圍掃描時，兩兩相鄰位移的積分會產生累積誤差，使得最終的底圖構建效果不佳。尤其是對于激光雷達量程不夠大的情況，這種情況位姿累積的誤差會較大。其他大面積情況會出現地圖整體扭曲的情況。
技術實現思路
本專利技術將傳統的基于2d激光雷達的室內地圖構建方法與慣性導航相結合提升了地圖構建的精度，降低了地圖的扭曲感。具體內容如下：一種基于慣性導航單元與激光雷達的地圖構建方法，包括以下步驟：1)搭建掃描平臺掃描平臺由具有雙輪移動平臺的機器人構成，平臺上搭載一激光雷達與慣性導航單元；2)掃描數據遙控雙輪移動平臺，用激光雷達進行掃描，得到掃描數據，同時從平臺搭載的慣性導航單元讀取平臺的位姿信息；3)幀間拼接對于激光雷達掃描出的數據，對相鄰的兩幀采取ICP最近點迭代方法得到平臺的位姿變化；4)閉環檢測提取所有掃描幀的特征點并將特征點存入特征字典；對每個新的幀，在特征字典中查找匹配，若匹配成功則完成閉環檢測；5)圖優化對步驟3）得到的一系列幀間拼接的位姿進行圖優化，其中以每一幀觀測瞬間的位姿為節點，相鄰兩幀的位姿變化為邊構建優化圖；將優化圖輸入isam優化方法庫計算，得到優化出的每...
【技術保護點】
一種基于慣性導航單元與激光雷達的地圖構建方法，包括以下步驟：1)?搭建掃描平臺掃描平臺由具有雙輪移動平臺的機器人構成，平臺上搭載一激光雷達與慣性導航單元；2)?掃描數據遙控雙輪移動平臺，用激光雷達進行掃描，得到掃描數據，同時從平臺搭載的慣性導航單元讀取平臺的位姿信息；3)?幀間拼接對于激光雷達掃描出的數據，對相鄰的兩幀采取ICP最近點迭代方法得到平臺的位姿變化；4)?閉環檢測提取所有掃描幀的特征點并將特征點存入特征字典；對每個新的幀，在特征字典中查找匹配，若匹配成功則完成閉環檢測；5)?圖優化對步驟3）得到的一系列幀間拼接的位姿進行圖優化，其中以每一幀觀測瞬間的位姿為節點，相鄰兩幀的位姿變化為邊構建優化圖；將優化圖輸入isam優化方法庫計算，得到優化出的每一幀的中心點位姿，以及包括中心點位姿的處理后的優化圖；6)?加入慣性導航數據在上述處理后的優化圖中，結合每一幀激光雷達數據采集的瞬間讀取到的慣性導航單元的位姿變化信息，將對應的節點之間加入由慣性導航單元得到的位姿變化，如此構成的優化圖的每兩節點之間如果有邊則都有兩條。7)?二次圖優化對上述處理后的優化圖重新運行圖優化方法得到優化出的每...
【技術特征摘要】
1.一種基于慣性導航單元與激光雷達的地圖構建方法，包括以下步驟：1)搭建掃描平臺掃描平臺由具有雙輪移動平臺的機器人構成，平臺上搭載一激光雷達與慣性導航單元；2)掃描數據遙控雙輪移動平臺，用激光雷達進行掃描，得到掃描數據，同時從平臺搭載的慣性導航單元讀取平臺的位姿信息；3)幀間拼接對于激光雷達掃描出的數據，對相鄰的兩幀采取ICP最近點迭代方法得到平臺的位姿變化；4)閉環檢測提取所有掃描幀的特征點并將特征點存入特征字典；對每個新的幀，在特征字典中查找匹配，若匹配成功則完成閉環檢測；5)圖優化對步驟3）得到的一系列幀間拼接的位姿進行圖優化，其中以每一幀觀測瞬間的位姿為節點，相鄰兩幀的...
【專利技術屬性】
技術研發人員：虞坤霖，張濤，
申請(專利權)人：深圳市普渡科技有限公司，
類型：發明
國別省市：廣東;44
還沒有人留言評論。發表了對其他瀏覽者有用的留言會獲得科技券。