基于动态滑动窗口辨识的机动目标轨迹在线预测方法

文档序号:30584070发布日期:2022-06-29 15:13阅读:225来源:国知局
基于动态滑动窗口辨识的机动目标轨迹在线预测方法
prediction based on gru neural network.2019ieee/aiaa 38th digital avionics systems conference(dasc),2019,pp.1-8.
8.[3]奚之飞,徐安,寇英信,李战武,杨爱武.基于改进粒子群算法辨识volterra 级数的机动目标轨迹预测[j].航空学报,2020,41(12):355-374.
[0009]
[4]m.lv,x.zhang,h.chen,c.ling and j.li.an accurate online prediction model for kiln head temperature chaotic time series.ieee access,vol.8,pp. 44288-44299,2020.


技术实现要素:

[0010]
本发明公开了一种基于动态滑动窗口辨识的机动目标轨迹在线预测方法,通过提出动态滑动窗口的方法,同时对滑窗内的数据进行赋权值处理,增加轨迹数据的可靠性,然后使用改进初始化方法的粒子群算法在线辨识volterra级数预测模型的参数,减少计算消耗时间,最后结合残差补偿法对预测值进行校正,提高轨迹预测精度,实现机动目标轨迹的在线精准预测。
[0011]
为了实现上述目的,本发明采用以下技术方案:
[0012]
基于动态滑动窗口辨识的机动目标轨迹在线预测方法,包括以下步骤:步骤 1:实时探测机动目标的轨迹数据,具体的:
[0013]
设定无线传感器网络可以实时观测到机动目标的位置坐标信息,对于已采集的历史轨迹数据表现为时间序列的形式,记为x(n),n=1,2,

,n;采用改进的 c-c方法确定重构相空间的嵌入维数m和延迟时间τ,将所述历史轨迹数据重构到m维相空间,重构后多维时间序列记为x
l
,l=1,2,

,m;
[0014]
步骤2:建立预测模型,具体的:
[0015]
根据步骤1中所述重构相空间的嵌入维数m和延迟时间τ,建立下述基于相空间的p阶volterra级数预测模型:
[0016][0017]
其中,为预测值;h0为常数项参数;hd(i1,i2,

,id)为d阶volterra核参数,id=0,1,

,m-1,d=1,2,

,p;p为模型阶数;m为嵌入维数;x(n-ijτ)为历史轨迹数据序列,n=1,2,

,n,j=1,2,

,d;τ为延迟时间。
[0018]
步骤3:建立动态滑动窗口,具体的:
[0019]
根据步骤1所述已采集的历史轨迹数据确定动态滑动窗口的固定部分长度,记为w;根据机动目标的轨迹特征以及算法的预测误差确定滑动窗口的动态调节部分长度,记为δw;动态滑动窗口的长度由所述固定部分和动态调节部分构成,记为w;对于实时移动的机动目标,从t=t1时刻开始,每个时刻都采样一个轨迹数据进入滑动窗口,并且窗口中最早的一个数据将被移除;每个时刻都进行一次轨迹预测;在t=tk时刻,动态滑动窗口内的机动目标轨迹坐标数据记为x(j), j=k,k+1,

,k+w-1;
[0020]
步骤4:动态调节滑动窗口的长度,具体的:
[0021]
根据步骤3所述滑动窗口的动态调节部分长度由机动目标的轨迹特征以及算法的预测误差确定;从所述t=t1时刻开始预测,设定预测时间周期,记为t,在每次周期开始前
对滑动窗口的长度进行动态调整;定义第r个时间周期内的轨迹数据均值波动为vr,第r个时间周期内的平均绝对预测误差为er;由所述轨迹数据均值波动和平均绝对预测误差计算动态调节部分的长度δw;
[0022]
步骤5:对滑动窗口内数据赋权值,具体的:
[0023]
根据步骤3和步骤4所构建的动态滑动窗口在线选取最新的机动目标轨迹数据,使用所述嵌入维数m和延迟时间τ对窗口内的数据进行相空间重构,并改为volterra级数预测模型的输入数据形式,记为u(l),l=1,2,

,m;结合sigmoid 函数,对动态滑动窗口内的各个数据按照递增的原则赋予权重,记为α
l
, l=1,2,

