一种制导炮弹的空中轨迹预测方法技术

一种制导炮弹的空中轨迹预测方法，制导炮弹在信号捕捉阶段的每一时刻接收卫星导航系统输出的三个速度信息，利用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数。在后续每一时刻，判断卫星导航系统是否失锁，如果不失锁，将卫星导航系统给出的三个速度信息作为观测量进行组合导航，同时计算每个速度信息与时间的拟合曲线系数；如果失锁，判断失锁次数是否大于轨迹预测限制次数，大于进入纯惯性导航计算；不大于则利用拟合曲线系数预测出当前时刻制导炮弹的三个速度信息，并将之作为观测量进行组合导航。本方法简单、计算时间短，实现了制导炮弹的空中飞行轨迹预测，大大提高了制导炮弹的落点精度和卫星导航系统的抗干扰性。

【技术实现步骤摘要】
一种制导炮弹的空中轨迹预测方法
本专利技术涉及组合导航系统
，特别涉及一种制导炮弹的空中轨迹预测方法，用于无人机、自旋制导炮弹等需要在卫星导航系统空中失锁情况下的组合导航场合。
技术介绍
制导炮弹是一种在空中发射，需要进行自我导航与控制的一种高精度武器，它包含了惯性导航和GPS等系统。惯性导航系统是一个基于加速度二次积分的航程推算系统，它完全依靠机械设备和相应的算法自动、独立完成导航任务，和外界不发生任何光、电联系。由于其具有隐蔽性好、工作环境不受气象条件限制等优点，成为航天、航空、航海领域中一种广泛使用的主要导航系统。制导炮弹在发射后一般处于高速自旋状态，故需要采用大量程低精度的MEMS惯性导航系统，且发射后，制导炮弹处于失重情况下，两个横向加表主要采集得到的是由于振动和离心产生的加速度信息，在此情况下，如果没有GPS信息进行组合导航，惯性导航系统会发散的比较快,数据可靠性度不高。GPS导航系统导航精度高，且不随时间发散，完全依赖于GPS卫星发射的导航信息，受制于他人，且易受人为干扰和电子欺骗。因此，目前采用的方法是利用GPS(卫星导航系统)和惯性导航系统进行组合导航，实现通过GPS来修正惯性导航系统的误差，达到精确打击目标的能力。但这种常规组合导航存在一个严重的问题，即GPS频带窄，当运载体作较高机动运动时，接收机极易失锁而丢失信号，从而完全丧失导航能力，而纯惯性导航系统又不能满足独立作为制导炮弹导航系统的要求。目前，还没有可靠的方法来处理GPS失锁后制导炮弹的导航问题，只能通过提高MEMS惯性导航系统的精度来保证，这种方法使得制导炮弹增加了成本，而且由于受大量程的限制，MEMS惯性导航系统的精度提高有限。
技术实现思路
本专利技术解决的技术问题是：克服现有技术的不足，提供一种制导炮弹的空中轨迹预测方法，在GPS失锁后能够对制导炮弹的空中轨迹进行预测，无需提高惯性导航系统的精度，解决了GPS失锁后制导炮弹的导航问题，大大提高了制导炮弹的导航精度和落点精度。本专利技术的技术方案是：一种制导炮弹的空中轨迹预测方法，包括如下步骤：(1)发射后的制导炮弹在Tk时刻接收卫星导航系统输出的信号，其中Tk为卫星导航系统第k次输出信号的时间，k＝1,2,3,……,M，k>1时，Tk＝T1+(k-1)ΔT，ΔT为卫星导航系统的信号输出周期，M为预先设定的制导炮弹接收卫星导航系统信号的限定次数，TM为预先设定的制导炮弹信号捕捉阶段的终点时刻，所述Tk时刻卫星导航系统输出的信号为Tk时刻制导炮弹的三个速度信息；(2)根据T1～TM时刻制导炮弹接收的信号，采用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数；(3)判断制导炮弹在TM+1时刻是否接收到卫星导航系统输出的信号，如果没有，则判定卫星导航系统失锁，进入步骤(4)，否则卫星导航系统未失锁，进入步骤(5)；(4)失锁次数Lost_Times的值加1，如果失锁次数Lost_Times小于预先设定的轨迹预测限制次数Limit_Times，则根据制导炮弹三个速度信息与时间的拟合曲线系数预测出TM+1时制导炮弹的三个速度信息，并将其作为观测量进行组合导航，否则进行纯惯性导航，进入步骤(6)；(5)失锁次数Lost_Times清零，根据TM+1时刻卫星导航系统输出的三个速度信息以及T1～TM时刻制导炮弹的三个速度信息，采用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数，同时将此时卫星导航系统输出的三个速度信息作为观测量，进行组合导航，进入步骤(6)；(6)M的值加1，进入步骤(3)，从而在信号捕捉阶段之后的每一时刻预测制导炮弹的空中轨迹，引导制导炮弹命中目标。步骤(2)的实现方式如下：(2.1)确定第i个速度信息时间拟合曲线的维数Ni，对第i个速度信息的一步预测均方差Pk,i、状态估计矩阵Xk,i和加权系数W进行初始化，得到初始一步预测均方差P0,i和状态估计矩阵X0,i，其中P0,i和X0,i的选取是任意的，加权系数W取大于等于1的实数，i＝1,2,3；(2.2)卫星导航系统在Tk时刻输出的三个速度信息分别为东向速度Ve、北向速度Vn和天向速度Vu，将第i个速度信息作为Tk时刻第i个速度信息的观测值Zk,i，其中k>1，Zk,1＝Ve；Zk,2＝Vn；Zk,3＝Vu；Tk＝T1+(k-1)ΔT；Tk-1＝T1+(k-2)ΔT；(2.3)根据拟合曲线维数确定Tk时刻第i个速度信息的观测阵：(2.4)计算Tk时刻第i个速度信息的一步预测均方差：其中，Pk-1,i表示Tk-1时刻第i个速度信息的一步预测均方差；(2.5)计算Tk时刻第i个速度信息的状态估计矩阵，该状态估计矩阵即为Tk时刻制导炮弹第i个速度信息与时间的拟合曲线系数：其中，Xk-1,i表示Tk-1时刻第i个速度信息的状态估计矩阵，Xk,i表示Tk时刻第i个速度信息的状态估计矩阵。所述步骤(4)中，根据制导炮弹三个速度信息与时间的拟合曲线系数预测出TM+1时制导炮弹的三个速度信息的实现方式如下：VM+1,i＝HM+1,iXM,i其中HM+1,i表示TM+1时刻第i个速度信息的观测阵，XM,i表示TM时刻第i个速度信息的状态估计矩阵，VM+1,i表示在TM+1时刻预测得到的第i个速度信息，i＝1,2,3。本专利技术与现有技术相比的优点如下：(1)、本专利技术设定一段信号捕捉阶段，根据该时间段制导炮弹接收的GPS信息，采用加权递推最小二乘法计算制导炮弹每个速度信息与时间的拟合曲线系数，在信号捕捉阶段之后的某一时刻，如果GPS失锁，则根据拟合曲线系数预测该时刻的速度，从而在信号捕捉阶段之后的每一时刻预测制导炮弹的空中轨迹。相对于现有技术中提高MEMS惯性导航系统精度而言，本专利技术不仅降低了成本以及惯性导航系统的设计难度，而且避免了GPS在失锁或者干扰情况下的无数据输出，因此得到的导航信息更精确，提高了导航的可靠性。(2)、本专利技术通过加权递推最小二乘算法拟合曲线的方法计算制导炮弹每个速度信息与时间的拟合曲线系数，可以减少保存的数据量，减轻弹上计算机工作量，同时减少了计算时间，通过加权的方式根据该拟合曲线系数对失锁后制导炮弹的轨迹进行预测，提高了后续数据的信任度和速度预测的精确度。(3)、本专利技术通过在GPS丢帧情况下采用预测数据取代GPS输出数据的方法，有效地将通过拟合得到的数据放入到滤波算法中，不仅能保持速度的精度，而且能保持姿态的精度，有效保证了导航的可靠性。(4)、本专利技术轨迹预测的方法简单、计算时间短，适用于失重和高速旋转环境，实现了空中飞行轨迹预测，提高了卫星导航系统的抗干扰性。附图说明图1为本专利技术方法流程图；图2为东向速度信息示意图，其中(a)中虚线为真实飞行时的东向速度信息曲线，实线为利用本专利技术方法预测得到的东向速度信息曲线，(b)为利用本专利技术方法预测得到的东向速度拟合误差信息曲线；图3为北向速度信息示意图，其中(a)中虚线为真实飞行时的北向速度信息曲线，实线为利用本专利技术方法预测得到的北向速度信息曲线，(b)为利用本专利技术方法预测得到的北向速度拟合误差信息曲线；图4为天向速度信息示意图，其中(a)中虚线为真实飞行时的天向速度信息曲线，实线为利用本专利技术方法预测得到的天向速度本文档来自技高网...

