基于北斗網格碼的三維空間最短路徑規(guī)劃方法和裝置
基本信息
申請?zhí)?/td> | CN202111626184.9 | 申請日 | - |
公開(公告)號 | CN114485611A | 公開(公告)日 | 2022-05-13 |
申請公布號 | CN114485611A | 申請公布日 | 2022-05-13 |
分類號 | G01C21/00(2006.01)I | 分類 | 測量;測試; |
發(fā)明人 | 張建學;楊光輝;王焰輝;張敬亮;邵宗有 | 申請(專利權)人 | 中科星圖股份有限公司 |
代理機構 | 北京華專卓海知識產權代理事務所(普通合伙) | 代理人 | - |
地址 | 101399北京市順義區(qū)臨空經濟核心區(qū)機場東路2號(產業(yè)園1A-4號1、5、7層) | ||
法律狀態(tài) | - |
摘要
摘要 | 本公開提供了一種基于北斗網格碼的三維空間最短路徑規(guī)劃方法,包括:查找起始網格節(jié)點的相鄰格節(jié)點,確定相鄰網格節(jié)點與目標網格節(jié)點的距離估值,將距離估值最小的相鄰網格節(jié)點作為目標路徑上的網格節(jié)點;查找距離估值最小的目標路徑上的網格節(jié)點的26個相鄰的第二網格節(jié)點,去除其中確定過距離估值的第二網格節(jié)點,確定剩余第二網格節(jié)點與目標網格節(jié)點的距離估值,將距離估值最小且與目標節(jié)點的連線不與障礙物相交的第二網格節(jié)點作為目標路徑上的網格節(jié)點,以此方式確定目標路徑上的網格節(jié)點;確定其中的拐點并保留;對保留下來的拐點進行平滑處理。本公開的基于北斗網格碼的三維空間最短路徑規(guī)劃方法,能夠提高導航效率和導航結果準確性。 |