,m;
[0024]
步骤6:调用粒子群算法并设置初始参数,具体的:
[0025]
根据步骤5得到具有权重的动态滑动窗口数据,将其作为粒子群算法的训练数据;设定粒子群算法迭代次数从ite=1开始,最大迭代次数为ite
max
,种群规模为np,搜索空间维数为d,搜索上限为搜索下限为x。
[0026]
步骤7:种群初始位置设置,具体的:
[0027]
根据步骤5和步骤6得到动态滑动窗口以及粒子群算法初始参数,判断是否首次调用粒子群算法;
[0028]
若是,采用均分网格法初始化种群位置:首先将所述搜索上限和搜索下限 x平均划分为q+1个间隔值ik;将每个间隔值ik扩充为d维的网格向量对于所述d维网格向量从第1维开始,将值i1依次替换为ik,k=2,3,

q+1,其余d-1维仍为i1,直到第d维,记录每次更改所生成的网格向量;以此类推,将所有网格向量重复上述过程;使用所述方法共生成(q+1)
×
((d
×
q)+1)组d 维网格向量;将所述网格向量代入适应度函数中,选取适应度值最小的np组网格向量作为粒子群算法的种群初始位置,记为
[0029]
否则,使用上次保存的粒子最优位置作为本次调用粒子群算法的种群初始位置,记为
[0030]
步骤8:粒子群辨识寻优,具体的:
[0031]
根据步骤7得到粒子群初始位置同时随机初始化粒子群速度开始循环迭代,在第ite=j轮迭代:将种群位置向量依次代入加权适应度函数中,i=1,2,

,np,计算出全体粒子的适应度值;由所述适应度值得到第i个粒子的历史最优位置pbesti,以及第j轮迭代的种群历史最优位置gbest;由速度和位置进化规则对种群位置进行进化;重复上述过程直至到达所述最大迭代次数ite
max
,保存种群最优位置。
[0032]
步骤9:轨迹预测,具体的:
[0033]
根据步骤8所得最优粒子位置作为所述volterra级数预测模型的参数,将所述动态滑动窗口内的数据作为预测模型的输入数据,计算得到机动目标的在 t=tk时刻的单步轨迹预测值
[0034]
步骤10:残差补偿法校正预测值,具体的:
[0035]
根据步骤9所得单步外推预测值计算其与真实值x(k)的偏差,记为δe(k),保存最大长度为所述动态滑动窗口长度w的偏差向量,记为δe;使用递推最小二乘算法,输
入项为所述动态滑动窗口内的轨迹坐标数据,期望输出项为所述偏差向量δe,求解下一时刻的预测残差补偿值res(k+1);将所述下一时刻预测残差补偿值res(k+1)与所述预测模型的下一时刻单步预测值相加得到校正后的轨迹预测值,记为
[0036]
步骤11:重复步骤3至步骤10,直到停止预测机动目标轨迹。
[0037]
步骤1所述重构后多维时间序列记为x
l
,具体形式如下:
[0038]
x
l
=[x(l),x(l+τ),

,x(l+(m-1)τ)]
t
,l=1,2,

,m
[0039]
其中,m=n-(m-1)τ为历史轨迹数据序列重构后的多维空间相点数。
[0040]
步骤3中所述动态滑动窗口的长度w采用如下方法计算:
[0041]
w=w+δw
[0042]
其中,w为固定部分长度,其大小由已收集到历史轨迹数据量决定;δw为动态调节部分长度,其大小由轨迹数据特征和预测误差波动决定。
[0043]
步骤4中所述滑动窗口的动态调节部分的长度δw采用如下方法计算:
[0044][0045]
式中,
[0046][0047][0048][0049][0050]
其中,λ和μ为平滑因子,用以调节δw的大小;δ(0≤δ≤1)和ε(0≤ε≤1)为设定的调节阈值;zr为第r个时间周期内的轨迹数据;var表示求方差;max和 min分别表示求最大值和最小值;δej为第r个时间周期内的轨迹预测误差。
[0051]
步骤5中所述volterra级数预测模型的输入数据记为u(l),l=1,2,

