基于北斗網格碼的三維空間最短路徑規(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ī)劃方法,能夠提高導航效率和導航結果準確性。