首页 / 专利库 / 飞机类型 / 巡航高度 / 基于多无人机的油田动态侵入目标追踪系统与方法

基于多无人机的油田动态侵入目标追踪系统与方法

阅读:766发布:2020-05-11

专利汇可以提供基于多无人机的油田动态侵入目标追踪系统与方法专利检索,专利查询,专利分析的服务。并且本 发明 提供一种基于多无人机的油田动态侵入目标追踪系统与方法,涉及无人机巡检及动态预测追踪技术领域。本系统包括控 制模 块 ,监控模块,动态目标轨迹预测模块和多机协同目标追踪轨迹优化模块。本系统通过安装在无人机上的监控模块采集地面油田工作环境中动态侵入目标的数据,然后通过动态目标轨迹预测模块对目标未来多个 采样 时刻内的轨迹进行预测,根据预测轨迹,利用多机协同目标追踪轨迹优化模块在追踪过程中优化无人机与目标间的距离误差,使其距离误差保持在有效追踪 阈值 内,实现多个无人机协同目标追踪。,下面是基于多无人机的油田动态侵入目标追踪系统与方法专利的具体信息内容。

1.一种基于多无人机的油田动态侵入目标追踪系统,其特征在于:包括控制模,监控模块,动态目标轨迹预测模块和多机协同目标追踪轨迹优化模块;
所述控制模块包括飞行高度探测模块、飞行姿态控制模块以及无线通讯模块;
所述飞行高度探测模块安装于无人机上,其输出端与飞行姿态控制模块相连接,用于实时飞行过程中的飞行高度检测与控制,以实现无人机始终处于固定安全飞行高度;所述飞行姿态控制模块其输出端与无线通讯模块输入端相连接,用于控制飞行过程中无人机自身的飞行姿态控制与飞行高度控制,以便于实现对油田工作区域内的巡检;所述无线通讯模块包括无线数据接收模块、无线数据发送模块以及无线数据通讯模块;所述无线数据接收模块用于接收各个区域内无人机所获取的目标状态数据,所述目标数据包括飞行姿态控制模块所输出的无人机姿态,飞行高度探测模块所输出的无人机飞行高度,无人机GPS和摄像头输出的数据;所述无线数据发送模块用于将接收到的目标状态数据传送到数据接收设备,并将接收到的无人机位置传输到其他无人机端;所述无线通讯模块,用于无人机之间的协同任务分配;
所述监控模块包括目标探测模块,无线数据通讯模块与数据存储模块;
所述目标探测模块包括摄像头和无人机GPS,所述摄像头安装在无人机上,其输出端与无线通讯模块相连接;所述GPS的输出端与无人机飞行姿态控制模块输入端和无线通讯模块的输入端相连接,用于实时监控无人机的飞行状况,对油田的环境进行监控;同时可以实时观测油田工作区域的环境;所述无线数据通讯模块输出端与数据存储模块的输入端,其他无人机端,和动态目标轨迹预测模块输入端相连接,用于将第一时间获得的动态目标的状态数据,传输给其他工作区域的无人机,联合建立目标的运动学模型
所述动态目标轨迹预测模块输出端与所述数据存储模块输入端和所述多机协同目标追踪轨迹优化模块输入端相连接,用于预测目标在当前油田工作区域内未来多个采样时刻内的轨迹,即目标多步预测轨迹;
所述多机协同目标追踪轨迹优化模块输出端与数据存储模块输入端相连接,用于优化多无人机协同目标追踪轨迹。
2.根据权利要求1所述的基于多无人机的油田动态侵入目标追踪系统,其特征在于,所述目标多步预测轨迹,采用预设的优化算法,优化该区域内无人机实时追踪目标的优化轨迹,并将优化轨迹数据传输给该区域的无人机,通过无人机搭载的控制模块,控制无人机的速度,航向实现对目标的实时追踪,将目标当前所在区域的无人机对目标的多步预测轨迹数据传输到数据存储模块进行存储,方便进行管理。
3.一种基于多无人机的油田动态侵入目标追踪方法,通过权利要求1所述一种基于多无人机的油田动态侵入目标追踪系统实现,其特征在于:包括以下步骤:
步骤1:用户设定无人机个数m,并将每个无人机所负责的油田工作区域范围输入到每个无人机的控制模块;将地面动态目标的初始状态信息输入到无人机的动态目标轨迹预测模块,并初始化分布式卡尔曼滤波算法的算法参数:连续采样时间为n_iter,i∈(1.4),i表示油田区域,过程方差为Qi,测量方差为Ri,高斯噪声为[0,25],无人机监控模块获取的目标实时观测信息为Zi,后验估计方差为Pi,误差方差为Psi,卡尔曼增益为Kgi;
步骤2:建立动态目标多步轨迹油田侵入目标完整的预测表达式:
其中 表示动态目标的预测坐标,Pt表示动态目标的预测后验估计方差,Ft表示系统的状态变化量,Bt表示控制矩阵, 表示代表系统外部影响所具有的协方差;
步骤3:根据目标前一时刻的最优估计坐标位置xhat(k-1),和步骤2中油田侵入目标完整的预测表达式,预测在动态目标在初次出现的油田工作区域内的多步预测轨迹;
步骤4:更新先验估计方差Pminus1;更新无人机对目标的观测数据,并计算卡尔曼增益Kg1;
Kgi(k)=Pminusi(k)/(Pminusi(k)+Ri)                 (2)
步骤5:结合无人机对目标当前时刻的观测值,对未来多个采样时刻的预测轨迹进行修正,得到修正后的最后估计;
其中i表示油田区域:i∈(1,4),(xhatminusi(k),xhatminusi(k))表示在第i个油田工作区域内,第k时刻无人机的监视模块观测到的目标状态信息,(xhatminusi(k-n),yhatminusi(k-n))表示第i个油田工作区域内,第k时刻未来第n个采样周期的无人机的监视模块观测到的目标状态信息;
步骤6:计算最终轨迹估计值的方差Pminusi,判断是否存在Pminusi迭代输出目标当前所在区域的多步预测轨迹,否则返回步骤3;
P(k)=(1-Kg(k))·Pminus(k)                      (4)
步骤7:重复步骤3到步骤6,得出所有油田工作区域内侵入目标的多步预测轨迹。
4.根据权利要求3所述的基于多无人机的油田动态侵入目标追踪方法,其特征在于,所述步骤3具体包括:
步骤3.1:首先,随机初始化果蝇群体在油田中四个区域的位置(Xi_axis,Yi_axis),i∈(1,4),其中每个油田区域只有一架无人机,和油田中通信基站的位置(X_base,Y_base),无人机最大通信距离ric,无人机飞行高度H,和通信基站的高度HG,无人机通信参考距离下的噪声rvoi,无人机对目标观测质量Z,设定果蝇种群规模Sizepop和最大迭代次数Maxgen;
步骤3.2:根据如下公式,赋予果蝇种群利用嗅觉在第一区域内搜寻食物的随机距离与方向;
Xi=X1_axis+RValue                           (5)
Yi=Y1_axis+RValue                            (6)
其中(Xi,Yi),i∈(1,4)表示第i个油田工作区域内果蝇种群的位置,RValue表示赋予果蝇种群搜寻食物的随机步长与方向,通过赋予果蝇种群沿X轴和Y轴,不同的随机步长,赋予果蝇种群不同的前进方向;
步骤3.3:估计第一区域内果蝇种群果蝇个体到原点的距离(Disti),并计算第一区域内种群即第一区域内无人机到其余各个区域内果蝇初始种群即其余区域内无人机的距离以及到油田区域内通信基站的距离 并计算第一区域内果
蝇初始种群,每个果蝇个体的味道浓度判定值 味道浓度值为距离的倒数,具体计算公式有:
步骤3.4:通过下述公式(11),(12)计算第一区域内果蝇种群即区域一内的无人机的信噪比(SNR)和通信强度 通过公式(13)记录传感器观测指数 及多无人机间通信约束条件;
其中 表示参考信噪比,Θ和ε2分别表示地面基站(GBS)的传输功率和UAV的噪声功率,H表示无人机巡航高度,Hg表示地面基站(GBS)的高度,g=(a,b)T,分别表示地面基站(GBS)与UAV在平坐标面的投影坐标;
其中 是表示通过中继
点k,通信节点l与j之间的通信强度, 则是表示通信节点l的最大通信距离, 表示通信节点间的距离, 表示需要与节点l间进行通信的节点的集合;
T T
其中Pi=[xi,yi,zi]表示第i个油田区域上无人机的位置向量,Pt=[xt,yt,zt]表示目标位置向量, 则分别表示四旋翼UAV的偏航俯仰角和速度,基于无人机的动学特性其速度具有一定的限制
步骤3.5:将 和 代入多无人机分区协作动态目标追踪轨迹优化代价函数即公式(15),得到味道浓度判定函数即适应度函数(Fitness function):
其中B为所设定的目标观测质量评价因子,Efitness,Pfitness和Sfitness分别表示用于多无人机分区域协作动态目标追踪轨迹优化代价函数中的 和
步骤3.6:找到油田第一区域内果蝇群体中的局部最优个体即适应度函数中的局部最优解,即 的最小值,以及相应果蝇个体在惯性坐标系中坐标,计算公式有:
其中Bestobs表示最佳观测值即优化代价函数最优值,Bestindex表示出现最佳值的迭代次数, 表示油田第一工作区域内果蝇种群内适应度函数值最优个体的位置;
步骤3.7:对MIEFOA的变异缩放算子F进行初始化,将前代种群中的果蝇个体按照适应度函数值得优劣进行排序,然后使用前代种群中适应度值前40%的果蝇个体替换适应度值后40%的果蝇个体,并从经过种群更新后的前代果蝇种群中选取前代种群中适应度最优的个体 和适应度值前50%中的两个果蝇个体 和 对三个果蝇个体进
行精英替换变异操作,具体变异公式如下所示:
步骤3.8:对经过精英替换变异操作后的果蝇种群进行交叉操作,具体交叉公式如下;
其中,randli为[0,1]间的随机小数,CR为交叉概率,CR∈[0,1];
步骤3.9:选择经过精英替换变异与交叉后的种群,通过公式(17),(18)计算经过精英替换变异与交叉后的果蝇种群的信噪比(SNR)和通信强度 记录传感器观测指数及多无人机间通信约束条件,然后计算下一代迭代个体 与原
个体(Xi(k+1),Yi(k+1))的适应度函数值并进行比较;
步骤3.10:如果 则:
如果 则:
(Xi(k+1),Yi(k+1))=(Xi(k),Yi(k))                  (20)
步骤3.11:如果更新后的种群的适应度函数值优于前一迭代适应度函数值,保留最优适应度函数值与所对应的种群坐标位置,此时果蝇群体利用视觉往该位置飞去;
步骤3.12:重复执行步骤7到10,同时判断味道浓度值即适应度函数值是否优于前一迭代味道浓度,若是执行步骤11,若否执行步骤13;
步骤3.13:输出油田第一区域的全局最优解;
步骤3.14:重复执行步骤1到步骤13分别得到油田工作区2,工作区3和工作区4的全局最优解;
步骤3.15:输出全局最优解。