,m,具体形式如下:
[0052]
u(l)=[1,x(l+(m-1)τ),

,x(l),x2(l+(m-1)τ),

,x2(l),

,x
p
(l)]
t
[0053]
其中,m=w-(m-1)τ为动态滑动窗口内数据重构后的多维空间相点数;m 为嵌入维数;τ为延迟时间;p为volterra级数预测模型阶数。
[0054]
步骤5中所述滑动窗口内各个数据的自适应权重α
l
采用如下方法计算:
[0055][0056]
式中,
[0057]al
=1/(1+e
(-10*l+5)
)
[0058]
其中,动态滑动窗口中越靠后的轨迹数据所拥有的权重越大;
[0059]
步骤6中所述搜索空间维数d采用如下方法计算:
[0060][0061]
其中,p为volterra级数预测模型的阶数;m为嵌入维数;c为组合数公式。
[0062]
步骤7中所述间隔值ik和网格向量分别采用如下方法计算:
[0063][0064][0065]
其中,和x分别为粒子搜索上限和搜索下限;q为搜索空间均分值;d为搜索空间维数。
[0066]
步骤8中所述第i个粒子的适应度值采用如下方法计算:
[0067][0068]
其中,α
l
为所述第l组数据的权重;y(l)为所述第l组数据的期望输出项; u(l)为所述第l组输入数据;u
t
(l)为u(l)的转置形式;为第i个粒子的位置向量。
[0069]
步骤8中所述粒子群第i个粒子的速度和位置进化规则采用如下方法计算:
[0070][0071][0072]
其中,vi为第i个粒子的速度;ω为粒子的惯性权重;c1和c2为学习因子; r1和r2为[0,1]区间内的随机数;pbesti(j)为第i个粒子在第j轮迭代的历史最优位置;为第i个粒子在第j轮迭代的位置;gbest(j)为第j轮迭代的种群历史最优位置。
[0073]
步骤10中所述最大长度为动态滑动窗口长度w的偏差向量δe,具体形式如下:
[0074]
δe=[δe(k-w+1),δe(k-w+2),

,δe(k)]
[0075]
其中,w为动态滑动窗口的长度。
[0076]
步骤10中所述校正后的轨迹预测值采用如下方法计算:
[0077][0078]
其中,为校正后的预测值;为volterra预测模型求出的预测值;res(k+1)为t=t
k+1
时刻预测值的残差补偿值。
[0079]
本发明的有益效果:
[0080]
通过上述技术方案,本发明针对现有的机动目标轨迹在线预测算法预测精度低、消耗时间久等问题,提出了基于动态滑动窗口辨识的机动目标轨迹在线预测方法。
[0081]
首先,在数据处理上,由于难以获取目标的所有机动方式,仅能通过传感器网络观测获得机动目标的轨迹坐标数据,为了增加数据的可靠性,本发明提出具有权重的动态滑动窗口策略,在线获取实时轨迹数据,同时在每次预测前更新预测模型参数,提高预测精度,实现在线轨迹预测;
[0082]
其次,在模型辨识上,由于标准粒子群算法在辨识预测模型参数时很难得到最优解,并且辨识过程往往无法复现,为了改善模型的辨识效果,本发明提出了空间网格初始化方法,用于首次辨识预测模型的参数,同时在更新模型参数时调用保存的粒子最优位置初始化粒子群,减少辨识时间;
[0083]
最后,在轨迹预测上,由于采用结合动态滑动窗口的在线辨识方法辨识预测模型的参数,长期积累会导致预测误差逐渐增大,为了避免这种情况,本发明提出残差补偿法对每次预测值进行修正,修正后的值作为最终的预测结果,增加轨迹预测精度。
附图说明
[0084]
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
[0085]
图1为本发明的方法流程图。
[0086]
图2为本发明的动态滑动窗口模型图。
[0087]
图3为本发明的滑动窗口加权过程图。
[0088]
图4为本发明的残差补偿方法示意图
[0089]
图5为无人机飞行机动轨迹图
[0090]
图6为本发明方法对无人机轨迹的预测偏差图
具体实施方式
[0091]
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
[0092]
如图1所示:基于动态滑动窗口辨识的机动目标轨迹在线预测方法,包括以下步骤:
[0093]
步骤1:实时探测机动目标的轨迹数据,具体的:
[0094]
设定无线传感器网络可以实时观测到机动目标的位置坐标信息,对于已采集的历史轨迹数据表现为时间序列的形式,记为x(n),n=1,2,

