一种用于无人机避撞的航迹不确定性边界算法制造技术

本发明专利技术公开了一种用于无人机避撞的航迹不确定性边界算法，涉及无人机感知与避撞技术领域。包括如下步骤：S1：利用航迹跟踪滤波算法得到无人机的航迹误差参数；S2：设定误差因子系数；S3：将航迹误差参数和误差因子系数带入最大不确定性边界模型得到无人机的最大不确定性边界；S4：根据最大不确定性边界建立帮助无人机避撞算法优化的动态安全缓冲区。本发明专利技术通过针对监视航迹与理想真实航迹存在客观偏差这一问题，提出了航迹不确定性边界计算方法，利用航迹的状态误差矩阵计算航迹的不确定性边界值，实现传感器监视航迹误差向航迹不确定性边界值的转化，以便获得对应的动态安全缓冲区作用于避撞引导算法。冲区作用于避撞引导算法。冲区作用于避撞引导算法。

【技术实现步骤摘要】
一种用于无人机避撞的航迹不确定性边界算法


[0001]本专利技术涉及无人机感知与避撞
，具体涉及一种用于无人机避撞的航迹不确定性边界算法。

技术介绍

[0002]为了给无人机远程飞行员提供及时可靠的告警和引导，无人机DAA系统必须将监视航迹数据的不确定性纳入考虑。现有技术中，DAA典型监视传感器包括应答机、空空雷达、ADS
‑
B等，其噪声特性各异，即使经过滤波器之后仍然存在各种不确定性信息，这些不确定性信息导致基于这些监视航迹数据进行的冲突探测及告警、冲突解脱避撞引导算法的输出存在告警闪烁、引导波动的情况。现有技术中还没有对这种不确定性信息进行处理的方法，使得无人机感知与避撞技术更加准确，帮助无人机DAA系统进行优化。

技术实现思路

[0003]针对现有技术的上述不足，本专利技术提供了一种有助于无人机DAA系统优化的用于无人机避撞的航迹不确定性边界算法。
[0004]为达到上述专利技术目的，本专利技术所采用的技术方案为：
[0005]提供一种用于无人机避撞的航迹不确定性边界算法，其包括如下本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于无人机避撞的航迹不确定性边界算法，其特征在于，包括如下步骤：S1：利用航迹跟踪滤波算法得到无人机的航迹误差参数；S2：设定误差因子系数；S3：将航迹误差参数和误差因子系数带入最大不确定性边界模型得到无人机的最大不确定性边界；S4：根据最大不确定性边界建立帮助无人机避撞算法优化的动态安全缓冲区。2.根据权利要求1所述的用于无人机避撞的航迹不确定性边界算法，其特征在于，带入最大不确定性边界模型的航迹误差参数包括x方向位置误差、y方向位置误差、xy方向位置协标准差、x方向速度误差、y方向速度误差、xy方向速度协标准差、z方向位置误差和z方向速度误差；带入最大不确定性边界模型的误差因子系数包括水平位置不确定性程度h_pos_z、水平速度不确定性程度h_vel_z、垂直位置不确定性程度v_pos_z和垂直速度不确定性程度v_vel_z。3.根据权利要求2所述的用于无人机避撞的航迹不确定性边界算法，其特征在于，所述水平速度不确定性程度包括
：
当本机与入侵机之间的距离range大于或等于判定阈值h_vel_dist时，水平速度不确定性程度h_vel_z＝h_vel_z_2；当本机与入侵机之间的距离range小于判定阈值h_vel_dist时，水平速度不确定性程度其中，h_vel_z_2为本机与入侵机之间的距离range大于或等于判定阈值h_vel_dist时的水平速度不确定性Z分数；h_vel_z_1为本机与入侵机之间的距离range小于判定阈值h_vel_dist时的水平速度不确定性Z分数。4.根据权利要求2所述的用于无人机避撞的航迹不确定性边界算法，其特征在于，最大不确定性边界模型包括如下：S
err
＝S
err_o
+S
err_i
；v
err
＝v
err_o
+v
err_i
；S
z_err
＝S
z_err_o
+S
z_err_i
；v
z_err
＝v
z_err_o
+v
z_err_i
；其中，S
err
为水平位置最大不确定性边界；v
err
为水平速度最大不确定性边界；S
z_err
为垂直位置最大不确定性边界；v
z_err
为垂直速度最大不确定性边界；S
err_o
为本机水平位置最大不确定性边界；S
err_i
为入侵机水平位置最大不确定性边界；v
err_o
为本机水平速度最大不确定性边界；v
err_i
为入侵机水平速度最大不确定性边界；S
z_err_o
为本机垂直位置最大不确定性边界；S
z_err_i
为入侵机垂直位置最大不确定性边界；v
z_err_o
为本机垂直速度最大不确定性边界；v
z_err_i
为入侵机垂直速度最大不确定性边界。5.根据权利要求4所述的用于无人机避撞的航迹不确定性边界算法，其特征在于，所述本机水平位置最大不确定性边界所述入侵机水平位
置最大不确定性边界其中，e
so1
和e
so2
为本机x方向和y方向位置协方差矩阵的特征值；e
so3
和e
so4
为入侵机x方向和y方向位置协方差矩阵的特征值；本机x方向和y方向位置协方差矩阵为：入侵机x方向和y方向位置协方差矩阵为：其中，σ
pxo
为本机x方向位置误差；σ
pyo

【专利技术属性】
技术研发人员：张学军，肖越，相辰橦，张维东，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：