一种制导炮弹滚动角计算方法技术

本发明专利技术提供了一种制导炮弹滚动角计算方法，包括：基于制导炮弹绕质心运动方程组获取滚动角的正弦与余弦表达式；将滚动角的正弦与余弦表达式和制导炮弹的转速作为卡尔曼滤波状态变量，并基于滚动角的正弦与余弦表达式和制导炮弹的转速得到状态转移矩阵，其中，滤波相邻时刻制导炮弹的转速相同；基于卡尔曼滤波状态变量和状态转移矩阵构建卡尔曼滤波状态方程；将微惯导系统三个轴向的陀螺角速率作为卡尔曼滤波观测变量；基于卡尔曼滤波观测变量构建卡尔曼滤波观测方程；基于卡尔曼滤波状态方程和观测方程进行卡尔曼滤波，得到估计后的滚动角。本发明专利技术能够解决现有技术中制导炮弹滚动角的计算精度较低的技术问题。动角的计算精度较低的技术问题。动角的计算精度较低的技术问题。

【技术实现步骤摘要】
一种制导炮弹滚动角计算方法


[0001]本专利技术涉及滚动角计算
，尤其涉及一种制导炮弹滚动角计算方法。

技术介绍

[0002]传统的炮射弹药通过自由落体去攻击目标，命中率低，弹药消耗量大，且射程较近，作战效费比不高，已经难以适应现代战争的需要。制导炮弹的出现使得炮兵技术的发展产生了革命性的变化。相对于传统的常规弹药，制导炮弹具有打击精确化、作战远程化等众多优点，与导弹攻击方式相比，制导炮弹又具有载弹量大、发射速度快、成本低、用途广泛、使用方式更为灵活等优势。随着武器装备的信息化与精确化，制导炮弹将在未来高技术条件下的战争中发挥非常重要的作用，兵器弹药制导化已成为一个重要的发展趋势。
[0003]制导炮弹通过弹载制导控制系统实现敌方目标的精确打击，弹体位置、速度、姿态等运动参数的准确获取是弹载控制系统实现精确控制的前提。制导弹药通常在发射后空中通电，位置、速度信息可以通过卫星定位系统获得，航向角和俯仰角也可以通过卫星速度信息计算得到，而滚动角只能通过微惯导系统计算得到。因此，如何利用微惯导系统测量信息准确获得弹体的滚动角，对于提高打击精度具有非常重要意义。
[0004]传统的微惯导系统滚动角计算方法主要依赖三个轴向加速度计敏感到的重力信息计算获取，由于制导炮弹发射后空中通电，弹体处于失重状态，加速度计测量得到的均为有害加速度，传统方法难以适用。美国霍尼韦尔试验室采用锁相环方法，利用弹体在空中高速旋转时，Y轴、Z轴陀螺上敏感到的正弦信号，采用锁相环(PLL)及相关运算的原理，解调出该信号的相位，实现滚动角的计算。但是，该方法抗扰动能力差，当弹体转速波动较大时，计算精度会明显下降。

技术实现思路