,n;采用改进的 c-c法确定重构相空间的嵌入维数m和延迟时间τ,将所述历史轨迹数据重构到 m维相空间,重构后多维时间序列记为x
l
,具体形式如下:
[0095]
x
l
=[x(l),x(l+τ),

,x(l+(m-1)τ)]
t
,l=1,2,

,m
[0096]
其中,m=n-(m-1)τ为历史轨迹数据序列重构后的多维空间相点数。
[0097]
步骤2:建立预测模型,具体的:
[0098]
根据步骤1中所述重构相空间的嵌入维数m和延迟时间τ,建立下述基于相空间的p阶volterra级数预测模型:
[0099][0100]
其中,为预测值;h0为常数项参数;hd(i1,i2,

,id)为d阶volterra核参数,id=0,1,

,m-1,d=1,2,

,p;p为模型阶数;m为嵌入维数;x(n-ijτ)为历史轨迹数据序列,n=1,2,

,n,j=1,2,

,d;τ为延迟时间。
[0101]
步骤3:建立动态滑动窗口,具体的:
[0102]
根据步骤1所述已采集的历史轨迹数据确定动态滑动窗口的固定部分长度,记为w;根据机动目标的轨迹特征以及算法的预测误差确定滑动窗口的动态调节部分长度,记为δw;动态滑动窗口的长度由所述固定部分和动态调节部分构成,记为w;对于实时移动的机动目标,从t=t1时刻开始,每个时刻都采样一个轨迹数据进入滑动窗口,并且窗口中最早的一个数据将被移除;每个时刻都进行一次轨迹预测;在t=tk时刻,动态滑动窗口内的机动目标轨迹坐标数据记为x(j), j=k,k+1,

,k+w-1;动态滑动窗口模型如图2所示;
[0103]
其中,步骤3中所述动态滑动窗口的长度w采用如下方法计算:
[0104]
w=w+δw
[0105]
其中,w为固定部分长度,其大小由已收集到历史轨迹数据量决定;δw为动态调节部分长度,其大小由轨迹数据特征和预测误差波动决定。
[0106]
步骤4:动态调节滑动窗口的长度,具体的:
[0107]
根据步骤3所述滑动窗口的动态调节部分长度由机动目标的轨迹特征以及算法的预测误差确定;从所述t=t1时刻开始预测,设定预测时间周期,记为t,在每次周期开始前对滑动窗口的长度进行动态调整;定义第r个时间周期内的轨迹数据均值波动为vr,第r个时间周期内的平均绝对预测误差为er;由所述轨迹数据均值波动和平均绝对预测误差计算动态调节部分的长度δw;
[0108]
其中,步骤4中所述滑动窗口的动态调节部分的长度δw采用如下方法计算:
[0109][0110]
式中,
[0111][0112]
[0113][0114][0115]
其中,λ和μ为平滑因子,用以调节δw的大小;δ(0≤δ≤1)和ε(0≤ε≤1)为设定的调节阈值;zr为第r个时间周期内的轨迹数据;var表示求方差;max和 min分别表示求最大值和最小值;δej为第r个时间周期内的轨迹预测误差。
[0116]
步骤5:对滑动窗口内数据赋权值,具体的:
[0117]
根据步骤3和步骤4所构建的动态滑动窗口在线选取最新的机动目标轨迹数据,使用所述嵌入维数m和延迟时间τ对窗口内的数据进行相空间重构,并改为 volterra级数预测模型的输入数据形式,记为u(l),l=1,2,

,m;结合sigmoid 函数,对动态滑动窗口内的各个数据按照递增的原则赋予权重,记为α
l
, l=1,2,

,m;滑动窗口加权过程如图3所示;
[0118]
其中,步骤5中所述volterra级数预测模型的输入数据记为u(l), l=1,2,

,m,具体形式如下:
[0119]
u(l)=[1,x(l+(m-1)τ),

,x(l),x2(l+(m-1)τ),

,x2(l),

,x
p
(l)]
t
[0120]
其中,m=w-(m-1)τ为动态滑动窗口内数据重构后的多维空间相点数;m 为嵌入维数;τ为延迟时间;p为volterra级数预测模型阶数。
[0121]
步骤5中所述滑动窗口内的各个数据权重α
l
采用如下方法计算:
[0122][0123]
式中,
[0124]al
=1/(1+e
(-10*l+5)
)
[0125]
其中,动态滑动窗口中越靠后的轨迹数据所拥有的权重越大;
[0126]
步骤6:调用粒子群算法并设置初始参数,具体的:
[0127]
根据步骤5得到具有权重的动态滑动窗口数据,将其作为粒子群算法的训练数据;设定粒子群算法迭代次数从ite=1开始,最大迭代次数为ite
max
,种群规模为np,搜索空间维数为d,搜索上限为搜索下限为x。
[0128]
其中,步骤6中所述搜索空间维数d采用如下方法计算:
[0129][0130]
其中,p为volterra级数预测模型的阶数;m为嵌入维数;c为组合数公式。
[0131]
步骤7:种群初始位置设置,具体的:
[0132]
根据步骤5和步骤6得到动态滑动窗口以及粒子群算法初始参数,判断是否首次调用粒子群算法;
[0133]
若是,采用均分网格法初始化种群位置:首先将所述搜索上限和搜索下限 x平均
划分为q+1个间隔值ik;将每个间隔值ik扩充为d维的网格向量对于所述d维网格向量从第1维开始,将值i1依次替换为ik,k=2,3,

q+1,其余d-1维仍为i1,直到第d维,记录每次更改所生成的网格向量;以此类推,将所有网格向量重复上述过程;使用所述方法共生成(q+1)
×
((d
×
q)+1)组d 维网格向量;将所述网格向量代入适应度函数中,选取适应度值最小的np组网格向量作为粒子群算法的种群初始位置,记为
[0134]
否则,使用上次保存的粒子最优位置作为本次调用粒子群算法的种群初始位置,记为
[0135]
其中,步骤7中所述间隔值ik和网格向量分别采用如下方法计算
[0136][0137][0138]
其中,和x分别为粒子搜索上限和搜索下限;q为搜索空间均分值;d为搜索空间维数。
[0139]
步骤7中所述d维网格向量所生成的新的网格向量,具体形式如下:
[0140][0141]
其中,每一列代表一组新的d维网格向量,共有d
×
q组。
[0142]
步骤8:粒子群辨识寻优,具体的:
[0143]
根据步骤7得到粒子群初始位置同时随机初始化粒子群速度开始循环迭代,在第ite=j轮迭代:将种群位置向量依次代入加权适应度函数中,i=1,2,