【技术保护点】
一种制导炮弹的空中轨迹预测方法，其特征在于包括如下步骤：(1)发射后的制导炮弹在Tk时刻接收卫星导航系统输出的信号，其中Tk为卫星导航系统第k次输出信号的时间，k＝1,2,3,……,M，k>1时，Tk＝T1+(k‑1)ΔT，ΔT为卫星导航系统的信号输出周期，M为预先设定的制导炮弹接收卫星导航系统信号的限定次数，TM为预先设定的制导炮弹信号捕捉阶段的终点时刻，所述Tk时刻卫星导航系统输出的信号为Tk时刻制导炮弹的三个速度信息；(2)根据T1～TM时刻制导炮弹接收的信号，采用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数；(3)判断制导炮弹在TM+1时刻是否接收到卫星导航系统输出的信号，如果没有，则判定卫星导航系统失锁，进入步骤(4)，否则卫星导航系统未失锁，进入步骤(5)；(4)失锁次数Lost_Times的值加1，如果失锁次数Lost_Times小于预先设定的轨迹预测限制次数Limit_Times，则根据制导炮弹三个速度信息与时间的拟合曲线系数预测出TM+1时制导炮弹的三个速度信息，并将其作为观测量进行组合导航，否则进行纯惯性导航，进入步骤(6)；(5)失锁次数Lost_Times清零，根据TM+1时刻卫星导航系统输出的三个速度信息以及T1～TM时刻制导炮弹的三个速度信息，采用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数，同时将此时卫星导航系统输出的三个速度信息作为观测量，进行组合导航，进入步骤(6)；(6)M的值加1，进入步骤(3)，从而在信号捕捉阶段之后的每一时刻预测制导炮弹的空中轨迹，引导制导炮弹命中目标。...

