[发明专利]一种基于负比例导引的无人机自动避撞方法

摘要

本发明提供了一种基于负比例导引的无人机自动避撞方法，属于无人机飞行控制技术领域。通过基于无人机与侵入机相对几何关系的碰撞检测，基于负比例导引的无人机避撞指令生成与飞行控制，无人机自动避撞完成时间估计，检测是否达到无人机避撞完成时间，无人机正常飞行等步骤完成无人机自动避撞，本发明利用负比例导引所需过载小的特点，采用负比例导引律引导无人机进行自动避撞飞行，并通过迭代法求解避撞模型方程，以估计避撞完成时间，适用于多种初始航向角条件和速度条件。

主权项

1.一种基于负比例导引的无人机自动避撞方法，其特征在于，包括以下步骤：步骤1：基于避撞机与侵入机相对几何关系的碰撞检测；初始状态下避撞机处于正常飞行模式，沿预定的正常飞行轨迹飞往目标点，利用机载传感器获得避撞机和侵入机的飞行状态信息，飞行状态信息包括避撞机初始位置(x₀,y₀)、飞行速度V和航向角ψ(t)，侵入机的位置(x_OB,y_OB)、速度V_OB和航向角ψ_OB，根据飞行状态信息得出两无人机的相对距离R_T(t)为：两无人机相对速度V_rel(t)为：V_rel(t)＝Vcos(ψ_rel‑ψ(t))+V_OBcos(π+ψ_OB‑ψ_rel(t))           (2)；其中，ψ_rel(t)为两无人机相对速度方位角视线角λ(t)为：相对速度方位角和视线角的差值ε(t)为：ε(t)＝|λ(t)‑ψ_rel(t)|                               (5)；给定安全距离R_S后可求取碰撞锥的半顶角θ(t)为：碰撞锥下边界角μ(t)为：μ(t)＝λ(t)‑θ(t)    (7)；当相对速度V_rel(t)在碰撞锥内，即相对速度方位角与视线角的偏差绝对值小于碰撞锥的半顶角，公式为|λ(t)‑ψ_rel(t)|＝|ε(t)|＜θ(t)，则两个无人机会发生碰撞，并执行步骤2，如果相对速度方位角与视线角的偏差绝对值大于或等于碰撞锥的半顶角，则执行步骤5；步骤2：基于负比例导引的无人机避撞指令生成与飞行控制；检测到避撞机与侵入机发生碰撞，首先计算机生成负比例导引指令a(t)，负比例导引指令a(t)经过下式的变换之后作为无人机滚转角姿态控制回路的给定值φ_g，采用常规PID控制律设计无人机的横侧向滚转角姿态控制回路和侧滑角姿态控制回路，用给定值φ_g作为横侧向滚转角姿态控制回路的输入，侧滑角姿态控制回路的输入为0，实现无侧滑飞行；避撞机通过滚转机动，去追踪避撞点，经过一定的时间，两无人机的相对速度V_rel与碰撞锥下边界角μ(t)重合，这时相对速度V_rel(t)开始脱离碰撞锥；负比例导引指令变为0，避撞机保持此时的航向角作匀速直线飞行，直至与侵入机航迹相交后避撞完成；步骤3：无人机自动避撞完成时间估计；在执行步骤2时，同时对无人机完成避撞的时间进行估计；步骤4：检测避撞是否完成；检测飞行时间是否达到估计的无人机避撞完成时间T，如果达到了就执行步骤5；如果未达到继续执行步骤2；步骤5：避撞机进入正常飞行模式；避撞机继续飞往目标点。