基于北斗网格码的三维空间最短路径规划方法和装置

基本信息

申请号 CN202111626184.9 申请日 -
公开(公告)号 CN114485611A 公开(公告)日 2022-05-13
申请公布号 CN114485611A 申请公布日 2022-05-13
分类号 G01C21/00(2006.01)I 分类 测量;测试;
发明人 张建学;杨光辉;王焰辉;张敬亮;邵宗有 申请(专利权)人 中科星图股份有限公司
代理机构 北京华专卓海知识产权代理事务所(普通合伙) 代理人 -
地址 101399北京市顺义区临空经济核心区机场东路2号(产业园1A-4号1、5、7层)
法律状态 -

摘要

摘要 本公开提供了一种基于北斗网格码的三维空间最短路径规划方法,包括:查找起始网格节点的相邻格节点,确定相邻网格节点与目标网格节点的距离估值,将距离估值最小的相邻网格节点作为目标路径上的网格节点;查找距离估值最小的目标路径上的网格节点的26个相邻的第二网格节点,去除其中确定过距离估值的第二网格节点,确定剩余第二网格节点与目标网格节点的距离估值,将距离估值最小且与目标节点的连线不与障碍物相交的第二网格节点作为目标路径上的网格节点,以此方式确定目标路径上的网格节点;确定其中的拐点并保留;对保留下来的拐点进行平滑处理。本公开的基于北斗网格码的三维空间最短路径规划方法,能够提高导航效率和导航结果准确性。