基于贝塞尔曲线二次优化的固定翼目标跟踪方法技术

本发明专利技术公开了一种基于贝塞尔曲线二次优化的固定翼目标跟踪方法。固定翼上实时观测获得观测目标位置及其时间戳组成数据存储，根据贝塞尔曲线建立损失函数，进而建立损失函数的约束；以最小化目标求解确定贝塞尔曲线初步预测跟踪轨迹；在初步预测跟踪轨迹上确定下一时刻预测目标位置，在实时观测目标位置到预测目标位置之间，通过dubins曲线建立最终预设轨迹，实现目标跟踪。本发明专利技术由预测轨迹跟踪目标可提高固定翼的追击速度，同时在目标丢失时，可按预测轨迹继续前进，重新寻找目标，大大减少了目标跟踪速度，提高了固定翼跟踪目标的速度减少了目标丢失的可能性。度减少了目标丢失的可能性。度减少了目标丢失的可能性。

【技术实现步骤摘要】
基于贝塞尔曲线二次优化的固定翼目标跟踪方法


[0001]本专利技术涉及无人机
的一种固定翼跟踪目标的规划控制方法，尤其是涉及了一种固定翼无人机跟踪目标时生成预测运动轨迹的规划进而实现目标跟踪的方法，主要涉及到对贝塞尔曲线的二次优化以及固定翼无人机运动轨迹的生成。

技术介绍

[0002]固定翼飞行速度较快的情况下要实现快速跟踪难度较大容易产生目标丢失等问题。需要对轨迹进行预测，并生成符合固定翼运动的轨迹，用于更快跟踪目标，减少丢失概率。由于目前对于固定翼目标追击的研究比较少，未查找到相关研究数据。
[0003]国内有基于安全走廊对贝塞尔曲线进行约束，优化轨迹找到无碰撞路径的应用。但主要用于四旋翼，对固定翼的轨迹优化并没有涉及，关于固定翼快速跟踪目标时，对其运动轨迹进行优化的研究较少。

技术实现思路

