基于时间最优的无人机跟踪水上目标的方法技术

本发明专利技术提出一种基于时间最优的无人机跟踪水上目标的方法，假设已知待跟踪目标的状态信息，且无人机在水平面与纵向平面内的运动是解耦的，所述方法包括以下步骤，确定跟踪平衡状态；基于跟踪平衡状态构建期望航路，引导无人机运行至期望航路，以引导无人机以最短的时间到达跟踪平衡状态。该方法同时还适用于多架无人机跟踪目标的任务，及障碍物规避。本发明专利技术提出的无人机跟踪水上目标的方法，通过确定跟踪平衡状态，针对平衡状态构造内/外切线与临界高度，引导无人机以最短时间收敛到水平极限环与对峙高度，任务效率较高。

【技术实现步骤摘要】
基于时间最优的无人机跟踪水上目标的方法
本专利技术涉及无人机控制
，尤其涉及一种无人机跟踪水上目标的方法。
技术介绍
无人机(UnmannedAerialVehicle，简称UAV)因具有使用灵活、性价比高、生存能力强、可执行高风险任务等优势，在军、民用领域得到了广泛应用，无人机技术也已成为影响未来军用和民用装备研制与发展的战略制高点。在军用领域，无人机广泛应用于侦察监视、毁伤评估、态势感知等任务；在民用领域，无人机可有效地执行灾害感知与评估、资源探测、大地测绘等多种任务。水上目标跟踪作为无人机的典型应用之一，已逐渐应用于海上突发事件应急监控等场景，成为国内外学术界与海洋管理部门的关注热点，然而现阶段针对无人机跟踪目标的技术瓶颈仍然较多。其中，智能化与自主化是无人机的本质特征与未来趋势，但现阶段无人机的自主等级仍然较低。结合近年来的无人机发展趋势可知，航路规划技术是提高无人机自主控制水平的关键技术之一，因此本专利技术将从无人机航路规划的技术角度出发，解决目标跟踪问题。现阶段无人机对目标的跟踪模式主要有两类，包括持续跟踪与对峙跟踪：持续跟踪使目标尽可能长时间地保持在无人机传感器的有效探测范围内，该种模式可处理复杂环境下的各类约束；对峙跟踪要求无人机与目标的水平距离保持恒定，此外各无人机需在极限环上按相位平均分布。通常来说，对峙跟踪模式可保证无人机传感器对目标的覆盖，减小定位误差，并降低无人机暴露风险，具有更高的实际应用价值。针对目标对峙跟踪问题，Lyapunov导航向量场是最普遍的方法，该类方法分为两级结构：首先定义Lyapunov距离函数并确定期望航向，引导无人机收敛到目标上空的极限环上；然后定义Lyapunov相位函数，对各架无人机的速率进行调整，引导多机按相位平均分布于极限环上，实现多无人机的最优空间配置。Lyapunov导航向量场方法虽然最终可收敛到极限环上，但上述收敛过程所需时间较长。为进一步提高收敛速度，可采取切向导航向量场法使无人机按最短路径收敛到极限环上，但该策略仅对极限环外部的无人机有效。此外，可采取最优控制思路(如非线性模型预测控制)对特定问题进行建模并求解，能够有效提高跟踪精度。其他方法还包括微分几何法、航路构造法、参考点制导法等。现有的目标对峙跟踪方法大多假定无人机在二维水平面内飞行，因此未能充分利用环境信息与机动能力。更重要的是，无人机收敛到极限环的时间往往较长，且未考虑目标跟踪过程中的安全避障问题，因此面向水上目标对峙跟踪的无人机航路规划技术在任务效率方面仍有很大的提升空间。
技术实现思路
本专利技术的目的在于提供一种基于时间最优的无人机跟踪水上目标的方法，该方法可实现无人机对水上目标快速稳定的跟踪。为了实现上述目的，本专利技术提供如下技术方案：一种基于时间最优的无人机跟踪水上目标的方法，其特征在于，假设已知待跟踪目标的状态信息，且无人机在水平面与纵向平面内的运动是解耦的，所述方法包括以下步骤，确定跟踪平衡状态；基于跟踪平衡状态构建期望航路，引导无人机运行至期望航路，以引导无人机以最短的时间到达跟踪平衡状态。优选的是，跟踪平衡状态为：无人机与水上目标保持恒定的水平距离，位于同一水平极限环内，且保持恒定的垂直距离。优选的是，若多无人机共同执行跟踪任务，所述跟踪平衡状态进一步为：各无人机在水平极限环上按相位平均分布。优选的是，构建期望航路的方法为：若无人机位于极限环的外部，将无人机位置点与极限环的外切线作为期望航路，其中外切点为：其中，(x,y)表示无人机的水平位置，(xt,yt)表示目标的水平位置；(xtan,ytan)为外切点，R表示极限环的半径，表示无人机与目标之间的水平距离。若无人机位于极限环的内部，确定与无人机当前速度矢量相切的极限环内切圆，将内切圆的外切线或内切圆部分弧线作为期望航路。优选的是，若无人机位于极限环的外部，选择与无人机当前速度矢量夹角较小的一条外切线作为期望航路。优选的是，若无人机位于极限环的内部，选择距离无人机当前位置较近的内切圆，取其外切线或内切圆部分弧线作为期望航路；内切圆圆心定义为：其中，为无人机顺时针(A＝-1)或逆时针(A＝1)运动的标志位；其中，rmin为无人机最小转弯半径，(x,y)表示无人机的水平位置，(xt,yt)表示目标的水平位置，表示无人机的水平速度矢量。上式中，rd和rl为中间变量，无实际意义。优选的是：引导无人机沿期望航路运行至跟踪平衡状态的方法为：横向引导：计算无人机的期望水平速度，所述期望水平速度是指无人机沿期望航路的水平速度，无人机横向以期望水平速度运行至极限环；纵向引导：确定临界高度Htan，若无人机位于极限环的下方，则无人机需要做下降运动：若无人机位于极限环的上方，则无人机需要做下降运动：其中，H为期望的对峙高度，aH,max为最大垂直加速度，vH,max表示无人机的垂直速度，无人机在临界高度之外时，始终以vH,max恒速飞行，当无人机在临界高度与对峙高度之间时，以aH,max为控制输入匀减速飞行；无人机在横向引导和纵向引导到达极限环后，沿极限环飞行。优选的是：计算无人机期望水平速度的方法为：假设无人机水平速率始终为V，获取期望航路后，可计算无人机的期望水平速度优选的是：若多无人机共同执行跟踪任务，实现各无人机在水平极限环上按相位平均分布的方法为：构建Lyapunov相位函数：其中，φi为第i架无人机的相位角，定义如下关系式：其中，为第i架无人机的相位角速度，Nu为无人机的总数量，假设第一架无人机的水平速率为V1＝V，则第一架无人机的相位角速率为：其中，R为第一架无人机与跟踪目标之间的距离；依此求取最终可计算得其他无人机的期望水平速率进而可实现各无人机按相位的平均分布。优选的是：跟踪方法进一步包括以下步骤：为目标跟踪方法引入待跟踪目标运动速度，则：其中，V为无人机的水平速度，为无人机期望水平速度，为待跟踪目标的水平移动速度，α为修正因子。优选的是：跟踪方法进一步包括以下步骤：当无人机飞行空间存在障碍物时，在障碍物周围形成斥力场Urep，终止点位置处形成引力场Uatt，两类势场的叠加即为复合势场U＝Urep+Uatt，它们的负梯度即为复合势场力F或飞行速度：其中表示障碍物对无人机的排斥力，ρ(q,qobs)为无人机与障碍物距离，ρ0为障碍物的影响距离，η为排斥系数。表示引力场对无人机的吸引力。表示负梯度运算。为了引导无人机跟踪目标且躲避障碍，可用时间最优导航向量场替代引力场，即把Fatt直接定义为按前述步骤所获得的期望飞行速度。与现有技术相比，本专利技术的优点和积极效果在于：(1)本专利技术提出了一种基于时间最优的无人机跟踪水上目标的方法，该方法提出了时间最优导航向量场，通过确定跟踪平衡状态，针对平衡状态构造内/外切线与临界高度，引导无人机以最短时间收敛到水平极限环与对峙高度，任务效率较高；(2)本专利技术将时间最优导航向量场代替传统人工势场法中的引力场，可同时满足对峙跟踪与自主避障的任务需求；(3)本专利技术使无人机在三维空间内飞行，充分利用了环境信息与无人机机动能力。附图说明图1为本专利技术无人机跟踪水上目标的方法流程示意图；图2a为本单架无人机跟踪静止目标示意图；图2b为本单架无人机跟踪静止目标示意图；图3a为水平方向上时间最优导航本文档来自技高网...

【技术保护点】
1.一种基于时间最优的无人机跟踪水上目标的方法，其特征在于，假设已知待跟踪目标的状态信息，且无人机在水平面与纵向平面内的运动是解耦的，所述方法包括以下步骤，确定跟踪平衡状态；基于跟踪平衡状态构建期望航路，引导无人机运行至期望航路，以引导无人机以最短的时间到达跟踪平衡状态。

【技术特征摘要】
1.一种基于时间最优的无人机跟踪水上目标的方法，其特征在于，假设已知待跟踪目标的状态信息，且无人机在水平面与纵向平面内的运动是解耦的，所述方法包括以下步骤，确定跟踪平衡状态；基于跟踪平衡状态构建期望航路，引导无人机运行至期望航路，以引导无人机以最短的时间到达跟踪平衡状态。2.如权利要求1所述的基于时间最优的无人机跟踪水上目标的方法，其特征在于，跟踪平衡状态为：无人机与水上目标保持恒定的水平距离，位于同一水平极限环内，且保持恒定的垂直距离。3.如权利要求2所述的基于时间最优的无人机跟踪水上目标的方法，其特征在于，若多无人机共同执行跟踪任务，所述跟踪平衡状态进一步为：各无人机在水平极限环上按相位平均分布。4.如权利要求1或2或3所述的基于时间最优的无人机跟踪水上目标的方法，其特征在于，构建期望航路的方法为：若无人机位于极限环的外部，将无人机位置点与极限环的外切线作为期望航路，其中外切点为：其中，(x,y)表示无人机的水平位置，(xt,yt)表示目标的水平位置，R表示极限环的半径，表示无人机与目标之间的水平距离；若无人机位于极限环的内部，确定与无人机当前速度矢量相切的极限环内切圆，将内切圆的外切线或内切圆部分弧线作为期望航路。5.如权利要求4所述的基于时间最优的无人机对峙水上目标的方法，其特征在于，若无人机位于极限环的外部，选择与无人机当前速度矢量夹角较小的一条外切线作为期望航路。6.如权利要求4所述的基于时间最优的无人机跟踪水上目标的方法，其特征在于，若无人机位于极限环的内部，选择距离无人机当前位置较近的内切圆，取其外切线或内切圆部分弧线作为期望航路；内切圆圆心定义为：其中，为无人机顺时针(A＝-1)或逆时针(A＝1)运动的标志位；其中，rmin为无人机最小转弯半径，表示无人机的水平速度矢量，rd和rl为中间变量，无实际意义。7.如权利要求4或5或6所述的基于时间最优的无人机跟踪水上目标的方法，其特征在于，引导无人机沿期望航路运行至跟踪平衡状态的方法为：横向引导：计算无人机的期望水平速度，所述期望水平速度是指无人机沿期望航路的水平速...

【专利技术属性】
技术研发人员：姚鹏，迟书凯，任凭，王琨，解则晓，
申请(专利权)人：中国海洋大学，
类型：发明
国别省市：山东,37