专利名称：一种通信约束下双无人机协同目标跟踪方法
技术领域：
本发明属于双无人机自治跟踪一个地面活动目标时的飞行控制方法，涉及目标估 计和飞行控制领域。
背景技术：
自治跟踪运动目标是无人机的一种新颖用途，具有广阔的应用前景，如动物迁徙 研究，体育赛事实况转播，紧急救援，物资空投指引等。Meven A. P. Quintero, Francesco Papi，Daniel J.Klein, Luigi Chisci 和 Joao P. Hespanha 提出的“使用动态规划的最优 无人机目标跟踪协同算法”(Optimal UAV Coordination for Target Tracking using Dynamic Programming)运用动态规划原理，为无人机跟踪地面目标提供了一种跟踪精度全 局最优的方法。该算法首先给出了无人机跟踪目标时对目标进行定位的精度分析方法；在 此基础上，将无人机在每一个决策周期中的航向角改变量离散化，以精度最高为规划目标， 使用动态规划原理逆向求解得到精度全局最优的跟踪轨迹。由于该算法是全局最优方法，需要在跟踪之前先验地知道无人机在整个运动过程 中每时每刻的位置，这一点不具有可行性；并且这种算法没有提出对通信距离约束(通信 距离约束指无人机之间能够进行通信的最大距离限制)的保证措施，而保证通信是协同的 基本要素；虽然文中采用的精度优化能够间接调整与目标之间的距离，但是仅仅通过调控 精度对无人机与目标之间的距离间接施加影响并没有足够可靠的约束力，而保证探测距离 约束(探测距离约束指无人机能够有效探测目标参数的最大距离限制)是目标跟踪的首要 前提。
发明内容
为了克服现有技术不能满足通信距离约束和探测距离约束的不足，本发明提供一 种通信约束下双无人机协同目标跟踪方法，能够控制两架无人机(一架长机和一架僚机) 协同地跟踪一个地面目标；跟踪过程中，能够确保通信距离约束得到满足，为协同提供通信 保障；能够确保长机的探测距离约束得到满足，为目标跟踪提供保证；能够在飞行中实时 分析跟踪精度并优化轨迹，为跟踪质量提供保证。本发明解决其技术问题所采用的技术方案是假设算法的执行周期是At，目标、 长机和僚机在惯性系中的三维坐标分别是A^m和Xs，长机和僚机航向角分别为Fn^P ￥s， 速率均恒定为V，传感器最大探测距离为rmax，长机、僚机到目标的距离分别是Γι、ι·2，ν\与 v_t、与ν; 与N2分别是目标、长机和僚机速度在无人机-目标连线上及其垂直方 向上的投影，并引入布尔型标志变量flagm = O和= O。若没有接收到退出命令或任 务没有完成，长机和僚机分别各自重复执行以下步骤1)长机执行以下步骤步骤1 计算目标冲出长机探测范围所需时间仁=(rmax_ri) X (v^)-1,估算的无人机调整姿态至对准目标时无人机-目标连线转过的角度Δ =(0. 5v ^ ,-V^ ^trA1,中间变量 ξ = 士 acos(vtcos( nt+AVvD+ZkJi - η「Δ，k = 0，士 1，估算的无人机机动到能够接近目标时需要转过的航向角Itl = SignK) min(| ξ |)，计算目标转向减小与目标距离方向所需时间&= ι ξ步骤2 若I Δ I < JI并且Γι > D0并且tn > tr,长机进入强制接近状态，令flagm =1 ；否则直接转到步骤3。步骤3 计算此时的航向增量入
权利要求
1. 一种通信约束下双无人机协同目标跟踪方法，其特征在于包括下述步骤 假设算法的执行周期是△〖，目标、长机和僚机在惯性系中的三维坐标分别是^、^和 &，长机和僚机航向角分别为Vn^P Ψs，速率均恒定为V，传感器最大探测距离为rmax，长机、 僚机到目标的距离分别是 r2，ν 11与v_t、V11与V^V12与v_2分别是目标、长机和僚机 速度在无人机-目标连线上及其垂直方向上的投影，并引入布尔型标志变量Hagm = 和 flags = 0 ；若没有接收到退出命令或任务没有完成，长机和僚机分别各自重复执行以下步 骤1)长机执行以下步骤步骤1 计算目标冲出长机探测范围所需时间仁=(^axT1) X (ν-,-ν^)-1, 估算的无人机调整姿态至对准目标时无人机-目标连线转过的角度Δ = (0. 5v ^ ,-V^ ^trA1,中间变量 ξ = 士acos(vt cos(nt+A)/Vl)+2k3i-ii「A，k = 0，士 1， 估算的无人机机动到能够接近目标时需要转过的航向角Itl = signG )min(| ξ |)， 计算目标转向减小与目标距离方向所需时间&= I ξ0|/ωω3χ； 步骤2 若I Δ I < j!并且ri > D0并且tn > tr,长机进入强制接近状态，令f Iagm = 1 ； 否则直接转到步骤3 ；步骤3 计算此时的航向增量；=
2.根据权利要求1的一种通信约束下双无人机协同目标跟踪方法，其特征在于所述 的参数Dtl在rmax的0. 2至0. 8倍之间取值。
全文摘要
本发明公开了一种通信约束下双无人机协同目标跟踪方法，控制两架无人机协同地跟踪一个地面目标；跟踪过程中，长机判断自身进入强制接近状态后，迅速重新满足探测距离约束的要求，若未进入强制接近状态，以精度优先，提高目标观察数据的精度；僚机以强制接近状态和以及提高精度的原理与长机相同，僚机的活动范围被限制在以两机连线为中心的一个小范围内，以足够的速度分量去追踪长机，从而确保长机和僚机之间的距离小于给定值。本发明能够确保通信距离约束得到满足，为协同提供通信保障；能够确保长机的探测距离约束得到满足，为目标跟踪提供保证；能够在飞行中实时分析跟踪精度并优化轨迹，为跟踪质量提供保证。
文档编号G05D1/12GK102081404SQ20111003022
公开日2011年6月1日 申请日期2011年1月27日 优先权日2011年1月27日
发明者冯慧成, 李波, 符小卫, 陈军, 高晓光 申请人:西北工业大学