申请/专利权人：国营芜湖机械厂

申请日：2019-10-17

公开（公告）日：2019-12-27

公开（公告）号：CN110617819A

主分类号：G01C21/20(20060101)

分类号：G01C21/20(20060101);G05D1/10(20060101)

优先权：

专利状态码：有效-授权

法律状态：2022.09.30#授权;2020.01.21#实质审查的生效;2019.12.27#公开

摘要：本发明涉及无人机地形辅助导航方法领域，具体是一种基于蚁群算法路径规划的无人机地形辅助导航方法，其具体步骤如下：S1：载入地形高程数据；S2：根据地形信息量，判断地形是否可匹配；S3：导入适配性地图，设置初始参数；S4：依据蚁群算法对路径进行规划；S5：用ICCP匹配所得位置信息对惯性导航系统输出位置信息进行校正；针对惯导误差随时间积累的问题，采用基于ICCP算法的地形辅助导航方法对惯导误差进行修正，以实现无人机长航时高精度的定位要求；针对地形辅助导航在地形变化不明显的区域无法有效修正惯导积累误差的问题，通过对导航区域地形信息量的计算，利用熵值法赋权灰色关联决策将地形划分为地形适配区与地形非适配区。

主权项：1.一种基于蚁群算法路径规划的无人机地形辅助导航方法,其特征在于：其具体步骤如下：S1：载入地形高程数据；S2：根据地形信息量，判断地形是否可匹配：S2.1：将路径规划中的地形区域划分为L块候选区域，L的值根据匹配定位精度和载体计算机存储容量确定；S2.2：根据无人机定位精度要求确定地形适配区与地形非适配区；S2.3：结合适配区划分结果，基于蚁群算法进行导航路径规划：1适配性矩阵，若网格所在地形为地形适配区则置0，非适配区则置去；2可达性矩阵，若网格i到网格j是可达的，则用LENi，j记录距离，若不可达，则LENi，j＝0；规定每一个网格可能到达的网格为其四周相邻的八个网格，及上、下、左、右、左上、左下、右上、右下方向的八个网格，若适配性矩阵是N维方阵，则可达性矩阵是N×N方阵；S3：导入适配性地图，设置初始参数：设置路径规划的起点网格为S,终点网格为E，设置出动蚁群的波数为K，每一波出动的蚂蚁只数为M；设置信息素启发因子为α，自启发因子为β，信息素蒸发系数为ρ，信息素增强系数为Q，设置对应于可达性矩阵的信息素矩阵的初始信息素浓度为c，c为一常数，用ROUTES记录每一波蚂蚁中的每只蚂蚁行进的路径，用PL记录每一波蚂蚁中的每一只蚂蚁行进路径的长度；S4：依据蚁群算法对路径进行规划：a：首先判断当前的网格是否是终点网格，若是则终止本只蚂蚁的寻径，启动下一只蚂蚁寻径；b：若不是则按照轮赌法选择下一个可前进的网格，通过轮赌法求出蚂蚁下一步可走的每一个网格的概率；c：假设蚂蚁下一步可以进入的网格为[g1，g2，g3]，按照公式计算得到进入每一个网格的概率为[ξ1，ξ2，ξ3]0≤ξ1，ξ2，ξ3≤1，且ξ1+ξ2+ξ3＝1，轮赌法按照下述方式进行：首先对进入每一个网格做累积概率统计，得到[ξ1ξ1+ξ2ξ1+ξ2+ξ3]＝[ξ1ξ1+ξ2]，然后产生一个0到1之间的随机数，若产生的随机数位于0和ξ1之间，则蚂蚁往网格g1前进，若位于ξ1和ξ1+ξ2之间，则蚂蚁往网格g2前进，若位于ξ1+ξ2和1之间，则蚂蚁往网格g3前进；d：更新路径和路径长度；e：重复步骤a和d，直到蚂蚁都到达终点或是陷入到死区，若蚂蚁未到达终点则至路径长度为0；f：重复步骤a到e，直至所有本波蚂蚁都到达了终点或是陷入了死区；g：更新信息素矩阵：当本波所有蚂蚁完成了路径选择之后，若蚂蚁到达了终点，对信息素进行更新；h：若所有波次蚂蚁均已进行了路径寻找，则输出所有路径中的最短路径及路径长度，寻径结束，否则，返回执行步骤a；i：依据步骤S2.3中规划的路径，采用等值线最近点迭代ICCP算法完成地形匹配，对惯导位置误差进行修正；j：获取惯导指示序列并进行初始变换：采用随机旋转和平移的方法进行初始变换，旋转和平移的大小在惯导系统误差方差的3倍范围内随意取值，取旋转偏移量为θrand，纬度方向的平移量为tL_rand，经度方向的随机平移量为tλ_rand，得到初始变换后的序列Pirand；k：提取高程等值线，寻找刚性变换求取最近点：通过机载气压高度表、无线电高度表获取初始变换后的位置序列Pirand处相应的高程值Hi，并从已知的数字地图中提取相应的高程等值线Ci；假设Pirand到相应等值线的最近点为Yi，寻找一个包含旋转矩阵R和平移矢量t的刚性变换T，得到最小目标函数d；l：迭代地进行刚性变换直至收敛：根据步骤3.2中获得的刚性变换T，对Pirand应用刚性变换可获得Pirand＝T·Pirand；此时，若迭代次数k大于最大迭代次数kmax，则表明收敛速度过慢，舍弃此次迭代地结果，并且返回执行步骤j；若迭代次数k小于最大迭代次数kmax并且|dk-dk-1|τ，则返回步骤3.2；若迭代次数k小于最大迭代次数kmax并且|dk-dk-1|≤τ，则迭代终止，确定最终匹配结果为[LICCPλICCP]T；S5：用ICCP匹配所得位置信息对惯性导航系统输出位置信息进行校正：将惯性导航系统输出的位置信息LSINS、λSINS与ICCP匹配得到的位置信息LICCP、λICCP的差值LSINS-LICCP、λSINS-λICCP作为观测量进行Kalman滤波，并利用滤波所得的位置信息反馈到惯性导航系统中对惯导输出的位置进行校正。

全文数据：

权利要求：

百度查询： 国营芜湖机械厂 一种基于蚁群算法路径规划的无人机地形辅助导航方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD