无人机与地面机动目标虚拟编队战位保持控制方法技术

本发明专利技术提供了一种无人机与地面机动目标“虚拟编队”战位保持控制方法，建立地面机动目标运动模型，对目标运动信息进行估计，建立“虚拟编队”模型及模糊状态机，根据目标运动信息维护虚拟编队点运动信息，利用虚拟编队点运动信息和无人机运动信息计算滚转指令，由滚转角指令计算无人机副翼控制指令及方向舵控制指令，并送入执行机构进行无人机姿态控制。本发明专利技术使得无人机对地面机动目标的跟踪运用方式变得灵活多样，满足多种跟踪需求；降低了系统不确定性与测量不确定性对无人机的影响，从而抑制了无人机姿态抖动；提高了无人机对地面机动目标的跟踪能力，同时也保障了飞行安全。

【技术实现步骤摘要】
无人机与地面机动目标虚拟编队战位保持控制方法
本专利技术涉及无人机领域，尤其是一种无人机与地面机动目标的控制方法。
技术介绍
侦察型无人机一般携带可见光/红外传感器及激光测距/照射设备完成对地面目标的侦察、定位及照射引导等功能。要完成这些功能，需要无人机的光电设备能稳定的跟踪地面目标，而固定翼无人机在跟踪地面机动目标时，由于需要保持空速，无法悬停，并且无人机的飞行速度一般大于地面目标的运动速度，因此固定翼无人机对地面机动目标的跟踪，需要在无人机与地面机动目标建立一种“虚拟编队”的战位来实现稳定跟踪。传统的无人机跟踪地面目标的方法是以目标为圆心在目标上空进行盘旋，这种方法实现简单，但不够灵活，无法满足需要无人机在目标侧面进行侦察照射的使用方式要求；若采用无人机在目标侧面进行机动飞行的方式，既增加地面操作人员的工作负荷，又不能精确保证无人机与目标之间的位置关系。因此需要根据无人机载侦察照射设备的激光作用距离、照射引导方式及跟踪角速度限制等因素，建立一种无人机与地面机动目标所组成的“虚拟编队”战位。由于地面目标运动模式的不确定性，以及侦察设备获取的目标运动信息中的噪声信号，使得如果单纯根据侦察照射设备获取的目标运动信息来调整无人机制导指令，控制无人机航迹，则将会出现无人机制导指令的抖动，从而导致无人机姿态控制指令的抖动，导致无人机姿态频繁变化，这样就不能为侦察照射设备提供稳定的工作环境，严重地，还会诱发振荡，导致飞机失控，影响任务执行并危及无人机飞行安全。
技术实现思路
为了克服现有技术的不足，实现固定翼无人机对地面机动目标实现灵活稳定的跟踪，解决固定翼无人机由于目标运动信息的不确定性以及侦察设备的测量不确定性对航迹控制的影响问题，本专利技术提出一种无人机与地面机动目标“虚拟编队”战位保持控制方法。本专利技术解决其技术问题所采用的技术方案的步骤如下：步骤1：建立地面机动目标运动模型，并对目标运动信息进行估计；对于地面机动目标，采用Singer模型进行描述，即：式中x，分别为目标的位置、速度、加速度和加加速度；ω(t)是均值为0，方差为σ2的高斯白噪声，α为机动系数；无人机上装载的机载侦察设备通过对地面机动目标进行测距定位，得到地面机动目标相对于无人机的位置，再根据已知的无人机位置得到地面机动目标的实时位置；建立离散卡尔曼滤波器，取状态量为[px,vx,ax,py,vy,ay]T，其中px,vx,ax,py,vy,ay分别为目标位置x轴向分量，目标速度x轴向分量，目标加速度x轴向分量，目标位置y轴向分量，目标速度y轴向分量，目标加速度y轴向分量，目标建立如下卡尔曼滤波器，用于估计目标位置和速度：Pk,k-1＝APk-1,k-1AT+QKk＝Pk,k-1HT(HPk,k-1HT+R)-1Pk,k＝Pk,k-1-KkHPk,k-1其中，和分别为k-1时刻和k时刻的后验状态估计值，A为状态矩阵，AT为状态矩阵的转置，Q为过程噪声矩阵，H为观测矩阵，HT为观测矩阵的转置，R为观测噪声矩阵；Pk-1,k-1表示k-1时刻的后验估计协方差，Pk,k-1表示k时刻的先验估计协方差，Kk为滤波增益矩阵，为k时刻的先验状态估计值，zk为观测值，Pk,k为k时刻的后验估计协方差；步骤2：建立“虚拟编队”模型及模糊状态机，根据目标运动信息维护虚拟编队点运动信息；引入虚拟编队点O，对于地面机动目标T，O点的位置通过相对于T的方位角ψ，俯仰角θ以及距离r确定，由于目标T不断运动，O点的位置也不断更新，看作O点与目标T编队运动，将这种无人机与地面机动目标之间的相对稳定编队称为“虚拟编队”战位；无人机对地面机动目标的跟踪问题分解为O点与目标T的非合作编队问题和无人机对以O点为圆心的圆形轨迹的跟踪问题；将虚拟编队点O与目标T间的距离误差De和速度误差Ve作为模糊状态机的输入，设De的取值范围为[-Dmax,Dmax]，Ve的取值范围为[-Vmax,Vmax]，对距离误差De和速度误差Ve作归一化处理：设de与ve的模糊语言取值均为{负大，小，正大}，对应的模糊隶属度函数均为三角隶属度函数，三角隶属度函数形式为：其中，该函数参数分别为：负大(a＝-2,b＝-1,c＝-0.1)，小(a＝-0.5,b＝0,c＝0.5)，负大(a＝0.1,b＝1,c＝2)；将虚拟编队点O的速度指令Vcmd作为模糊状态机的输出，其模糊语言取值设为{负大，小，正大}，其中负大对应-Vcmd，小对应0，正大对应Vcmd；建立如下模糊规则库：根据所建立的规则库，采用乘积推理机进行模糊推理：μ(u)＝μ(de)×μ(ve)式中，μ(de)和μ(ve)分别为de和ve的隶属度函数；对于模糊推理的结果，采用重心法进行反模糊化，计算方法如下：式中，μi指第i条规则对应的输出，μN(ui)指该输出的隶属度函数值，得到最终的虚拟编队点O的速度指令u；步骤3：利用虚拟编队点运动信息和无人机运动信息计算滚转指令；无人机目标轨迹为以虚拟编队点O为圆心，半径为Rcmd的圆轨迹，虚拟编队点O的速度为步骤2中计算得出的u，无人机当前位置为P，当前速度为V，与虚拟编队点O的速度方向夹角为ψp，该虚拟编队点即为无人机跟踪的地面机动目标，无人机的横向加速度指令由以下步骤计算得到：(1)无人机运动时间常数为T，阻尼为ξ，ω、kd、kd均为增益系数，按以下公式计算：kd=ω2,(2)由无人机与圆心间距离d和半径指令Rcmd得到位置误差derr，由无人机速度V沿OP投影可得到速度误差(3)计算由位置误差得到的横向加速度指令acmd1：(4)计算由动点O运动所需的横向加速度指令acmd2：acmd2＝kcucosψp(5)计算无人机圆周运动所需的横向加速度指令acmd3：(6)计算总的横向加速度指令acmd：acmd＝acdm1+acdm2+acdm3(7)计算滚转角指令φcmd，g为重力加速度：步骤4：由滚转角指令φcmd根据下式计算无人机副翼控制指令δa及方向舵控制指令δr：δa＝kφ·(φ-φcmd)+kppδr＝kφr·(φ-φcmd)+krr式中，p为无人机滚转角速率，r为无人机偏航角速率，φ为无人机滚转角，kφ，kφr，kp，kr均为控制增益，将计算得到的无人机副翼控制指令δa及方向舵控制指令δr送入执行机构进行无人机姿态控制，从而实现固定翼无人机与地面机动目标“虚拟编队”战位的保持控制。本专利技术的有益效果在于本专利技术提出的无人机与地面机动目标“虚拟编队”战位保持控制方法，具有以下3个优点：1.通过构建“虚拟编队”，将无人机对地面机动目标的跟踪问题分解为一中心点与目标的非合作编队问题和无人机对以该中心点为圆心的圆形轨迹的跟踪问题，使得无人机对地面机动目标的跟踪运用方式变得灵活多样，满足多种跟踪需求；2.对定位所得的目标位置进行卡尔曼滤波，并运用模糊状态机对虚拟编队中心点的速度量进行求解，降低了系统不确定性与测量不确定性对无人机的影响，从而抑制了无人机姿态抖动；3.运用L1制导算法解决了无人机姿态控制与对机动目标跟踪间的矛盾，提高了无人机对地面机动目标的跟踪能力，同时也保障了飞行安全。附图说明图1是本专利技术专利技术方法实现框图。图2是本专利技术虚拟编队点示意图。图3是本专利技术模糊系统隶属度函数。图4是本专利技术无人机跟踪本文档来自技高网...

