[發明專利]導航定位方法、裝置及機器人有效
| 申請號： | 201710519970.6 | 申請日： | 2017-06-30 |
| 公開（公告）號： | CN109211236B | 公開（公告）日： | 2022-03-04 |
| 發明（設計）人： | 徐方;孫銘澤;鄒風山;楊奇峰;趙彬;梁亮 | 申請（專利權）人： | 沈陽新松機器人自動化股份有限公司 |
| 主分類號： | G01C21/20 | 分類號： | G01C21/20;B25J19/00 |
| 代理公司： | 沈陽科苑專利商標代理有限公司 21002 | 代理人： | 許宗富 |
| 地址： | 110168 遼*** | 國省代碼： | 遼寧;21 |
| 權利要求書： | 查看更多 | 說明書： | 查看更多 |
| 摘要： | |||
| 搜索關鍵詞： | 導航 定位 方法 裝置 機器人 | ||
1.一種導航定位方法，其特征在于，所述方法包括：
在第一周期中，在第一時刻掃描第一點云數據，將所述第一點云數據作為基礎點云；
在第二時刻掃描第二點云數據，并將所述第一點云數據和所述第二點云數據進行匹配；
在第三時刻獲得所述第一點云數據和所述第二點云數據的偏差值及第二時刻的位姿數據；
獲取所述第二時刻和所述第三時刻之間所記錄的位移偏移量；
根據所述位移偏移量和所述第二時刻的位姿數據確定位姿修正數據；
將所述位姿修正數據對應的點云數據作為第二時刻下新的第二點云數據；
在進入下一周期掃描點云數據時將所述新的第二點云數據作為基礎點云進行匹配，以完成對整個場景的位姿修正；
其中，所述將所述第一點云數據和所述第二點云數據進行匹配，包括：
采用NDT匹配或ICP匹配對所述第一點云數據和所述第二點云數據進行匹配。
2.根據權利要求1所述的方法，其特征在于，所述獲取所述第二時刻和所述第三時刻之間所記錄的位移偏移量，包括：
利用碼盤獲取所述第二時刻和所述第三時刻之間所記錄的位移偏移量。
3.根據權利要求1所述的方法，其特征在于，所述在第一時刻掃描第一點云數據，包括：
在第一時刻掃描第一點云數據，并通過(x,y,z)的方式進行存儲。
4.根據權利要求1所述的方法，其特征在于，所述在第二時刻掃描第二點云數據，包括：
在第二時刻掃描第二點云數據，并通過(x,y,z)的方式進行存儲。
5.一種導航定位裝置，其特征在于，所述裝置包括：
掃描單元，用于在第一周期中，在第一時刻掃描第一點云數據，將所述第一點云數據作為基礎點云；
所述掃描單元還用于在第二時刻掃描第二點云數據，并將所述第一點云數據和所述第二點云數據進行匹配；
獲取單元，用于在第三時刻獲得所述第一點云數據和所述第二點云數據的偏差值及第二時刻的位姿數據；
所述獲取單元還用于獲取所述第二時刻和所述第三時刻之間所記錄的位移偏移量；
修正單元，用于根據所述位移偏移量和所述第二時刻的位姿數據確定位姿修正數據；
所述修正單元還用于將所述位姿修正數據對應的點云數據作為第二時刻下新的第二點云數據；
掃描單元還用于在進入下一周期掃描點云數據時將所述新的第二點云數據作為基礎點云進行匹配，以完成對整個場景的位姿修正；
其中，所述掃描單元還用于：采用NDT匹配或ICP匹配對所述第一點云數據和所述第二點云數據進行匹配。
6.根據權利要求5所述的裝置，其特征在于，所述掃描單元還用于：
利用碼盤獲取所述第二時刻和所述第三時刻之間所記錄的位移偏移量。
7.根據權利要求5所述的裝置，其特征在于，所述掃描單元還用于：
在第一時刻掃描第一點云數據，并通過(x,y,z)的方式進行存儲；或
在第二時刻掃描第二點云數據，并通過(x,y,z)的方式進行存儲。
8.一種機器人，其特征在于，應用于如權利要求1至4中任一項所述的導航定位方法。
該專利技術資料僅供研究查看技術是否侵權等信息，商用須獲得專利權人授權。該專利全部權利屬于沈陽新松機器人自動化股份有限公司，未經沈陽新松機器人自動化股份有限公司許可，擅自商用是侵權行為。如果您想購買此專利、獲得商業授權和技術合作，請聯系【客服】
本文鏈接：http://www.szxzyx.cn/pat/books/201710519970.6/1.html，轉載請聲明來源鉆瓜專利網。
- 上一篇：室內偽衛星定位系統及方法
- 下一篇：基于多充電樁的機器人位置校正方法和裝置