[0004]为了解决
技术介绍
中存在的问题，本专利技术提出了一种基于贝塞尔曲线二次优化的固定翼目标跟踪方法，解决了固定翼飞行速度快而且受到动力学约束、在跟踪目标时容易丢失目标的技术问题。
[0005]为达到上述目的，本专利技术技术方案包括以下步骤：
[0006]S1、固定翼上实时观测目标的当前位置作为观测目标位置，将观测目标位置及其对应的时间戳信息组成数据存储；时间戳即时刻。
[0007]S2、根据贝塞尔曲线建立损失函数，进而建立损失函数的约束；
[0008]S3、对S1获得的历史所有时刻的观测目标位置及其时刻的数据输入到损失函数中，以最小化损失函数为目标进行求解获得最优贝塞尔曲线的参数，进而确定最优贝塞尔曲线作为初步预测跟踪轨迹；
[0009]S4、然后在初步预测跟踪轨迹上按照时刻顺序确定下一时刻的点作为预测目标位置为目标点，在实时获得的观测目标位置到预测目标位置之间，以固定翼的最小转弯半径为约束通过dubins曲线建立固定翼的最终预设轨迹，进而控制固定翼飞行对目标进行跟踪。
[0010]所述的固定翼上安装有云台，云台上安装相机，相机拍摄目标的图像进而图像分析处理后实现对目标位置的获取。
[0011]本专利技术是在观测目标位置基础上贝塞尔曲线拟合建立并获得轨迹，进而以时刻代入获得预测目标位置。
[0012]所述的损失函数具体如下：
[0013][0014][0015][0016]其中，J
pre
表预测目标与实际目标位置的损失值，表示二范数的平方，B(t
i
)为第i个时刻t
i
的预测目标位置，为第i个时刻t
i
的观测目标位置，为第i个时刻t
i
的权重，ω
p
为二阶正交项权重，用于避免过拟合；t1表示初始的第1个时刻，t
L
表示当前时刻，L为到当前时刻为止的时间长度，i表示时刻的序号；为t时刻的贝塞尔曲线系数，c
u
为贝塞尔曲线的第u个控制点的位置坐标，u表示贝塞尔曲线的控制点的序号，n表示贝塞尔曲线的控制点的总数；为第i个时刻t
i
的贝塞尔曲线系数，B(t)为t时刻的预测目标位置；B
(2)
(t)表示预测目标位置B(t)的二阶导数，其中为二次正交项。
[0017]本实施例采用五阶贝塞尔曲线，n为5，五阶贝塞尔示意图如图2所示。
[0018]所述的损失函数中的第i个时刻t
i
的权重具体设置为：
[0019][0020]其中，t
L
为当前时刻，t
i
为历史的第i个时刻，k
t
表示预设的时间权重系数。由上述公式可知，随着时间推移t
L
‑
t
i
的值越来越大，对应的时刻的权重越来越低。
[0021]本专利技术在目标函数中使用双切曲线设计权重，使得权重随时间递减，观测到的时刻越靠前在损失函数中权重越低，进而优化不同时刻间的观测目标位置的置信度，实现准确的目标跟踪。
[0022]本专利技术在损失函数中加入了设计的二阶正交项，能够避免过拟合，使目标轨迹和观测距离差最小。
[0023]本专利技术以双切曲线设计的权重以及观测目标位置与贝塞尔曲线生成的预测目标位置之间的差值下的构思建立损失函数，且加入二阶正交项避免过拟合，能够更优地跟踪目标，实现准确跟踪。
[0024]所述损失函数中的约束包括预测速度和加速度约束[
‑
v
mp
，v
mp
]，[
‑
a
mp
，a
mp
]，有预测速度和加速度约束建立为不等式约束：
[0025]‑
v
mp
≤n
·
(c
u
‑
c
u
‑1)≤v
mp
[0026]‑
a
mp
≤n
·
(n
‑
1)
·
(c
u
‑
2c
u
‑1+c
u
‑2)/s
t
≤a
mp
[0027]其中，n是贝塞尔曲线的阶次，s
t
是时间尺度参数，c
u
为贝塞尔曲线的第u个控制点位置坐标，v
mp
表示目标的预测速度约束，a
mp
表示目标的预测加速度约束。
[0028]将贝塞尔曲线被包裹在其控制点连成的凸包中，本专利技术利用贝塞尔曲线的凸包性质来约束控制点的位置；对贝塞尔曲线求导，其还是一个贝塞尔曲线，本专利技术利用贝塞尔曲线的导数属性将控制点用低阶贝塞尔曲线的控制点线性表示。
[0029]本专利技术据贝塞尔曲线的凸包属性和导数属性加入预测速度与加速度约束的不等式约束，使目标轨迹可行。
[0030]所述步骤S3中，贝塞尔曲线的二范数正定，将损失函数及其约束看作是带约束的二次优化问题，采用OOQP开源求解器求解损失函数及其约束，获得贝塞尔曲线中的每个控制点，最优的初步预测跟踪轨迹。
[0031]贝塞尔曲线二范数正定，本专利技术二次优化损失函数，计算出使观测目标位置与预测目标位置之间差值最小的最优解，获得初步预测跟踪轨迹。
[0032]所述步骤S4中，具体实施通过设置Dubins路径计算模块，根据固定翼的转弯半径区间[RMIN，RMAX]以及预测目标位置生成到达目标的最短固定翼运动轨迹作为最终预设轨迹。
[0033]本专利技术的有益效果是：
[0034]本专利技术由轨迹跟踪目标可提高固定翼的追击速度，同时在目标丢失时，可按预测轨迹继续前进，重新寻找目标，大大减少了目标跟踪速度，提高了固定翼跟踪目标的速度减少了目标丢失的可能性。
附图说明
[0035]构成本申请的一部分的附图用来提供对本专利技术的进一步理解，本专利技术的示意性实施例及其说明用于解释本专利技术，并不构成对本专利技术的不当本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于贝塞尔曲线二次优化的固定翼目标跟踪方法，其特征在于方法包括以下步骤：S1、固定翼上实时观测目标的当前位置作为观测目标位置，将观测目标位置及其对应的时间戳信息组成数据存储；S2、根据贝塞尔曲线建立损失函数，进而建立损失函数的约束；S3、对S1获得的历史所有时刻的观测目标位置及其时刻的数据输入到损失函数中，以最小化损失函数为目标进行求解获得最优贝塞尔曲线的参数，进而确定最优贝塞尔曲线作为初步预测跟踪轨迹；S4、然后在初步预测跟踪轨迹上按照时刻顺序确定下一时刻的点作为预测目标位置，在实时获得的观测目标位置到预测目标位置之间，以固定翼的最小转弯半径为约束通过dubins曲线建立固定翼的最终预设轨迹，进而控制固定翼飞行对目标进行跟踪。2.根据权利要求1所述的一种基于贝塞尔曲线二次优化的固定翼目标跟踪方法，其特征在于：所述的损失函数具体如下：征在于：所述的损失函数具体如下：征在于：所述的损失函数具体如下：其中，J
pre
表预测目标与实际目标位置的损失值，表示二范数的平方，B(t
i
)为第i个时刻t
i
的预测目标位置，为第i个时刻t
i
的观测目标位置，为第i个时刻t
i
的权重，ω
p
为二阶正交项权重；t1表示初始的第1个时刻，t
L
表示当前时刻，L为到当前时刻为止的时间长度，i表示时刻的序号；为t时刻的贝塞尔曲线系数，c
u
为贝塞尔曲线的第u个控制点的位置坐标，u表示贝塞尔曲线的控制点的序号，n表示贝塞尔曲线的控制点的总数；为第i个时刻t
i
的贝塞尔曲线系数...

【专利技术属性】
技术研发人员：金磊城，郑恩辉，
申请(专利权)人：中国计量大学，
类型：发明
国别省市：