【技术保护点】
1.一种无人机与地面机动目标“虚拟编队”战位保持控制方法，其特征在于包括下述步骤：步骤1：建立地面机动目标运动模型，并对目标运动信息进行估计；对于地面机动目标，采用Singer模型进行描述，即：

【技术特征摘要】
1.一种无人机与地面机动目标“虚拟编队”战位保持控制方法，其特征在于包括下述步骤：步骤1：建立地面机动目标运动模型，并对目标运动信息进行估计；对于地面机动目标，采用Singer模型进行描述，即：式中x，分别为目标的位置、速度、加速度和加加速度；ω(t)是均值为0，方差为σ2的高斯白噪声，α为机动系数；无人机上装载的机载侦察设备通过对地面机动目标进行测距定位，得到地面机动目标相对于无人机的位置，再根据已知的无人机位置得到地面机动目标的实时位置；建立离散卡尔曼滤波器，取状态量为[px,vx,ax,py,vy,ay]T，其中px,vx,ax,py,vy,ay分别为目标位置x轴向分量，目标速度x轴向分量，目标加速度x轴向分量，目标位置y轴向分量，目标速度y轴向分量，目标加速度y轴向分量，目标建立如下卡尔曼滤波器，用于估计目标位置和速度：Pk,k-1＝APk-1,k-1AT+QKk＝Pk,k-1HT(HPk,k-1HT+R)-1Pk,k＝Pk,k-1-KkHPk,k-1其中，和分别为k-1时刻和k时刻的后验状态估计值，A为状态矩阵，AT为状态矩阵的转置，Q为过程噪声矩阵，H为观测矩阵，HT为观测矩阵的转置，R为观测噪声矩阵；Pk-1,k-1表示k-1时刻的后验估计协方差，Pk,k-1表示k时刻的先验估计协方差，Kk为滤波增益矩阵，为k时刻的先验状态估计值，zk为观测值，Pk,k为k时刻的后验估计协方差；步骤2：建立“虚拟编队”模型及模糊状态机，根据目标运动信息维护虚拟编队点运动信息；引入虚拟编队点O，对于地面机动目标T，O点的位置通过相对于T的方位角ψ，俯仰角θ以及距离r确定，由于目标T不断运动，O点的位置也不断更新，看作O点与目标T编队运动，将这种无人机与地面机动目标之间的相对稳定编队称为“虚拟编队”战位；无人机对地面机动目标的跟踪问题分解为O点与目标T的非合作编队问题和无人机对以O点为圆心的圆形轨迹的跟踪问题；将虚拟编队点O与目标T间的距离误差De和速度误差Ve作为模糊状态机的输入，设De的取值范围为[-Dmax,Dmax]，Ve的取值范围为[-Vmax,Vmax]，对距离误差De和速度误差Ve作归一化处理：设de与ve的模糊语言取值均为{负大，小，正大}，对应的模糊隶属度...

【专利技术属性】
技术研发人员：贾伟，孙哲芃，肖佳伟，汤恒先，
申请(专利权)人：西安爱生技术集团公司，西北工业大学，
类型：发明
国别省市：陕西,61