基于感知信息的USV目标环绕跟踪方法.pdf
《基于感知信息的USV目标环绕跟踪方法.pdf》由会员分享,可在线阅读,更多相关《基于感知信息的USV目标环绕跟踪方法.pdf(7页珍藏版)》请在咨信网上搜索。
1、基于感知信息的 USV 目标环绕跟踪方法宋吉广1,2,李德隆1,2*,冯亮1,2,刘阳1,2,林扬1,2,孙铁铭1,2(1.中国科学院沈阳自动化研究所机器人学国家重点实验室,辽宁沈阳,110016;2.中国科学院机器人与智能制造创新研究院,辽宁沈阳,110169)摘要:无人水面艇(USV)作为一种智能水面工具,可实现航行控制、水面目标识别与感知等基本功能,但伴随着工程需求的多元化,如水面失事货轮、未知船只特征识别、失事飞机等搜救探测任务,该基本功能已无法完成任务,因此需要开展一种可对目标进行稳定跟踪并完成 360环视的方法研究。文中提出一种基于感知目标信息,通过对目标环绕跟踪,实现目标检测的方
2、法。在对感知信息进行目标运动状态估计后,采用虚拟目标点跟踪算法计算出期望航向及速度,通过航向控制器及速度控制器实现对 USV 的位姿控制,同时加入重规划跟踪策略,以适应水面复杂环境并感知设备提供信息的误差扰动。以 USV 模型辨识方法获得模型并搭建仿真平台进行仿真验证,通过实航试验测试证明该算法设计的合理性。关键词:无人艇;感知信息;目标环绕跟踪;目标运动状态估计;虚拟目标点跟踪算法;重规划跟踪策略中图分类号:U674.91;TJ630.64文献标识码:A文章编号:2096-3920(2023)05-0696-07DOI:10.11993/j.issn.2096-3920.202206011T
3、argetSurroundTrackingMethodofUSVsBasedonPerceptionInformationSONGJiguang1,2,LIDelong1,2*,FENGLiang1,2,LIUYang1,2,LINYang1,2,SUNTieming1,2(1.StateKeyLaboratoryofRobotics,ShenyangInstituteofAutomation,ChineseAcademyofSciences,Shenyang110016,China;2.InstitutesforRoboticsandIntelligentManufacturing,Chin
4、eseAcademyofSciences,Shenyang,110169,China)Abstract:Unmannedsurfacevehicle(USV),asanintelligentsurfacetool,canrealizebasicfunctionssuchasnavigationcontrol,aswellassurfacetargetrecognitionandperception.However,withthediversificationofengineeringrequirements,suchassearchandrescuemissionsorientedtowrec
5、kedfreighter,unknownshipfeaturerecognition,andwreckedaircraft,thesebasicfunctionsfailtocompletethetask.Therefore,itisnecessarytodevelopamethodtotrackthetargetstablyandcomplete360-degreescanning.Inthispaper,basedontheperceptualtargetinformation,atargetsurroundtrackingmethodwasproposedfortargetdetecti
6、on.Afterestimatingthetargetmotionstatefromthesensinginformation,thevirtualtargetpointtrackingalgorithmwasusedtocalculatethedesiredheadingandvelocity.TheheadingcontrollerandspeedcontrollerwereusedtocontrolthepositionandattitudeoftheUSV.Atthesametime,are-planningandtrackingstrategywasaddedtoadaptto th
7、e complex environment of the water surface and the error disturbance of the information provided by the sensingequipment.TheUSVmodelidentificationmethodwasusedtoobtainthemodelandbuildasimulationplatformforsimulationverification.Theactualflighttestprovestherationalityofthealgorithmdesign.Keywords:unm
8、annedsurfacevehicle;perceptualinformation;targetsurroundtracking;targetmotionstateestimation;virtualtargetpointtrackingalgorithm;re-planningandtrackingstrategy收稿日期:2022-06-22;修回日期:2022-09-30.作者简介:宋吉广(1992-)男,硕士,助理研究员,主要研究方向为无人航行器模型建立、航行控制、控制算法等.*通信作者简介:李德隆(1981-),男,硕士,正高级工程师,硕士生导师,主要研究方向为水上/水下无人航行器电
9、控系统、总体技术.第31卷第5期水下无人系统学报Vol.31 No.52023年10月JOURNALOFUNMANNEDUNDERSEASYSTEMSOct.2023引用格式 宋吉广,李德隆,冯亮,等.基于感知信息的 USV 目标环绕跟踪方法 J.水下无人系统学报,2023,31(5):696-702.696JournalofUnmannedUnderseaSystemssxwrxtxb.xml-0引言目前,无人系统已经成为未来军事和民用领域发展的重点。近 20 年来,无人水面艇(unmannedsurfacevehicle,USV)技术成为国内外研究热点,在反水雷、侦查、监控、电子战以及反侦
10、察作战中具有很大的优势,保证了无人员伤亡前提下完成作战任务,同时在民用领域可执行探测资源、搜救、气象监测和预报、信号中继站等任务,因此深入研究 USV 技术,对于提升我国国防实力具有重要的意义1-2。目标跟踪是 USV 研究领域的一项关键技术,USV 目标跟踪方法的研究,对于海底矿物探测、港口防御和目标打击等领域有着广泛的应用前景。USV 作为探知海洋丰富资源的一种智能多功能探测载体,需能够在无人状态下自主完成规划任务。目前,在 USV 目标跟踪技术领域,可实现对锁定目标进行基于感知信息下的目标跟踪任务,Qiao 等3使用基于平方根 Sage-Husa 自适应鲁棒卡尔曼滤波方法进行 USV 雷
11、达目标跟踪,在对测量和观测噪声进行联合估计后,从仿真和试验中验证了该算法的有效性;饶六中等4使用基于单目视觉对水面艇目标进行跟踪,具体方式是通过比较运动过程中标志物图像与期望图像的位置关系,实时计算出偏航角和偏航距离作为控制器输入量,并控制跟踪船航向和航速,从而实现对被跟踪船的跟踪;秦世洋等5使用模型预测控制(modelpre-dictivecontrol,MPC)的方法,将环境干扰等问题转换为二次规划问题,可实现稳定的目标点跟踪。但在实际工程发展中,存在一些对目标信息采集更加全面具体的任务,如对于突发事故的船只,人工无法靠近或抵达,不能获得其最新发展动态并及时处理,当前技术状态下 USV 处
12、于相对目标的单一方位而无法满足该需求。因此,文中提出了一种基于 USV 平台、搭载雷达载荷、通过实时感知目标信息、基于虚拟目标点跟踪算法的目标环绕跟踪方法,对目标进行环绕跟踪,完成对目标的360全方位监视,通过此种方法能够快速、高效且安全地完成任务,提高工作效率和安全性。使用“勇士号”USV 作为算法验证载体,如图 1 所示。“勇士号”USV 是由中国科学院沈阳自动化研究所联合有关合作单位研制的新型多模式操控高速 USV。图1“勇士号”USV 实航效果图Fig.1ActualnavigationeffectoftheWarriorUSV通过建立的仿真平台进行理论验证,使其具备良好的自主环绕跟踪
13、能力,从而完成设定的任务,实航试验验证了文中所提方法的有效性。1基于无迹卡尔曼滤波器的目标运动状态估计方法采用无迹卡尔曼滤波(unscentedKalmanfilter,UKF)对描述系统状态的均值和方差的采样点进行非线性变换,得到的点分布近似真实值和方差值于 2 阶以上,同时 UKF 不需要采用雅克比矩阵对状态方程和量测方程线性化,对于非线性系统,UKF 的滤波效果优于扩展卡尔曼滤波(extendedkalmanfilter,EKF)。同时,由于滤波对象为感知信息获得,其数据分布具有非线性特点,故选用UKF 方法对目标运动状态进行估计6-7。y=f(x)xDx2N+1iWiyi=f(i)无迹
14、变换(unscentedtransform,UT)方法中,假设非线性变换,向量 x 是 n 维随机变量,设其均值为、方差为,y 的特性统计计算使用UT 得到的个点和对应的权值。将向量x 的取值范围近似为高斯分布,并假设变化点近似服从高斯分布,再通过取权值和求加权方差获得期望所求8-9。点集相对均值为对称分布,同时对称点加权值相同,故其样本均值和方差与原始均值和方差相等。使用 UKF 的目标运动状态估计,其计算方法如下。1)随机变量均值及方差计算 x=Ex(0)D(0)=Ex0 x(0)x0 x(0)T(1)2)时间更新(预测)i2N+1构建点权值,共有个,过程如下:2023年10月宋吉广,等:
15、基于感知信息的 USV 目标环绕跟踪方法第5期水下无人系统学报sxwrxtxb.xml-697i=x,i=0 x+(N+)Dx)i,i 1,Nx(N+)Dx)i,i 1,2N(2)W(a)i=W(b)i=/(N+),i=01/2(N+),i 1,2N(3)(k1)=x(k1),x(k1)+(N+)Dx(k1)i x(k1)(N+)Dx(k1)i,i 1,N(4)W(a)iW(b)i(N+)Dx(N+)Dxi式中:W 为 权值,且权值之和为 1;为均值使用 权 值;为 方 差 使 用 权 值;为 微 调 参 数,为平方根的第 i 行或第 j 列向量,则预测点、均值和方差计算如下:i(k)=fi(
16、k1),i 0,2N(5)x(k)=2Ni=0W(a)ii(k)D(k)=2Ni=0W(b)ii(k)x(k)i(k)x(k)T+Q(k)(6)3)量测更新z(k)新测量值获取后,状态均值和方差更新如下:x(k)=x(k)+K z(k)z(k)Dx(k)=Px(k)KDz(k)KTK=Dxz(k)D1z(k)(7)z(k)=2Ni=0W(a)ihi(k)(8)Dz(k)=2Ni=0W(b)ihi(k)z(k)hi(k)z(k)T+R(k)(9)Dxz(k)=2Ni=0W(b)ii(k)x(k)hi(k)z(k)T(10)2目标环绕跟踪方法原理基于艇雷达感知目标信息,包括目标的中心位置、航向、运
17、动方向和目标标记 ID 号,目标环绕跟踪模块对指定 ID 号目标进行环绕跟踪。依托于水平面航向控制器10,采用虚拟目标点跟踪算法实现目标环绕跟踪。根据运动目标航向、速度信息,自适应调整 USV 环绕半径及运动速度,充分考虑 USV 本身运动特性,确定组成环绕一圈所需的虚拟目标点数量,以目标位置为原点,设定运动目标航向为 Y 轴正方向,根据右手定则建立运动目标坐标系,计算各点在运动坐标系中的位置。航行器在运动过程中实时计算到达虚拟目标点所需的航向角,通过水平面航向控制器完成航向闭环,航行器依次跟踪每个虚拟目标点,以重规划策略保障,进而实现目标环绕跟踪11-12。算法原理如图 2 所示,算法总体框
18、图如图 3 所示。R目标Xs1XEYEXs1Ys1XA1YA1OO1USVXA2YA2环行方向PAPAUSVYs1图2虚拟目标点跟踪算法原理Fig.2Principleofvirtualtargetpointtrackingalgorithm切换判定控制计算重规划艇位姿信息感知目标信息算法输入信息处理目标环绕跟踪方法是否水面航行控制器执行机构准备结束任务继续否是图3算法总体框架图Fig.3OverallframeworkofalgorithmXEOYEXs1OYs1XsO1YsXA1PAYA1图 2 中:为大地坐标系;和为 不 同 时 刻 下 USV 运 动 坐 标 系;和2023年10月水下
19、无人系统学报第31卷698JournalofUnmannedUnderseaSystemssxwrxtxb.xml-XA2PAYA2为不同时刻的目标运动坐标系。1)虚拟目标点划分首先根据经验拟合设计 USV 的环绕速度,并自主解算环绕半径,即v=(va+0.5)(1+ev/10)(11)R=floor(1v3+2v2+3v+4)(12)vafloor()1234式中:为比例系数;为量测目标速度;v 为航行器速度值;为取数字整数函数;为 3 阶速度参数;为 2 阶速度参数;为速度变化率参数;为偏移参数;R 为环绕半径。根据输入速度及半径计算虚拟目标点数量N=floorR(v2)1+31(13)1
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 感知 信息 USV 目标 环绕 跟踪 方法
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。