说明书全文

基于多无人机的油田动态侵入目标追踪系统与方法

技术领域

[0001] 本发明涉及无人机巡检及动态预测追踪技术领域,尤其涉及一种基于多无人机的油田动态侵入目标追踪系统与方法。

背景技术

[0002] 随着国家经济与科技实的发展,各行各业对于石油能源的需求愈发增多,社会逐步向信息化,数字化,智能化方向发展,石油行业也逐步走向信息化,数字化,智能化。随着石油行业的高速发展,对我国石油资源开发的安全性,稳定性,经济性都提出了更高的要求。
[0003] 由于石油采集设备大多存在于野外,并且相对应的安全设施不全,传统的人工巡检需要花费大量的时间对油田中的情况进行检查,不仅耗时而且耗力;而半自动化巡检方式需要也需要定期对安装的设备进行检查,浪费时间的同时也需要庞大的费用。而且近年来不法盗取石油的现象屡禁不止,严重的还破坏采集或存储的设备,对石油工业的安全生产造成了极大的影响。因此传统的人工巡检和半自动巡检方式存在着很多的问题和缺陷
[0004] 近年来,无人机因其效率高,成本低,安全可靠等优点受到广泛关注,在军事和民事两个领域都得到了广泛应用。通常采用无人机对油田生产可能出现的紧急情况进行监控,如石油泄漏,生产设备故障等。而对于油田中的动态侵入目标的实时追踪检测技术还没有得到关注发展,由于油田通常位于地域辽阔的荒野地区,因此油井分布分散,导致侵入油田的动态目标轨迹随机性较大,这给目标实时追踪带来了很大的挑战。小型无人机由于其组织结构较小,承载力有限,往往无法安装稳定的传感器观测平台,通常直接将传感器以预设的安装固定在机体上,同时由于无人机承载力受限也会导致无人机的续航时间受到限制,这种问题在使用单架无人机在连续时间内追踪动态目标时显得尤为突出。如果使用多架无人机协同追踪同一动态目标则可以通过无人机间的信息共享,分配各个无人机的追踪区域,从而提高目标追踪效率。因此,发明一种油田中多无人机分区域协同,连续时间内对油田中动态侵入目标进行多步轨迹预测,然后基于预测轨迹优化不同区域无人机协同目标追踪轨迹系统。