[0005]本专利技术提供了一种制导炮弹滚动角计算方法，能够解决现有技术中制导炮弹滚动角的计算精度较低的技术问题。
[0006]根据本专利技术的一方面，提供了一种制导炮弹滚动角计算方法，所述方法包括：
[0007]基于制导炮弹绕质心运动方程组获取滚动角的正弦与余弦表达式；
[0008]将滚动角的正弦与余弦表达式和制导炮弹的转速作为卡尔曼滤波状态变量，并基于滚动角的正弦与余弦表达式和制导炮弹的转速得到状态转移矩阵，其中，滤波相邻时刻制导炮弹的转速相同；
[0009]基于卡尔曼滤波状态变量和状态转移矩阵构建卡尔曼滤波状态方程；
[0010]将微惯导系统三个轴向的陀螺角速率作为卡尔曼滤波观测变量；
[0011]基于卡尔曼滤波观测变量构建卡尔曼滤波观测方程；
[0012]基于卡尔曼滤波状态方程和观测方程进行卡尔曼滤波，得到估计后的滚动角。
[0013]优选的，通过下式获取滚动角的正弦与余弦表达式：
[0014][0015]式中，γ为微惯导系统的滚动角，为微惯导系统的航向角，θ为微惯导系统的俯仰角，为微惯导系统的Y轴陀螺角速率，为微惯导系统的Z轴陀螺角速率，t为时间。
[0016]优选的，通过下式得到卡尔曼滤波状态变量：
[0017]X(t)＝[p(t) cos(γ(t)) sin(γ(t))]T
；
[0018]式中，X(t)为t时刻的卡尔曼滤波状态变量，p(t)为t时刻制导炮弹的转速，γ(t)为t时刻微惯导系统的滚动角。
[0019]优选的，通过下式得到状态转移矩阵：
[0020][0021]其中，p(t+1)＝p(t)；
[0022]式中，F(t)为t时刻状态变量对应的连续状态方程状态转移矩阵，Δt为t时刻至t+1时刻的时间差，p(t)为t时刻制导炮弹的转速，p(t+1)为t+1时刻制导炮弹的转速。
[0023]优选的，通过下式构建卡尔曼滤波状态方程：
[0024]X(t+1)＝F(t)
·
X(t)+w(t)；
[0025]式中，X(t+1)为t+1时刻的卡尔曼滤波状态变量，X(t)为t时刻的卡尔曼滤波状态变量，F(t)为t时刻状态变量对应的连续状态方程状态转移矩阵，w(t)为t时刻系统随机噪声向量。
[0026]优选的，通过下式得到卡尔曼滤波观测变量：
[0027][0028]式中，Z(t)为t时刻的卡尔曼滤波观测变量，为微惯导系统的X轴陀螺角速率，为微惯导系统的Y轴陀螺角速率，为微惯导系统的Z轴陀螺角速率。
[0029]优选的，通过下式构建卡尔曼滤波观测方程：
[0030]Z(t)＝H(t)X(t)+V(t)；
[0031]其中，
[0032]式中，Z(t)为t时刻的卡尔曼滤波观测变量，H(t)为t时刻的观测矩阵，X(t)为t时刻的卡尔曼滤波状态变量，V(t)为t时刻的观测量噪声，为微惯导系统的航向角，θ为微惯导系统的俯仰角，t为时间。
[0033]优选的，通过下式得到估计后的滚动角：
[0034][0035]式中，为估计后的滚动角，分别为卡尔曼滤波估计结果的第二、第三个元素。
[0036]根据本专利技术的又一方面，提供了一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现上述任一所述方法。
[0037]应用本专利技术的技术方案，根据制导炮弹外弹道运动特性得到制导炮弹绕质心运动方程组，利用微惯导系统三个轴向的陀螺角速率信息、滚动角和转速，构建合适的观测变量和观测变量，通过卡尔曼滤波实现了制导炮弹失重条件下滚动角的高精度快速计算，对于发射后空中通电的制导炮弹(其弹载控制系统在起控前弹体处于失重状态)，具有非常重要的意义。本专利技术既适用于制导炮弹高速旋转的情况，也适用于制导炮弹不旋转的情况，且具有对制导炮弹的运动轨迹没有任何约束，不依赖重力信息，便于工程实现的优点。
附图说明
[0038]所包括的附图用来提供对本专利技术实施例的进一步的理解，其构成了说明书的一部分，用于例示本专利技术的实施例，并与文字描述一起来阐释本专利技术的原理。显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0039]图1示出了根据本专利技术的一种实施例提供的制导炮弹滚动角计算方法的流程图。
具体实施方式
[0040]需要说明的是，在不冲突的情况下，本申请中的实施例及实施例中的特征可以相互组合。下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的，决不作为对本专利技术及其应用或使用的任何限制。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0041]需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根
据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种制导炮弹滚动角计算方法，其特征在于，所述方法包括：基于制导炮弹绕质心运动方程组获取滚动角的正弦与余弦表达式；将滚动角的正弦与余弦表达式和制导炮弹的转速作为卡尔曼滤波状态变量，并基于滚动角的正弦与余弦表达式和制导炮弹的转速得到状态转移矩阵，其中，滤波相邻时刻制导炮弹的转速相同；基于卡尔曼滤波状态变量和状态转移矩阵构建卡尔曼滤波状态方程；将微惯导系统三个轴向的陀螺角速率作为卡尔曼滤波观测变量；基于卡尔曼滤波观测变量构建卡尔曼滤波观测方程；基于卡尔曼滤波状态方程和观测方程进行卡尔曼滤波，得到估计后的滚动角。2.根据权利要求1所述的方法，其特征在于，通过下式获取滚动角的正弦与余弦表达式：式中，γ为微惯导系统的滚动角，为微惯导系统的航向角，θ为微惯导系统的俯仰角，为微惯导系统的Y轴陀螺角速率，为微惯导系统的Z轴陀螺角速率，t为时间。3.根据权利要求1或2所述的方法，其特征在于，通过下式得到卡尔曼滤波状态变量：X(t)＝[p(t) cos(γ(t)) sin(γ(t))]
T
；式中，X(t)为t时刻的卡尔曼滤波状态变量，p(t)为t时刻制导炮弹的转速，γ(t)为t时刻微惯导系统的滚动角。4.根据权利要求1所述的方法，其特征在于，通过下式得到状态转移矩阵：其中，p(t+1)＝p(t)；式中，F(t)为t时刻状态变量对应的连续状态方程状态转移矩阵，Δt为t时刻至t+1时刻的时间差，p(t)为t时刻制导炮弹的转速，...

【专利技术属性】
技术研发人员：邓继权，郭玉胜，邹思远，尚克军，闫红松，杨研蒙，王琦，刘冲，周亚男，
申请(专利权)人：北京自动化控制设备研究所，
类型：发明
国别省市：