[发明专利]一种基于测距信号的固定翼无人机编队跟踪制导方法

摘要

本发明提出一种基于测距信号固定翼无人机编队跟踪制导方法，该方法首先设计了单架无人机自动跟踪地面目标的制导模型，其次，分别设计了用于单邻居编队的相位和速度控制协同制导模型和用于双邻居编队的相位和速度控制协同制导模型；最后，针对地面静止目标的跟踪需求选择相应的制导模型作为各无人机的制导策略。区别于其它的制导方法，本发明能够仅使用距离传感器即实现对地面静止目标的自动协同跟踪。

主权项

1.一种基于测距信号的固定翼无人机编队跟踪制导方法，其特征在于，包括步骤：(1)获取无人机和地面目标的航向信息，根据获取的信息数据构建无人机定距跟踪地面目标的二维运动学模型：其中，为无人机i与地面目标间的相对距离变化率；v_i为无人机i的速度；χ_i为无人机i的视线角，即无人机i速度方向与无人机和目标间连线的夹角；为χ_i的角变化率；ω_i无人机i的角速度；ρ_i为无人机i与地面目标间的相对距离；(2)根据无人机定距跟踪地面目标的二维运动学模型，建立定距跟踪地面静止目标的单无人机制导模型和无人机编队制导模型；其中，定距跟踪地面静止目标的单无人机制导模型为：式中，表示无人机i的航向跟踪制导律输出，表示单无人机制导增益，ρ_d表示稳定定距跟踪时无人机与目标间距离；定距跟踪地面静止目标的无人机编队制导模型包括：无人机编队单邻居相位控制制导模型：其中，表示无人机i的编队航向制导律输出，表示编队航向制导增益，r_i,i‑1表示无人机i与其相邻无人机i‑1之间的距离，N表示无人机编队中的无人机总数；无人机编队单邻居速度控制制导模型：其中，kv表示编队速度制导增益；无人机编队双邻居相位控制制导模型：无人机编队双邻居速度控制制导模型：其中，表示无人机i的编队速度控制制导律输出；(3)当单架无人机定距跟踪地面静止目标时，选取单无人机制导模型作为无人机制导策略；(4)当无人机编队定距跟踪地面静止目标时，根据无人机前、后、左、右四个探测雷达所探测到的无人机数量，选择各无人机制导策略，包括步骤：(4‑1)定义：若无人机i前方或右方探测雷达探测到的无人机数量非空，则ri,i‑1≠0，否则，ri,i‑1＝0；若无人机i后方或左方雷达探测到的无人机数量非空，则ri,i+1≠0，否则，ri,i+1＝0；(4‑2)若ri,i‑1≠0且ri,i+1＝0，则采用无人机编队单邻居相位控制制导模型和无人机编队单邻居速度控制制导模型作为各无人机制导策略；若ri,i‑1≠0且ri,i+1≠0，则采用无人机编队双邻居相位控制制导模型和无人机编队双邻居速度控制制导模型作为各无人机制导策略；若不满足ri,i‑1≠0且ri,i+1＝0或ri,i‑1≠0且ri,i+1≠0，则不采用无人机编队跟踪制导方法。