发明内容

[0005] 针对现有技术的不足,本发明提供一种基于多无人机的油田动态侵入目标追踪系统与方法。
[0006] 本发明所采取的技术方案是:
[0007] 一方面,本发明提供一种基于多无人机的油田动态侵入目标追踪系统,包括控制模,监控模块,动态目标轨迹预测模块和多机协同目标追踪轨迹优化模块;
[0008] 所述控制模块包括飞行高度探测模块、飞行姿态控制模块以及无线通讯模块;
[0009] 所述飞行高度探测模块安装于无人机上,其输出端与飞行姿态控制模块相连接,用于实时飞行过程中的飞行高度检测与控制,以实现无人机始终处于固定安全飞行高度;所述飞行姿态控制模块其输出端与无线通讯模块输入端相连接,用于控制飞行过程中无人机自身的飞行姿态控制与飞行高度控制,以便于实现对油田工作区域内的巡检;所述无线通讯模块包括无线数据接收模块、无线数据发送模块以及无线数据通讯模块;所述无线数据接收模块用于接收各个区域内无人机所获取的目标状态数据,所述目标数据包括飞行姿态控制模块所输出的无人机姿态,飞行高度探测模块所输出的无人机飞行高度,无人机GPS和摄像头输出的数据;所述无线数据发送模块用于将接收到的目标状态数据传送到数据接收设备,并将接收到的无人机位置传输到其他无人机端;所述无线通讯模块,用于无人机之间的协同任务分配;
[0010] 所述监控模块包括目标探测模块,无线数据通讯模块与数据存储模块;
[0011] 所述目标探测模块包括摄像头和无人机GPS,所述摄像头安装在无人机上,其输出端与无线通讯模块相连接;所述GPS的输出端与无人机飞行姿态控制模块输入端和无线通讯模块的输入端相连接,用于实时监控无人机的飞行状况,对油田的环境进行监控;同时可以实时观测油田工作区域的环境;所述无线数据通讯模块输出端与数据存储模块的输入端,其他无人机端,和动态目标轨迹预测模块输入端相连接,用于将第一时间获得的动态目标的状态数据,传输给其他工作区域的无人机,联合建立目标的运动学模型
[0012] 所述动态目标轨迹预测模块输出端与所述数据存储模块输入端和所述多机协同目标追踪轨迹优化模块输入端相连接,用于预测目标在当前油田工作区域内未来多个采样时刻内的轨迹,即目标多步预测轨迹;
[0013] 所述目标多步预测轨迹,采用预设的优化算法,优化该区域内无人机实时追踪目标的优化轨迹,并将优化轨迹数据传输给该区域的无人机,通过无人机搭载的控制模块,控制无人机的速度,航向实现对目标的实时追踪,将目标当前所在区域的无人机对目标的多步预测轨迹数据传输到数据存储模块进行存储,方便进行管理。
[0014] 所述多机协同目标追踪轨迹优化模块输出端与数据存储模块输入端相连接,用于优化多无人机协同目标追踪轨迹;
[0015] 另一方面,一种基于多无人机的油田动态侵入目标追踪方法,通过前述基于多无人机的油田动态侵入目标追踪系统实现:包括以下步骤:
[0016] 步骤1:用户设定无人机个数m,并将每个无人机所负责的油田工作区域范围输入到每个无人机的控制模块;将地面动态目标的初始状态信息输入到无人机的动态目标轨迹预测模块,并初始化分布式卡尔曼滤波算法的算法参数:连续采样时间为n_iter,i∈(1.4),i表示油田区域,过程方差为Qi,测量方差为Ri,高斯噪声为[0,25],无人机监控模块获取的目标实时观测信息为Zi,后验估计方差为Pi,误差方差为Psi,卡尔曼增益为Kgi;
[0017] 步骤2:建立动态目标多步轨迹油田侵入目标完整的预测表达式:
[0018]
[0019] 其中 表示动态目标的预测坐标,Pt表示动态目标的预测后验估计方差,Ft表示系统的状态变化量,Bt表示控制矩阵, 表示代表系统外部影响所具有的协方差。
[0020] 步骤3:根据目标前一时刻的最优估计坐标位置xhat(k-1),和步骤2中油田侵入目标完整的预测表达式,预测在动态目标在初次出现的油田工作区域内的多步预测轨迹;
[0021] 步骤3.1:首先,随机初始化果蝇群体在油田中四个区域的位置(Xi_axis,Yi_axis),i∈(1,4),其中每个油田区域只有一架无人机,和油田中通信基站的位置(X_base,Y_base),无人机最大通信距离ric,无人机飞行高度H,和通信基站的高度HG,无人机通信参考距离下的噪声rvoi,无人机对目标观测质量Z,设定果蝇种群规模Sizepop和最大迭代次数Maxgen;
[0022] 步骤3.2:根据如下公式,赋予果蝇种群利用嗅觉在第一区域内搜寻食物的随机距离与方向;
[0023] Xi=X1_axis+RValue                    (5)
[0024] Yi=Y1_axis+RValue                     (6)
[0025] 其中(Xi,Yi),i∈(1,4)表示第i个油田工作区域内果蝇种群的位置,RValue表示赋予果蝇种群搜寻食物的随机步长与方向,通过赋予果蝇种群沿X轴和Y轴,不同的随机步长,赋予果蝇种群不同的前进方向;
[0026] 步骤3.3:估计第一区域内果蝇种群果蝇个体到原点的距离(Disti),并计算第一区域内种群即第一区域内无人机到其余各个区域内果蝇初始种群即其余区域内无人机的距离 i∈(1,4),j∈(1,4)以及到油田区域内通信基站的距离 并计算第一区域内果蝇初始种群,每个果蝇个体的味道浓度判定值 味道浓度值为距离的倒数,具体计算公式有:
[0027]
[0028]
[0029]
[0030]
[0031] 步骤3.4:通过下述公式(11),(12)计算第一区域内果蝇种群即区域一内的无人机的信噪比(SNR)和通信强度 通过公式(13)记录传感器观测指数 及多无人机间通信约束条件;
[0032]
[0033] 其中 表示参考信噪比,Θ和ε2分别表示地面基站(GBS)的传输功率和UAV的噪声功率,H表示无人机巡航高度,Hg表示地面基站(GBS)的高度,g=(a,b)T,分别表示地面基站(GBS)与UAV在平坐标面的投影坐标。
[0034]
[0035] 其中 是表示通过中继点k,通信节点l与j之间的通信强度, 则是表示通信节点l的最大通信距离, 表示通信节点间的距离。 表示需要与节点l间进行通信的节点的集合;
[0036]
[0037] 其中Pi=[xi,yi,zi]T表示第i个油田区域上无人机的位置向量,Pt=[xt,yt,zt]T表示目标位置向量, 则分别表示四旋翼UAV的偏航角、俯仰角和速度,基于无人机的动力学特性其速度具有一定的限制
[0038] 步骤3.5:将 和 代入多无人机分区协作动态目标追踪轨迹优化代价函数即公式(15),得到味道浓度判定函数即适应度函数(Fitness function):
[0039]
[0040]
[0041] 其中B为所设定的目标观测质量评价因子,Efitness,Pfitness和Sfitness分别表示用于多无人机分区域协作动态目标追踪轨迹优化代价函数中的和
[0042] 步骤3.6:找到油田第一区域内果蝇群体中的局部最优个体即适应度函数中的局部最优解,即 的最小值,以及相应果蝇个体在惯性坐标系中坐标,计算公式有:
[0043]
[0044] 其中Bestobs表示最佳观测值即优化代价函数最优值,Bestindex表示出现最佳值的迭代次数, 表示油田第一工作区域内果蝇种群内适应度函数值最优个体的位置;
[0045] 步骤3.7:对MIEFOA的变异缩放算子F进行初始化,将前代种群中的果蝇个体按照适应度函数值得优劣进行排序,然后使用前代种群中适应度值前40%的果蝇个体替换适应度值后40%的果蝇个体,并从经过种群更新后的前代果蝇种群中选取前代种群中适应度最优的个体 和适应度值前50%中的两个果蝇个体 和 对三个果蝇个体进行精英替换变异操作,具体变异公式如下所示:
[0046]
[0047] 步骤3.8:对经过精英替换变异操作后的果蝇种群进行交叉操作,具体交叉公式如下;
[0048]
[0049] 其中,randli为[0,1]间的随机小数,CR为交叉概率,CR∈[0,1];
[0050] 步骤3.9:选择经过精英替换变异与交叉后的种群,通过公式(17),(18)计算经过精英替换变异与交叉后的果蝇种群的信噪比(SNR)和通信强度 记录传感器观测指数及多无人机间通信约束条件,然后计算下一代迭代个体 与原个体(Xi(k+1),Yi(k+1))的适应度函数值并进行比较;
[0051] 步骤3.10:如果 Yi(k+1))则:
[0052] (Xi(k+1),
[0053] 如果 Yi(k+1))则:
[0054] (Xi(k+1),Yi(k+1))=(Xi(k),Yi(k))              (20)
[0055] 步骤3.11:如果更新后的种群的适应度函数值优于前一迭代适应度函数值,保留最优适应度函数值与所对应的种群坐标位置,此时果蝇群体利用视觉往该位置飞去;
[0056]
[0057] 步骤3.12:重复执行步骤7到10,同时判断味道浓度值即适应度函数值是否优于前一迭代味道浓度,若是执行步骤11,若否执行步骤13;
[0058] 步骤3.13:输出油田第一区域的全局最优解;
[0059] 步骤3.14:重复执行步骤1到步骤13分别得到油田工作区2,工作区3和工作区4的全局最优解;
[0060] 步骤3.15:输出全局最优解。
[0061] 步骤4:更新先验估计方差Pminus1;更新无人机对目标的观测数据,并计算卡尔曼增益Kg1;
[0062] Kgi(k)=Pminusi(k)/(Pminusi(k)+Ri)             (2)
[0063] 步骤5:结合无人机对目标当前时刻的观测值,对未来多个采样时刻的预测轨迹进行修正,得到修正后的最后估计;
[0064]
[0065] 其中i表示油田区域:i∈(1,4),(xhatminusi(k),xhatminusi(k))表示在第i个油田工作区域内,第k时刻无人机的监视模块观测到的目标状态信息,(xhatminusi(k-n),yhatminusi(k-n))表示第i个油田工作区域内,第k时刻未来第n个采样周期的无人机的监视模块观测到的目标状态信息;
[0066] 步骤6:计算最终轨迹估计值的方差Pminusi,判断是否存在Pminusi
[0067] P(k)=(1-Kg(k))·Pminus(k)                 (4)
[0068] 步骤7:重复步骤3到步骤6,得出所有油田工作区域内侵入目标的多步预测轨迹;
[0069] 采用上述技术方案所产生的有益效果在于:
[0070] 本发明提供一种基于多无人机的动态目标多步轨迹预测方法和一种基于多无人机的协同动态目标实时追踪系统,无人机本身具有灵活性高、成本低和安全性高等特点。本发明采用多架无人机分区域协同作业,提高了目标追踪的效率,也提高了实时追踪轨迹的优化精度。并确保在无人机实时追踪过程中,工作人员可以通过无人机上的目标探测模块对周围环境和目标状态有大概了解。解决了当前无人机巡检系统中存在的效率低和对于动态目标追踪轨迹误差大灯缺点。附图说明
[0071] 图1为本发明实施例提供的系统结构示意图;
[0072] 图2为本发明实施例提供的应用场景及组成示意图;
[0073] 图3为本发明实施例提供的无人机动态目标轨迹预测流程图
[0074] 图4为本发明实施例提供实时追踪轨迹优化方法流程图。

