(19)中华人民共和国国家知识产权局
(12)发明专利申请
(10)申请公布号 CN 109724592 A(43)申请公布日 2019.05.07
(21)申请号 201910158057.7(22)申请日 2019.03.03
(71)申请人 西北工业大学
地址 710072 陕西省西安市友谊西路127号(72)发明人 刘明雍 郭娇娇 牛云 王梦凡
杨扬 向举苗 王旭辰 (74)专利代理机构 西北工业大学专利中心
61204
代理人 陈星(51)Int.Cl.
G01C 21/08(2006.01)G01C 21/20(2006.01)
权利要求书1页 说明书7页 附图5页
(54)发明名称
一种基于进化梯度搜索的AUV地磁仿生导航方法
(57)摘要
本发明提出一种基于进化梯度搜索的AUV地磁仿生导航方法,将基于进化策略的地磁仿生导航和经典的梯度下降法结合起来搜索函数极值,利用地磁趋势性实现导航任务,不仅解决了基于梯度信息的线性搜索方法易陷入局部最优的不足,可以保证搜索具有全局最优性,而且具有快速的收敛性,弥补了进化搜索中的耗时长的缺点,可以提高地磁仿生导航的效率。
CN 109724592 ACN 109724592 A
权 利 要 求 书
1/1页
1.一种基于进化梯度搜索的AUV地磁仿生导航方法,其特征在于:包括以下步骤:步骤1:初始化,包括载体初始化和种群初始化:载体初始化:设定载体目标位置的地磁参量BT,测量起始位置的地磁参量B0;种群初始化:在搜索过程中,将航向角作为进化个体,产生初始化种群如下:θ={θθθ}1,2,...,λ其中,
λ为个体空间的个数,Δθ为采样间隔;
步骤2:利用进化梯度搜索策略确定下一时刻载体运动位置:在AUV上安装λ个地磁传感器,载体下一时刻运动的方向为地磁传感器测量到的地磁值对应的目标函数最小的方向;具体步骤如下:
步骤2.1:设AUV当前所在位置为(xj,yj),当前位置对应的地磁值为g(xj,yj),起始位置的地磁值为g(x0,y0),目标位置的地磁值为g(xt,yt);
步骤2.2:分别得到i个传感器采集到的地磁值g(xij,yij),i=1,...,λ;步骤2.3:由下式得出第i个传感器测得的地磁值对应的目标函数:
将求得目标函数最小的传感器所在的方向作为下一时刻AUV运动的航向:θθ{minFj+1=(xij,yij)};
步骤2.4:由下式引导AUV运动至下一位置(xj+1,yj+1):
L为采样周期内AUV的航行距离;步骤2.5:种群更新:如果趋近目标值的解:Fk<Fk-1,则保留该航向角,θθ否则更j+1=j;新航向角;
步骤3:到达目标位置判断:
若当前位置地磁目标函数与上一时刻目标函数满足下式:Fk<ε
表明当前位置地磁值无限接近目标位置,认为载体到达目标位置,否则返回步骤2继续进行搜索;其中ε为一个趋于0的设定值。
2