,np,计算出全体粒子的适应度值;由所述适应度值得到第i个粒子的历史最优位置pbesti,以及第j轮迭代的种群历史最优位置gbest;由速度和位置进化规则对种群位置进行进化;重复上述过程直至到达所述最大迭代次数ite
max
,保存种群最优位置。
[0144]
其中,步骤8中所述第i个粒子的适应度值采用如下方法计算:
[0145][0146]
其中,α
l
为所述第l组数据的权重;y(l)为所述第l组数据的期望输出项; u(l)为所述第l组输入数据;u
t
(l)为u(l)的转置形式;为第i个粒子的位置向量。
[0147]
步骤8中所述粒子群第i个粒子的速度和位置进化规则采用如下方法计算:
[0148][0149]
[0150]
其中,vi为第i个粒子的速度;ω为粒子的惯性权重;c1和c2为学习因子; r1和r2为[0,1]区间内的随机数;pbesti(j)为第i个粒子在第j轮迭代的历史最优位置;为第i个粒子在第j轮迭代的位置;gbest(j)为第j轮迭代的种群历史最优位置。
[0151]
步骤9:轨迹预测,具体的:
[0152]
根据步骤8所得最优粒子位置作为所述volterra级数预测模型的参数,将所述动态滑动窗口内的数据作为预测模型的输入数据,计算得到机动目标的在 t=tk时刻的单步轨迹预测值
[0153]
步骤10:残差补偿法校正预测值,具体的:
[0154]
根据步骤9所得单步外推预测值计算其与真实值x(k)的偏差,记为δe(k),保存最大长度为所述动态滑动窗口长度w的偏差向量,记为δe;使用递推最小二乘算法,输入项为所述动态滑动窗口内的轨迹坐标数据,期望输出项为所述偏差向量δe,求解下一时刻的预测残差补偿值res(k+1);将所述下一时刻预测残差补偿值res(k+1)与所述预测模型的下一时刻单步预测值相加得到校正后的轨迹预测值,记为残差补偿法如图4所示;
[0155]
其中,步骤10中所述最大长度为动态滑动窗口长度w的偏差向量δe,具体形式如下:
[0156]
δe=[δe(k-w+1),δe(k-w+2),

,δe(k)]
[0157]
其中,w为动态滑动窗口的长度。
[0158]
步骤10中所述校正后的轨迹预测值采用如下方法计算:
[0159][0160]
其中,为校正后的预测值;为volterra预测模型求出的预测值;res(k+1)为t=t
k+1
时刻预测值的残差补偿值。
[0161]
步骤11:重复步骤3至步骤10,直到停止预测机动目标轨迹。
[0162]
通过上述技术方案,本发明针对现有的机动目标轨迹在线预测算法预测精度低、消耗时间久等问题,提出了基于动态滑动窗口辨识的机动目标轨迹在线预测方法。
[0163]
首先,在数据处理上,由于难以获取目标的所有机动方式,仅能通过传感器网络观测获得机动目标的轨迹坐标数据,为了增加数据的可靠性,本发明提出具有权重的动态滑动窗口策略,在线获取实时轨迹数据,同时在每次预测前更新预测模型参数,提高预测精度,实现在线轨迹预测;
[0164]
其次,在模型辨识上,由于标准粒子群算法在辨识预测模型参数时很难得到最优解,并且辨识过程往往无法复现,为了改善模型的辨识效果,本发明提出了空间网格初始化方法,用于首次辨识预测模型的参数,同时在更新模型参数时调用保存的粒子最优位置初始化粒子群,减少辨识时间;
[0165]
最后,在轨迹预测上,由于采用结合动态滑动窗口的在线辨识方法辨识预测模型的参数,长期积累会导致预测误差逐渐增大,为了避免这种情况,本发明提出残差补偿法对每次预测值进行修正,修正后的值作为最终的预测结果,增加轨迹预测精度。
[0166]
本发明通过提出动态滑动窗口的方法,并对窗口内的数据进行赋权值处理,增加
轨迹数据的可靠性,然后使用改进初始化方法的粒子群算法在线辨识 volterra级数预测模型参数,减少计算消耗时间,最后结合残差补偿法对预测值进行校正,提高轨迹预测精度,实现机动目标轨迹的在线精准预测。
[0167]
为验证上述实施方式的正确性及合理性,图5为使用无人机三自由度模型随机生成的一组机动轨迹,采样次数为300,采样间隔为0.2s,利用本发明方法对该飞行轨迹进行在线预测。设置动态滑动窗口的初始长度为20,采用三维坐标独立预测,对后280个轨迹坐标点进行在线单步外推预测。通过改进的c-c法计算本发明算法的延迟时间τ和嵌入维数m,分别得到无人机三自由度机动轨迹 x维度延迟时间τ=5,嵌入维数m=2;y维度延迟时间τ=6,嵌入维数m=2; z维度延迟时间τ=6,嵌入维数m=2。选择volterra级数预测模型的阶数p=2。设置粒子群算法搜索空间均分值q=29,搜索上限搜索下限x=-5,惯性权重ω=0.8,学习因子c1=c2=2。
[0168]
图6为本发明方法对无人机轨迹分别在x、y、z三个维度上的预测偏差,可以看出,本发明方法所得到的机动目标在线预测轨迹与无人机飞行机动轨迹基本吻合,在三个维度上的预测偏差都在零点上下波动,且预测偏差最大都不超过 1m。计算得到本发明方法的平均单步预测所耗时间约为0.043s,对于传感器的采样间隔0.2s,本发明方法满足对实时运动的机动目标进行在线预测的目的。
[0169]
需要进一步说明的是:
[0170]
本发明仿真实验通过无人机三自由度模型来模拟实时轨迹数据的生成,将无人机看作质点,将地面坐标系作为惯性坐标系,则运动模型如下:
[0171][0172]
其中,x
t
,y
t
和z
t
分别表示无人机在惯性坐标系中的水平和高度坐标;v
t
,θ
t
和ψ
t
表示无人机的速度、爬升角和航向角;φ
t
表示滚转角;g为重力加速度; n
xt
和n
zt
分别表示水平过载和纵向过载;[x
t
,y
t
,z
t
,v
t

t

t
]
t
和[n
xt
,n
zt

t
]
t
分别为无人机的状态变量和控制变量。
[0173]
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1