具体实施方式

[0075] 下面结合附图对本发明具体实施方式加以详细的说明。
[0076] 一方面,本发明提供一种基于多无人机的油田动态侵入目标追踪系统,系统结构示意图如图1所示,应用场景及组成示意图如图2所示,系统包括控制模块,监控模块,动态目标轨迹预测模块和多机协同目标追踪轨迹优化模块;
[0077] 所述控制模块包括飞行高度探测模块、飞行姿态控制模块以及无线通讯模块;
[0078] 所述飞行高度探测模块安装于无人机上,其输出端与飞行姿态控制模块相连接,用于实时飞行过程中的飞行高度检测与控制,以实现无人机始终处于固定安全飞行高度;所述飞行姿态控制模块其输出端与无线通讯模块输入端相连接,用于控制飞行过程中无人机自身的飞行姿态控制与飞行高度控制,以便于实现对油田工作区域内的巡检;所述无线通讯模块包括无线数据接收模块、无线数据发送模块以及无线数据通讯模块;所述无线数据接收模块用于接收各个区域内无人机所获取的目标状态数据,所述目标数据包括飞行姿态控制模块所输出的无人机姿态,飞行高度探测模块所输出的无人机飞行高度,无人机GPS和摄像头输出的数据;所述无线数据发送模块用于将接收到的目标状态数据传送到数据接收设备,并将接收到的无人机位置传输到其他无人机端;所述无线通讯模块,用于无人机之间的协同任务分配;
[0079] 所述监控模块包括目标探测模块,无线数据通讯模块与数据存储模块;
[0080] 所述目标探测模块包括摄像头和无人机GPS,所述摄像头安装在无人机上,其输出端与无线通讯模块相连接;所述GPS的输出端与无人机飞行姿态控制模块输入端和无线通讯模块的输入端相连接,用于实时监控无人机的飞行状况,对油田的环境进行监控;同时可以实时观测油田工作区域的环境;所述无线数据通讯模块输出端与数据存储模块的输入端,其他无人机端,和动态目标轨迹预测模块输入端相连接,用于将第一时间获得的动态目标的状态数据,传输给其他工作区域的无人机,联合建立目标的运动学模型;
[0081] 所述动态目标轨迹预测模块输出端与所述数据存储模块输入端和所述多机协同目标追踪轨迹优化模块输入端相连接,用于预测目标在当前油田工作区域内未来多个采样时刻内的轨迹,即目标多步预测轨迹;
[0082] 所述目标多步预测轨迹,采用预设的优化算法,优化该区域内无人机实时追踪目标的优化轨迹,并将优化轨迹数据传输给该区域的无人机,通过无人机搭载的控制模块,控制无人机的速度,航向实现对目标的实时追踪,将目标当前所在区域的无人机对目标的多步预测轨迹数据传输到数据存储模块进行存储,方便进行管理。
[0083] 所述多机协同目标追踪轨迹优化模块输出端与数据存储模块输入端相连接,用于优化多无人机协同目标追踪轨迹;
[0084] 另一方面,一种基于多无人机的油田动态侵入目标追踪方法,通过前述基于多无人机的油田动态侵入目标追踪系统实现,如图3所示,操作人员首先将油田各个工作区域的位置分布输入到无人机中,确保每块油田子工作区内存在至少一架无人机执行巡检任务。多架无人机同时出发开始巡检任务,无人机通过在固定巡航高度飞行利用目标探测模块监控油田区域内部情况,为了避免无人机巡检过程中发生碰撞事故,无人机通过自身的GPS模块和无线通讯模块协同作业,在探测到油田中出现的动态侵入时,首先确定当前目标所在的油田工作区域,然后调集执行该区域巡检任务的无人机飞进目标,同时通过无人机的目标探测模块确定目标当前时刻的状态信息,并将信息传递到动态目标多步轨迹预测模块,预测目标在当前油田工作子区域的多步预测轨迹,同时将多步预测轨迹传输到多无人机协同目标实时追踪轨迹优化模块,采用MIEFOA优化算法优化计算无人机在该区域内实时追踪目标的优化轨迹。同时将目标在当前区域的多步预测轨迹和无人机实时追踪优化轨迹通过无人机无线通讯模块传输给其他执行任务的无人机,当目标进入下一油田工作子区域时重复上述工作,直到目标离开油田工作区域,各个无人机不再获取目标的状态信息。
[0085] 具体包括以下步骤:
[0086] 步骤1:用户设定无人机个数m,并将每个无人机所负责的油田工作区域范围输入到每个无人机的控制模块;将地面动态目标的初始状态信息输入到无人机的动态目标轨迹预测模块,并初始化分布式扩展卡尔曼滤波算法的算法参数:连续采样时间为n_iter,i∈(1.4),i表示油田区域,过程方差为Qi,测量方差为Ri,高斯噪声为[0,25],无人机监控模块获取的目标实时观测信息为Zi,后验估计方差为Pi,误差方差为Psi,卡尔曼增益为Kgi;
[0087] 步骤2:建立动态目标多步轨迹油田侵入目标完整的预测表达式:
[0088]
[0089] 其中 表示动态目标的预测坐标,Pt表示动态目标的预测后验估计方差,Ft表示系统的状态变化量,Bt表示控制矩阵, 表示代表系统外部影响所具有的协方差。
[0090] 步骤2.1:根据公式(1)和前一时刻目标的位置的最优估计值xhatk-1预测目标当前时刻的位置xhatminus(k);
[0091] 步骤2.2:更新先验估计方差Pminusi;
[0092] 步骤2.3:更新目标轨迹测量值并计算卡尔曼增益Kgi;
[0093] 步骤2.4:结合传感器当前时刻的实测值,对未来多步目标轨迹进行修正预测,得到修正后的最优估计;
[0094] 步骤2.5:计算最终的先验估计方差Pminusi,并与前一时刻先验估计方差对比;
[0095] 步骤2.6:如果Pminusi-1<Pminusi,则输出目标在第一子工作区域的多步预测轨迹,否则返回步骤2.1;
[0096] 步骤2.7:重复上述步骤对目标处于其他子工作区时的多步轨迹进行预测;
[0097] 步骤2.8:输出目标在不同子工作区的预测轨迹;
[0098] 步骤2.9:结合目标在不同子工作区的多步预测轨迹输出目标;
[0099] 步骤3:根据目标的整体多步预测轨迹,提出一种改进的果蝇优化算法(MIEFOA),求解无人机实时追踪目标的最佳轨迹,如图4所示;
[0100] 步骤3.1:首先,随机初始化果蝇群体在油田中四个区域的位置(Xi_axis,Yi_axis),i∈(1,4),其中每个油田区域只有一架无人机,和油田中通信基站的位置(X_base,Y_base),无人机最大通信距离ric,无人机飞行高度H,和通信基站的高度HG,无人机通信参考距离下的噪声rvoi,无人机对目标观测质量Z,设定果蝇种群规模Sizepop和最大迭代次数Maxgen;
[0101] 步骤3.2:根据如下公式,赋予果蝇种群利用嗅觉在第一区域内搜寻食物的随机距离与方向;
[0102] Xi=X1_axis+RValue                    (5)
[0103] Yi=Y1_axis+RValue                    (6)
[0104] 其中(Xi,Yi),i∈(1,4)表示第i个油田工作区域内果蝇种群的位置,RValue表示赋予果蝇种群搜寻食物的随机步长与方向,通过赋予果蝇种群沿X轴和Y轴,不同的随机步长,赋予果蝇种群不同的前进方向;
[0105] 步骤3.3:估计第一区域内果蝇种群果蝇个体到原点的距离(Disti),并计算第一区域内种群即第一区域内无人机到其余各个区域内果蝇初始种群即其余区域内无人机的距离 i∈(1,4),j∈(1,4)以及到油田区域内通信基站的距离 并计算第一区域内果蝇初始种群,每个果蝇个体的味道浓度判定值 味道浓度值为距离的倒数,具体计算公式有:
[0106]
[0107]
[0108]
[0109]
[0110] 步骤3.4:通过下述公式(11),(12)计算第一区域内果蝇种群即区域一内的无人机的信噪比(SNR)和通信强度 通过公式(13)记录传感器观测指数 及多无人机间通信约束条件;
[0111]
[0112] 其中 表示参考信噪比,Θ和ε2分别表示地面基站(GBS)的传输功率和UAV的噪声功率,H表示无人机巡航高度,Hg表示地面基站(GBS)的高度,g=(a,b)T,分别表示地面基站(GBS)与UAV在水平坐标面的投影坐标。
[0113]
[0114] 其中 是表示通过中继点k,通信节点l与j之间的通信强度, 则是表示通信节点l的最大通信距离, 表示通信节点间的距离。 表示需要与节点l间进行通信的节点的集合;
[0115]
[0116] 其中Pi=[xi,yi,zi]T表示第i个油田区域上无人机的位置向量,Pt=[xt,yt,zt]T表示目标位置向量, 则分别表示四旋翼UAV的偏航角、俯仰角和速度,基于无人机的动力学特性其速度具有一定的限制
[0117] 步骤3.5:将 和 代入多无人机分区协作动态目标追踪轨迹优化代价函数即公式(15),得到味道浓度判定函数即适应度函数(Fitness function):
[0118]
[0119]
[0120] 其中B为所设定的目标观测质量评价因子,Efitness,Pfitness和Sfitness分别表示用于多无人机分区域协作动态目标追踪轨迹优化代价函数中的和
[0121] 步骤3.6:找到油田第一区域内果蝇群体中的局部最优个体即适应度函数中的局部最优解,即 的最小值,以及相应果蝇个体在惯性坐标系中坐标,计算公式有:
[0122]
[0123] 其中Bestobs表示最佳观测值即优化代价函数最优值,Bestindex表示出现最佳值的迭代次数, 表示油田第一工作区域内果蝇种群内适应度函数值最优个体的位置;
[0124] 步骤3.7:对MIEFOA的变异缩放算子F进行初始化,将前代种群中的果蝇个体按照适应度函数值得优劣进行排序,然后使用前代种群中适应度值前40%的果蝇个体替换适应度值后40%的果蝇个体,并从经过种群更新后的前代果蝇种群中选取前代种群中适应度最优的个体 和适应度值前50%中的两个果蝇个体 和 对三个果蝇个体进行精英替换变异操作,具体变异公式如下所示:
[0125]
[0126] 步骤3.8:对经过精英替换变异操作后的果蝇种群进行交叉操作,具体交叉公式如下;
[0127]
[0128] 其中,randli为[0,1]间的随机小数,CR为交叉概率,CR∈[0,1];
[0129] 步骤3.9:选择经过精英替换变异与交叉后的种群,通过公式(17),(18)计算经过精英替换变异与交叉后的果蝇种群的信噪比(SNR)和通信强度 记录传感器观测指数及多无人机间通信约束条件,然后计算下一代迭代个体 与原个体(Xi(k+1),Yi(k+1))的适应度函数值并进行比较;
[0130] 步骤3.10:如果 Yi(k+1))则:
[0131] (Xi(k+1),
[0132] 如果 Yi(k+1))则:
[0133] (Xi(k+1),Yi(k+1))=(Xi(k),Yi(k))              (20)
[0134] 步骤3.11:如果更新后的种群的适应度函数值优于前一迭代适应度函数值,保留最优适应度函数值与所对应的种群坐标位置,此时果蝇群体利用视觉往该位置飞去;
[0135]
[0136] 步骤3.12:重复执行步骤7到10,同时判断味道浓度值即适应度函数值是否优于前一迭代味道浓度,若是执行步骤11,若否执行步骤13;
[0137] 步骤3.13:输出油田第一区域的全局最优解;
[0138] 步骤3.14:重复执行步骤1到步骤13分别得到油田工作区2,工作区3和工作区4的全局最优解;
[0139] 步骤3.15:输出全局最优解。
[0140] 步骤4:更新先验估计方差Pminus1;更新无人机对目标的观测数据,并计算卡尔曼增益Kg1;
[0141] Kgi(k)=Pminusi(k)/(Pminusi(k)+Ri)             (2)
[0142] 步骤5:结合无人机对目标当前时刻的观测值,对未来多个采样时刻的预测轨迹进行修正,得到修正后的最后估计;
[0143]
[0144] 其中i表示油田区域:i∈(1,4),(xhatminusi(k),xhatminusi(k))表示在第i个油田工作区域内,第k时刻无人机的监视模块观测到的目标状态信息,(xhatminusi(k-n),yhatminusi(k-n))表示第i个油田工作区域内,第k时刻未来第n个采样周期的无人机的监视模块观测到的目标状态信息;
[0145] 步骤6:计算最终轨迹估计值的方差Pminusi,判断是否存在Pminusi
[0146] P(k)=(1-Kg(k))·Pminus(k)                (4)
[0147] 步骤7:重复步骤3到步骤6,得出所有油田工作区域内侵入目标的多步预测轨迹。
[0148] 如表1所示为本发明实施例提供的基于多无人机的油田动态侵入目标追踪方法与系统的油田无人机巡视区域和无人机追踪路线评价因子及其定义。
[0149] 表1
[0150]
[0151] 如表2所示为本发明实施例提供的基于多无人机的油田动态侵入目标追踪方法与系统的油田无人机巡视区域和无人机追踪路线数据。本文提出一种改进的FOA优化算法(MIEFOA),受到DE算法中更新种群机制所采用的交叉、变异和选择的启发,并考虑到经典的DE优化算法的优化精度不高,受到精英模式的启发,提出一种新型的精英变异环节,通过将经典DE算法中变异环节中的随机选择三个个体,改为首先将前代种群中适应度值得前40%的个体替换前代种群中适应度后40%的个体以后,选取前代种群中的最佳个体并在适应度值前50%中随机选择两个个体,通过交叉,精英变异,和选择环节来对FOA算法的种群进行更新,从而实现对FOA算法优化精度的提升,使得新提出的MIEFOA优化算法同时具备较强的局部搜索能力与全局优化能力,由表1可以发现通过20次的仿真验证,新提出的MIEFOA优化算法的i次预测结果的平均绝对预测误差(MAE)最优值,最劣值与平均值均达到了5m,满足说明该算法有效解决了FOA算法优化精度较差与经典DE算法出现的陷入局部最优解的问题,MIEFOA算法i次预测结果的平均绝对预测误差(MAE)的Std值为0.0522说明该算法的具备较强的稳定性可以稳定应用于轨迹优化问题求解中;轨迹优化结果一致性指标(IA)平均值为0.9943m最优值为0.9946m;绝对误差的平均值(MAPE)的平均值为0.4996m,轨迹优化结果的方向精度(DA)的平均值为0.1482,均为八种优化算法中的最优值,可以看出经过修改过的MIEFOA优化算法具有较好的轨迹优化方向精度,较好的轨迹优化结果一致性,同时MIEFOA 20次仿真验证的平均优化时间为31.97s,说明该算法的收敛速度较快,可以满足本文中油田多区动态侵入目标多无人机实时追踪观测轨迹优化问题的时效性要求,可以有效实现对油田内动态侵入目标的追踪观测。
[0152] 表2
[0153]
[0154] 如表3所示为本发明实施例提供的基于分布式扩展卡尔曼滤波算法对油田内动态侵入目标多步轨迹进行预测的轨迹预测数据。这一部分,采用统计指标MAE对侵入目标多步轨迹预测平均精度进行评估,该指标可以反映轨迹预测的全局预测精度,轨迹预测的稳定性通过在每种情况下运行30次出现较大的轨迹预测偏差(各个采样点的轨迹预测点与目标实时坐标点距离超过阈值范围[-10m,10m]),从Table 3可以看出对目标的进行不同步数的轨迹预测,预测时间随着预测步数的增加而增加,但预测精度在对目标进行四步轨迹预测时达到最高,平均绝对误差(MAE)达到了4.47m,满足轨迹预测成功阈值[-10m,10m],预测一致性指标(IA)达到了0.6600m,方向精度(DA)达到了0.1615m,绝对误差平均值(MAPE)达到了0.3723%,而整体的轨迹预测时间为9.85s,可以看出当轨迹预测步数为四步时轨迹预测精度达到最佳的同时,轨迹预测时间小于单位采样时间10s,与之相比,当预测步数为1到3步时轨迹预测时间均小于10s但预测误差较大超过了轨迹预测成功阈值[-10m,10m],而当预测步数超过四步时,预测精度逐渐下降而轨迹预测时间随着预测步数的增加而增加,超过了单位采样时间10s,因此,为了获得最精确的目标轨迹状态,选择对油田内侵入动态目标进行四步轨迹预测,在获得目标未来四个采样周期内的轨迹数据后,根据预测轨迹实现多无人机的协同目标追踪轨迹优化。
[0155] 表3
[0156]
[0157] 最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明权利要求所限定的范围。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