【技术特征摘要】
1.一种制导炮弹的空中轨迹预测方法，其特征在于包括如下步骤：(1)发射后的制导炮弹在Tk时刻接收卫星导航系统输出的信号，其中Tk为卫星导航系统第k次输出信号的时间，k＝1,2,3,……,M，k>1时，Tk＝T1+(k-1)ΔT，ΔT为卫星导航系统的信号输出周期，M为预先设定的制导炮弹接收卫星导航系统信号的限定次数，TM为预先设定的制导炮弹信号捕捉阶段的终点时刻，所述Tk时刻卫星导航系统输出的信号为Tk时刻制导炮弹的三个速度信息，即东向速度、北向速度和天向速度；(2)根据T1～TM时刻制导炮弹接收的信号，采用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数；(3)判断制导炮弹在TM+1时刻是否接收到卫星导航系统输出的信号，如果没有，则判定卫星导航系统失锁，进入步骤(4)，否则卫星导航系统未失锁，进入步骤(5)；(4)失锁次数Lost_Times的值加1，如果失锁次数Lost_Times小于预先设定的轨迹预测限制次数Limit_Times，则根据制导炮弹三个速度信息与时间的拟合曲线系数预测出TM+1时制导炮弹的三个速度信息，并将其作为观测量进行组合导航，否则进行纯惯性导航，进入步骤(6)；(5)失锁次数Lost_Times清零，根据TM+1时刻卫星导航系统输出的三个速度信息以及T1～TM时刻制导炮弹的三个速度信息，采用递推最小二乘算法计算制导炮弹每个速度信息与时间的拟合曲线系数，同时将此时卫星导航系统输出的三个速度信息作为观测量，进行组合导航，进入步骤(6)；(6)M的值加1，进入步骤(3)，从而在信号捕捉阶段之后的每一时刻预测制导炮弹的空中轨迹，引导制导炮弹命中目标。2.根据权利要求1所述的一种制导炮弹的空中轨迹预测方法，其特征在于：步骤(2)的实现方式如下：(2.1)确定第i个速度信息时间拟合曲线的维数Ni，对第i个速度信息的一步预测均方差Pk,i、状态估计矩阵Xk...

【专利技术属性】
技术研发人员：赵龙，常新，郭琳，郭涛，范玉宝，王盛，纪文涛，段宇鹏，
申请(专利权)人：北京航天控制仪器研究所，
类型：发明
国别省市：北京;11