基于动态规划制导的无人艇自主回收控制方法.pdf
《基于动态规划制导的无人艇自主回收控制方法.pdf》由会员分享,可在线阅读,更多相关《基于动态规划制导的无人艇自主回收控制方法.pdf(8页珍藏版)》请在咨信网上搜索。
1、本文网址:http:/www.ship- J.中国舰船研究,2024,19(1):264271.GUO W X,LI Z H,TANG G Y,et al.Autonomous recovery control method for USV based on dynamic programmingguidanceJ.Chinese Journal of Ship Research,2024,19(1):264271(in both Chinese and English).基于动态规划制导的无人艇自主回收控制方法扫码阅读全文郭文轩1,李子豪1,唐国元*1,王泉斌2,孙江龙1,马杰3,乔瑜41
2、华中科技大学 船舶与海洋工程学院,湖北 武汉 4300742 中国舰船研究设计中心,湖北 武汉 4300643 华中科技大学 人工智能与自动化学院,湖北 武汉 4300744 华中科技大学 能源与动力工程学院,湖北 武汉 430074摘 要:目的目的针对欠驱动无人艇(USV)自主回收的需求,提出一种基于动态规划制导的跟踪控制方法。方法方法在运动学层面,将平行接近制导(CB)与动态窗口算法(DWA)相结合,引导 USV 实现目标跟踪与动态避障;在动力学层面,针对模型参数及回收环境的不确定性,采用径向基函数神经网络(RBFNN)设计动力学 滑 模 控 制 器,实 现 对 制 导 输 出 的 跟 踪
3、 控 制。随 后,采 用 Lyapunov 理 论 对 系 统 的 稳 定 性 进 行 分 析。结果结果仿真结果表明,所提方法使 USV 具备了稳定跟踪性能,可有效规避回收过程中的动态障碍,并能自适应估计模型中的不确定因素和未知的环境干扰。结论结论所提方法展现出较强的鲁棒性与灵活性,可为USV 在动态环境下的回收进行制导与目标跟踪提供参考。关键词:欠驱动无人艇;平行接近制导;动态窗口法;神经网络;滑模控制中图分类号:U664.82文献标志码:ADOI:10.19693/j.issn.1673-3185.03397 Autonomous recovery control method for U
4、SVbased on dynamic programming guidanceGUO Wenxuan1,LI Zihao1,TANG Guoyuan*1,WANG Quanbin2,SUN Jianglong1,MA Jie3,QIAO Yu41 School of Naval Architecture and Ocean Engineering,Huazhong University of Science and Technology,Wuhan 430074,China2 China Ship Development and Design Center,Wuhan 430064,China
5、3 School of Artificial Intelligence and Automation,Huazhong University of Science and Technology,Wuhan 430074,China4 School of Energy and Power Engineering,Huazhong University of Science and Technology,Wuhan 430074,ChinaAbstract:ObjectiveThis paper presents a tracking control method based on dynamic
6、 programming guid-ance to address the challenges presented by the autonomous recovery of underactuated unmanned surfacevehicles(USVs).MethodsAt the kinematic level,constant bearing approach(CB)guidance is combinedwith a dynamic window algorithm(DWA)to guide the USV in achieving target tracking and d
7、ynamic obstacleavoidance.At the dynamic level,considering the uncertainties in the model parameters and recovery environ-ment,a radial basis function neural network(RBFNN)is employed to design a dynamic sliding mode control-ler for the tracking control of the guidance output.Finally,the stability of
8、 the system is analyzed using Lya-punov theory.ResultsThe simulation results demonstrate that the proposed method enables the USV toexhibit stable tracking performance,effectively avoid dynamic obstacles during the recovery process and ad-apt to uncertain factors in the estimation model and unknown
9、environmental disturbances.ConclusionTheproposed method exhibits strong robustness and flexibility,providing valuable references for the guidance andtarget tracking of USVs during recovery in dynamic environments.Key words:underactuated unmanned surface vehicle;constant bearing guidance;dynamic wind
10、ow ap-proach;neural networks;sliding mode control收稿日期:20230605 修回日期:20230805 网络首发时间:20231220 17:43基金项目:“慧眼行动”创新成果转化应用资助项目(626020204)作者简介:郭文轩,男,1997 年生,硕士。研究方向:水面无人艇制导与控制。E-mail:guowenxuan_李子豪,男,2001 年生,硕士生。研究方向:水面无人艇运动控制。E-mail:唐国元,男,1973 年生,博士,教授,博士生导师。研究方向:舰船与水下航行器运动控制。E-mail:*通信作者:唐国元 第 19 卷 第 1
11、期中 国 舰 船 研 究Vol.19 No.12024 年 2 月Chinese Journal of Ship ResearchFeb.2024 0 引言近年来,随着海洋环境的日益复杂和海上作业范围的逐渐扩大,高新技术的海洋装备势必朝着智能化和集群化的方向发展1。作为一种以遥控或自主方式航行的多用途小型水面运载平台,无人艇(unmanned surface vehicles,USVs)执行完远海任务后通常需要回收到母船上补充能量,以及进行数据交换等艇旁操作。因此,有必要针对USV 的回收技术展开研究。为实现高精度的回收引导控制,国内外学者展开了大量研究。Pearson 等2开发了模糊逻辑Wa
12、ypoint-Heading 控制器,用于根据航路点航向目标向低级控制器提供所需的航向和速度命令,并进行仿真实验。白一鸣等3针对欠驱动USV 的路径跟踪控制问题,基于改进的自适应积分视线(improved adaptive integral line-of-sight,IAILOS)制导方法,通过引入降阶的扩张状态观测器,提高USV 对复杂海况的适应性,利用径向基函数神经网络(radial basis function neural network,RBFNN)的无限逼近特性估计 USV 动力学模型中的不确定项和未知的外部环境干扰,设计了积分滑模路径跟踪控制器。以上方法仅局限于路径已知情形,但
13、在面向回收任务时还需充分考虑目标机动状态下的不确定性。徐海彬等4为实现自主回收USV,通过 USV 和悬浮托架的双向视觉导引,构建基于视觉和定位系统的 USV 自主对接系统。高剑等5着眼于自主水下航行器(AUV)的对接回收技术,提出了基于人工势场的回收路径规划,并设计了滑模跟踪控制律用于解决回收避障问题。以上回收控制方法大多未充分考虑回收避障问题,尤其是回收过程中的动态避障,这在无人集群控制中尤为重要。在集群回收任务中,为满足多航行体协调控制,通常需要将每台无人装备视为独立的个体6以完成自主引导与跟踪控制,同时确保装备间无碰撞。现有的 USV 回收控制方法多是根据已知的期望目标进行制导,未考虑
14、回收避障问题,难以满足集群规模下装备间的避障回收要求。为此,本文拟围绕欠驱动 USV 的自主回收需求,提出一种基于动态规划制导的跟踪控制方法,并着眼于制导及控制 2 个方面,实现 USV 的动态避障与目标跟踪。在运动学层面,将平行接近制导(CB)与动态窗口算法(DWA)相结合,得到制导律的解析解;在动力学层面,针对外界环境干扰导致 USV模型参数不确定的情况,采用径向基函数神经网络设计动力学滑模控制器,实现对制导输出的跟踪控制,完成 USV 在动态环境下的自主回收控制。1 回收策略与控制模型采用母船艉滑道对USV 进行回收,是海上USV重要的回收方式之一7。如图 1 所示,根据艉滑道式回收技术
15、要求,USV 需持续识别周围障碍物和母船的运动状态,在风、浪、流等外界环境的干扰下持续跟踪母船,规避静态及动态障碍物,不断调整自身位姿,驶入滑道完成回收。目标母船母船航迹回收轨迹待回收艇移动障碍及其轨迹障碍物图 1USV 回收过程航行轨迹示意图Fig.1 Navigation trajectory of USV recovery process 本文将围绕欠驱动 USV 的回收控制问题进行研究,主要考虑其水平面的三自由度运动。可通过以下非线性数学模型进行描述:x=ucosvsin y=usin+vcos=r u=fu(u,v,r)+um11 v=fv(u,v,r)r=fr(u,v,r)+rm3
16、3(1)fu(u,v,r)=m22m11vr1m11gx(u)fv(u,v,r)=m11m22ur1m22gy(v)fr(u,v,r)=m11m22m33uv1m33gz(r)(2)gx(u)=d11uEugy(v)=d22vEvgz(r)=d33rEr(3)x,yu,rm11,m22,m33d11,d22,d33上式中:为 USV 在水面的位置;为艏摇角;u 为纵荡速度;v 为横荡速度;r 为艏摇角速度;分别为欠驱动 USV 的推进力和转向力矩,其横向无控制力;为 USV 固有和附加的质量参数,在此为已知项;为忽略高阶阻尼后的水动力阻尼,在此为不确定第 1 期郭文轩等:基于动态规划制导的无人
17、艇自主回收控制方法265Eu,Ev,Er项;为水平面三自由度运动下的干扰力,包括系统自身的不确定性和风浪流的干扰,为不确定项且有界。欠驱动 USV 的横荡运动通常由外界环境或船体本身的特性引起,本文在回收控制器的设计过程中,控制期望仅考虑了其纵荡线速度和艏摇角速度,以减少对 USV 动力学模型的要求,提高控制的可行性和鲁棒性。图 2 所示为 USV 回收控制策略示意图。首先,根据目标母船滑道的状态,引入平行接近制导,优化动态窗口算法,进而得到回收制导的控制期望;考虑到实际回收航行过程中由外界环境干扰导致的模型参数不确定,在控制层设计出一种基于神经网络的滑模控制器,利用径向基函数神经网络来估计
18、USV 模型中的未知项,应用滑模控制理论设计跟踪控制算法,实现对回收制导期望的精确跟踪,最终完成艉滑道式自主回收任务。目标母船滑道状态平行接近制导动态窗口避障x,y,u,rru控制期望跟踪误差滑模控制器RBFNN自适应律+外部环境扰动Eu,Ev,Er无人艇图 2无人艇回收控制策略示意图Fig.2 Block diagram of recovery control strategy for USV 2 回收制导规划 2.1 全局目标跟踪所谓全局目标跟踪,即从全局可用信息的角度实现对母船的跟踪,常见的目标跟踪制导方法主要包括视线(LOS)制导、纯追踪制导和平行接近制导 3 种8。其中,平行接近制导
19、是指将目标视线保持平行移动的一种导引方法,即在回收引导的过程中母船相对 USV 的方位恒定,最终将 USV与目标母船间的视距旋转率降低至定值并保持。相比其他导引方法,平行接近制导的航行轨迹较平直,且受机动目标影响较小9。本文基于平行接近制导策略,建立了全局跟踪导航模型。OEXEYEF(t)=x(t),y(t)TT(t)=xg(t),yg(t)TV(t)=dF(t)/dt=F(t)Vg(t)=T(t)面向回收需求,本文只考虑了 USV 和母船向前航行的情况,未考虑倒车,故其控制目标为:在指定方位保持对目标母船的稳定跟踪。图 3 所示为回收场景下对目标进行全局跟踪时的速度分解关系。图中,为大地坐标
20、系,若某时刻USV 的位置为,母船目标滑道的位置为,则 USV 的速度矢量为,期望跟踪位置速度矢量为。p(t)=T(t)F(t)令为目标位置相对 USV 的距离矢量,则平行接近制导在本文的控制目标为limxp(t)=0(4)基于平行接近制导律的速度分解图,可得10 YEVg(t)V(t)UmaxT(xg(t),yg(t)F(x(t),y(t)OEXE图 3跟踪导航速度分解图Fig.3 The velocity assignment associated with guidance V(t)=Vg(t)+Umaxp(t)p(t)Tp(t)+2P(5)UmaxUmax 0PP 0式中:为 USV
21、沿视线方向靠近期望位置的最大接近速度,要求才能保障 USV 能够达到期望跟踪位置;为防撞常数,。因此,基于平行接近制导原理的运动学制导律为uf=|V(t)|=x(t)2+y(t)2f=atan2(y(t),x(t)(6)ufff(,式中:为 USV 的跟踪引导速度;为 USV 的引导航向,且满足。2.2 局部动态避障局部动态避障旨在基于局部环境信息进行航266“无人船艇自主性技术”专辑第 19 卷速决策以及位姿调整,使得 USV 在回收过程中能够安全、高效地绕过障碍物。考虑到回收过程中对 USV 航速和输出力矩的限制,为此,本文引入了动态窗口算法,以实现 USV 在动态环境下的自主避障。动态窗
22、口算法的原理为:首先,根据 USV 的运动特性生成速度窗口,在空间中对每一时刻的纵荡速度 u 和艏摇角速度 r 进行采样,模拟预测在每个速度状态下 USV 在时间 t 内可能的运动航迹;然后,引入评价函数确定最优轨迹11。动态窗口算法在生成速度窗口时,首先需满足 USV 运动特性的约束条件:Vs=us,rs?us u uxt,u+uxtrs r rxt,r+rxt(7)ux,rx式中:分别为 USV 的线加速度最大值与角加速度最大值;t 为采样间隔时间。同时,还需考虑推进器的性能参数。USV 的纵荡速度和艏摇角速度均受限于物理驱动:Vr=ur,rr|ur 0,umax,rr rmax,rmax
23、(8)umaxrmax式中,和分别为 USV 的纵荡速度最大值和艏摇角速度最大值。考虑到 USV 回收航行过程中的安全性,若要确保 USV 能够在碰到障碍之前停下,还需对 USV的制动情况进行约束。Va=ua,ra?ua2dist(u,r)uxra2dist(u,r)rx(9)dist(u,r)式中,为轨迹末端与最近障碍物间的距离。其后,可得到下一时刻的速度取值范围为Vd=VsVrVa(10)USV 的运动航迹可由以下参数方程给出:xd(t+t)yd(t+t)d(t+t)=xd(t)yd(t)d(t)+tud(t)cosd(t)ud(t)sind(t)rd(t)(11)然后,利用评价函数对每条
24、轨迹进行评分:G(u,r)=(heading(u,r)+dist(u,r)+vel(u,r)(12)heading(u,r)=|f|dist(u,r)vel(u,r)式中:为航向评价函数,用于衡量 USV 偏离目标航向的程度,在此取,表示 USV 当前航向与平行接近制导期望航向的偏差,偏差越大,评分越低,即保证局部避障的同时,实现全局最优制导;在此作为距离评价 函 数;为 速 度 评 价 函 数,其 取 值 为USV 当前纵荡速度,在确保安全行驶的前提下,uf,越趋近于全局目标跟踪的期望航速,评分将越高;均为权重因子;为正则化因子,其使得 3 个部分的权重更加平滑。ud,rdurudrd最后,
25、取使评价函数值最大的作为最优制导输出虚拟控制量。至此,回收控制问题可描述为:设计合适的纵向推进力和转向力矩,使USV 能够以制导速度和航行。3 基于神经网络的控制器设计 3.1 自适应神经网络控制器设计ue=uudre=rrdur由于速度误差是由独立的动力学控制律镇定的,故定义纵荡速度误差,艏摇角速度误差。可以将控制目标进一步描述为:设计合适的纵向推进力和转向力矩,使 USV的跟踪误差镇定至原点附近足够小的邻域,从而实现 USV 的自主回收控制。为使动力学控制器具有更好的动态特性并能渐近稳定,设计滑模控制器,并引入误差积分项构造滑模面。su=ue+uwt0ue(t)dt(13)sr=re+rw
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 动态 规划 制导 无人 自主 回收 控制 方法
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,个别因单元格分列造成显示页码不一将协商解决,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。