CN116429095A - 一种基于主子惯导结合的行进间炮口振动测量方法 - Google Patents
一种基于主子惯导结合的行进间炮口振动测量方法 Download PDFInfo
- Publication number
- CN116429095A CN116429095A CN202211568434.2A CN202211568434A CN116429095A CN 116429095 A CN116429095 A CN 116429095A CN 202211568434 A CN202211568434 A CN 202211568434A CN 116429095 A CN116429095 A CN 116429095A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- sub
- navigation
- main
- coordinate system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 238000009434 installation Methods 0.000 claims abstract description 39
- 238000005259 measurement Methods 0.000 claims abstract description 38
- 230000000694 effects Effects 0.000 claims abstract description 19
- 238000012546 transfer Methods 0.000 claims abstract description 14
- 230000005540 biological transmission Effects 0.000 claims abstract description 13
- 238000004364 calculation method Methods 0.000 claims abstract description 12
- 239000011159 matrix material Substances 0.000 claims description 49
- 230000001133 acceleration Effects 0.000 claims description 34
- 230000033001 locomotion Effects 0.000 claims description 17
- 230000003068 static effect Effects 0.000 claims description 14
- 230000005484 gravity Effects 0.000 claims description 13
- 238000001914 filtration Methods 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 10
- 230000014509 gene expression Effects 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 230000005489 elastic deformation Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 238000010606 normalization Methods 0.000 claims description 3
- 230000035945 sensitivity Effects 0.000 claims description 3
- 230000002087 whitening effect Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 2
- 238000011160 research Methods 0.000 description 6
- 230000004069 differentiation Effects 0.000 description 4
- 238000004164 analytical calibration Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01H—MEASUREMENT OF MECHANICAL VIBRATIONS OR ULTRASONIC, SONIC OR INFRASONIC WAVES
- G01H17/00—Measuring mechanical vibrations or ultrasonic, sonic or infrasonic waves, not provided for in the preceding groups
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Operations Research (AREA)
- Computing Systems (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于主子惯导结合的行进间炮口振动测量方法,该方法为:在炮塔上安装抗高过载高精度惯导,在身管的炮口处安装低精度的MEMS惯导;在初始阶段,炮塔处的高精度主惯导与炮口处的MEMS子惯导完成传递对准;在传递对准阶段,根据火炮身管特性进行外杆臂误差与挠曲形变的动态建模,对杆臂效应及挠曲形变进行补偿;建立以速度加姿态匹配方式的传递对准卡尔曼滤波器;在导航更新阶段,子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,进行导航状态更新,完成炮口的振动测量。本发明具有安装简便、稳定性高、抗干扰能力强、准确性高的优点。
Description
技术领域
本发明涉及炮口振动测量技术领域,特别是一种基于主子惯导结合的行进间炮口振动测量方法。
背景技术
火炮行进作业时,身管炮口处的振动会影响火炮的射击精度,炮口振动测量研究是如今一个难题。炮口振动研究最早开展于国外,komnkov建立的数学方程表述了身管振动与射击精度之间的关系,证明身管振动是影响射击精度的主要因素之一;苏联火炮设计专家奥尔洛夫与马利科夫等人在1982年给出了估算身管固有频率的计算方法。国内于会杰、王德石等人将身管简化成梁类的结构模型,在此基础上利用梁的振动理论,研究身管振动响应;徐达等人采用线激光散斑场光电检测方法,研究了身管振动信号与输出电流数学关系,提出了一种基于身管表面线激光散斑效应的炮口振动测量的方法,实现炮口振幅测量。
在多数研究中,以位移量变化参数开展研究多采用非接触式测量,不足之处即是非接触式测量仪器安装不方便,采样数据较为困难,仪器校准也较为麻烦。
发明内容
本发明的目的在于提出一种安装简便、稳定性高、抗干扰能力强、准确性高的基于主子惯导结合的行进间炮口振动测量方法。
实现本发明目的的技术解决方案为:一种基于主子惯导结合的行进间炮口振动测量方法,包括以下步骤:
步骤1、根据火炮平台,设计主、子惯导安装位置,包括主惯导和MEMS子惯导;
步骤2、根据火炮行进间主惯导、MEMS子惯导传感器输出,设计基于陀螺仪角增量更新的姿态更新算法;
步骤3、在传递对准阶段,根据火炮身管特性进行外杆臂误差与挠曲形变的动态建模,对杆臂效应及挠曲形变进行补偿;
步骤4、将MEMS子惯导解算出的速度、姿态,相对于主惯导解算出的速度、姿态偏差量作为MEMS子惯导的量测信息,建立以速度加姿态匹配方式的传递对准卡尔曼滤波器;
步骤5、在导航更新阶段,MEMS子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,进行导航状态更新,完成炮口的振动测量。
本发明与现有技术相比,其显著优点为:(1)在炮塔处安装高精度主惯导,在身管炮口处安装MEMS子惯导的接触式测量方式,相对传统光学等非接触式测量方式,安装方便、稳定性高,避免了传统光学方式的易受干扰、安装困难、仪器校准繁琐等缺点;(2)在初始对准阶段,采用高精度主惯导对MEMS子惯导进行传递对准,属于惯导精对准范畴,可以保证MEMS子惯导有准确的初始惯导信息,提高了炮口振动测量的可靠性和准确性;(3)在导航更新阶段,子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,利用姿态更新算法不断迭代解算,可以保证MEMS子惯导的位姿输出准确性,提高了炮口振动测量方法的实时性和可靠性。
附图说明
图1是本发明主子惯导安装的结构示意图。
图2是本发明基于主子惯导结合的行进间炮口振动测量方法的流程图。
图3是本发明中主子惯导杆臂的原理示意图。
图4是本发明中Kalman滤波的流程示意图。
图5是本发明中Kalman滤波计算回路与增益计算回路的流程示意图。
具体实施方式
本发明一种基于主子惯导结合的行进间炮口振动测量方法,包括以下步骤:
步骤1、根据火炮平台,设计主、子惯导安装位置,包括主惯导和MEMS子惯导;
步骤2、根据火炮行进间主惯导、MEMS子惯导传感器输出,设计基于陀螺仪角增量更新的姿态更新算法;
步骤3、在传递对准阶段,根据火炮身管特性进行外杆臂误差与挠曲形变的动态建模,对杆臂效应及挠曲形变进行补偿;
步骤4、将MEMS子惯导解算出的速度、姿态,相对于主惯导解算出的速度、姿态偏差量作为MEMS子惯导的量测信息,建立以速度加姿态匹配方式的传递对准卡尔曼滤波器;
步骤5、在导航更新阶段,MEMS子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,进行导航状态更新,完成炮口的振动测量。
进一步地,步骤1中,根据火炮平台,设计主、子惯导安装位置,包括主惯导和MEMS子惯导,具体如下:
所述主惯导固连于炮塔,保持水平状态,炮塔进行航向运动带动主惯导一同运动;
所述MEMS子惯导固连于火炮身管前端,用于测量火炮身管前端炮口的位姿。
进一步地,步骤2中根据火炮行进间主惯导、MEMS子惯导传感器输出,设计基于陀螺仪角增量更新的姿态更新算法,具体如下:
步骤2.2、设置初始零点,利用四元数以及陀螺仪的角增量,对惯导载体的姿态进行更新。
进一步地,所述步骤2.1具体如下:
步骤2.1.1、利用加速度三轴分量估算俯仰角θ和滚转角γ:
其中,θk、γk分别表示第k次解算出的俯仰角、滚转角;
步骤2.1.3、在静止条件下,利用三个欧拉角获得从载体坐标系到导航坐标系的方向余弦矩阵,完成惯导的初始对准。
进一步地,所述步骤2.2,具体如下:
步骤2.2.1、由陀螺仪的更新数据计算得到角增量Δ:
式中,ωx、ωy、ωz表示仪输出的三轴角速度标量值,Tm为采样时间;
步骤2.2.2、利用角增量对四元数进行更新:
式中,q1|k+1、q2|k+1、q3|k+1、q4|k+1分别为k+1时刻四元数的q1、q2、q3、q4值,q1|k、q2|k、q3|k、q4|k分别为k时刻四元数的q1、q2、q3、q4值;
步骤2.2.3、四元数进行归一化处理:
其中,q1'|k+1、q'2|k+1、q'3|k+1、q'4|k+1分别为q1|k+1、q2|k+1、q3|k+1、q4|k+1归一化处理后的值;进行归一化使得四元数变为单位四元数,四个值的平方和为1;
步骤2.2.4、根据单位四元数得到方向余弦矩阵,公式为:
步骤2.2.5、根据方向余弦矩阵得到欧拉角如下:
步骤2.2.6、根据方向余弦矩阵信息和比力信息,得到当前加速度三轴的分量,区分三轴分量能够对重力分量进行补偿,除去重力分量获得导航坐标系下的运动加速度,对运动加速度进行牛顿力学积分得到速度和位置,公式为:
进一步地,步骤3中的外杆臂误差补偿,具体如下:
定义惯性坐标系为Oixiyizi,载体坐标系为Obxbybzb,Ob是载体的摇摆中心,子惯导的加速度计安装在载体坐标系中的固定点p,为载体坐标系原点的位置矢量,为p点相对于惯性坐标系原点的位置矢量,为p点相对于载体坐标系原点的位置矢量,则p点相对于惯性坐标系的线加速度表达式为:
上式后面两项就是由于杆臂效应引起的惯导敏感到的杆臂加速度基本表达式;
进一步地,步骤3中所述的挠曲变形的动态建模,具体如下:
动态变形角速率运动方程:
进一步地,步骤4中的MEMS子惯导解算出的速度、姿态,相对于主惯导解算出的速度、姿态偏差量,具体如下:
主、子惯导的速度差微分方程为:
式中,表示主子惯导的速度差,为子惯导系统的姿态矩阵,φ×表示主、子惯导的初始安装误差角对应的反对称矩阵,ξ表示主、子惯导的安装误差角估计值;表示主惯导在子惯导坐标系下感受到的比力;表示地球在导航坐标系下的自转角速率;表示子惯导加速度计误差;
姿态量测方程为:
式中,φ表示主、子惯导解算的姿态偏差量;Zφ表示主、子惯导去掉静态变形角与动态变形角影响的姿态差;μ表示静态变形角,包括安装误差;θ表示动态变形角,即挠曲变形。
进一步地,步骤4中所述的速度加姿态匹配方式的卡尔曼滤波模型,具体如下:
(1)状态一步预测
(2)状态一步预测均方误差阵
其中,Pk|k-1为状态一步预测均方误差阵;Pk-1为k-1时刻状态最优估计的均方误差阵;(3)滤波增益
(4)状态估计
(5)状态估计均方误差阵
Pk=(I-KkHk)Pk|k-1 (21)。
进一步地,所述步骤5具体如下:
传递对准结束后,子惯导从状态估计量中获取当前陀螺仪的零漂及加速度计的零偏,以及主、子惯导的失准角;子惯导利用获取的三个欧拉角得到从载体坐标系到导航坐标系的方向余弦矩阵,结合步骤2中的姿态更新算法,实现子惯导的实时位置姿态测量;
由于子惯导与炮口固连,所以子惯导的实时位置姿态信息即为炮口的实时振动情况。
下面结合附图和具体实施例,对本发明做进一步的详细说明。
实施例
结合图1,本发明一种基于主子惯导结合的行进间炮口振动测量方法,包括以下步骤:
步骤1、根据火炮平台,设计主、子惯导安装位置,包括高精度主惯导1和MEMS子惯导2;
步骤2、根据火炮行进间主、子惯导传感器输出,设计基于陀螺仪角增量更新的姿态更新算法;
步骤3、在传递对准阶段,根据火炮身管特性进行外杆臂误差与挠曲形变的动态建模,对杆臂效应及挠曲形变进行补偿;
步骤4、将MEMS子惯导解算出的速度、姿态相对于高精度主惯导解算出的速度、姿态偏差量作为子惯导的量测信息,建立以速度加姿态匹配方式的传递对准卡尔曼滤波器;
步骤5、在导航更新阶段,子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,进行导航状态更新,完成炮口的振动测量。
进一步地,步骤1所述的根据火炮平台,设计主、子惯导安装位置,包括高精度主惯导1和MEMS子惯导2,具体如下:
所述高精度抗高过载惯导1固连于炮塔4,保持水平状态,炮塔4进行航向运动带动高精度抗高过载惯导1一同运动;
所述MEMS子惯导2固连于火炮身管3前端,用于测量火炮身管3前端炮口的位姿。
进一步地,步骤2所述的根据火炮行进间主、子惯导传感器输出,设计基于陀螺仪角增量更新的姿态更新算法,具体如下:
在不同的导航系统中,对坐标系的选取也各不相同,特别是对导航坐标系选取。默认OXnYnZn作为导航坐标系。
(1)地理坐标系
地理坐标系,原点位于载体质心,其中一个坐标轴沿当地地理垂线的方向,另外两轴在当地水平面内分别沿当地经线和纬线的切线方向。选取东北天(ENU)地理坐标系,即:x轴指向东,y轴指向北,z轴垂直于当地水平面,沿当地垂线向上。
(2)载体坐标系
载体坐标系Oxbybzb,(原)点与载体质心重合。xb沿载体横轴向右,yb沿载体纵轴向前,zb沿载体竖轴向上,又称“右前上”坐标系。
(3)导航坐标系
由于涉及多个坐标系系统,需要将多种坐标系转换到同一坐标系进行求解,用Oxnynzn表示。
(4)主惯导坐标系
主惯导坐标系选取与载体坐标系一致,用Oxmymzm表示。
(5)子惯导坐标系
子惯导坐标系用Oxsyszs表示,惯导安装在炮口位置。
步骤2.1.1、利用加速度三轴分量估算俯仰角θ和滚转角γ:
计算得到偏航角为:
步骤2.1.3、在静止条件下,三个欧拉角可以获得从载体坐标系到导航坐标系的方向余弦矩阵,完成惯导的初始对准。
步骤2.2所述的设置初始零点,利用四元数以及陀螺仪的角增量,对惯导载体的姿态进行更新;
步骤2.2.1、由陀螺仪的更新数据计算得到角增量Δ:
ωx、ωy、ωz表示仪输出的三轴角速度标量值,Tm为采样时间;
步骤2.2.2、利用角增量对四元数进行更新:
式中,q1|k+1为k+1时刻四元数的q1值,q1|k为k时刻四元数的q1值,其他同理;步骤2.2.3、四元数进行归一化处理:
进行归一化使得四元数变为单位四元数,四个值的平方和为1;
步骤2.2.4、根据单位四元数得到方向余弦矩阵,公式为:
步骤2.2.5、根据方向余弦矩阵得到欧拉角如下:
步骤2.2.6、根据上述矩阵信息再加上比力信息可以得到当前加速度三轴的分量,区分三轴分量可以对重力分量进行补偿,除去重力分量可以获得导航坐标系下的运动加速度,对运动加速度进行牛顿力学积分可以得到速度和位置,公式为:
至此,可以获得炮塔、炮口的瞬时姿态、速度以及位置信息。
进一步地,步骤3所述的在传递对准阶段,根据火炮身管特性进行外杆臂误差与挠曲形变的动态建模,对杆臂效应及挠曲形变进行补偿,具体如下:
由于主、子惯导的安装位置不同,其各自敏感的信息存在一定的差别。为提高传递对准的性能,在进行信息匹配时,需要采取一定的措施对杆臂效应、挠曲变形等引起的误差进行补偿,尽可能真实的反映各个误差状态同观测量之间的关系。在杆臂效应中,外杆臂误差远远大于内杆臂误差影响,所以现忽略内杆臂误差,仅对外杆臂误差进行。
(1)外杆臂误差补偿
在实际的运用中,认为主、子惯导可能均未安装在载体的摇摆中心,甚至距摇摆中心有较长的距离,因此主、子惯导的加速度计敏感的加速度不同。由杆臂引起的误差在传递匹配过程中需要实时补偿。
如图3所示,定义惯性坐标系为Oixiyizi,载体坐标系为Obxbybzb,并认为Ob是载体的摇摆中心,在多数的研究中被认为是载体的重心,一般根据设计的载荷分布情况,求出重心位置,并且认为重心是固定的,且常假设主惯导安装位置与Ob重合,子惯导的加速度计安装在载体坐标系中的固定点p。
显然它们有如下关系:
将上式两边对时间求微分可以得到:
再对上式求相对时间的微分可以得到:
根据矢量微分的相对微分原理,可以得到:
同理可以得到:
将上式组合可以得到p点相对于惯性坐标系的线加速度表达式:
在研究杆臂效应时一般认为载体是刚性结构,当存在挠性变形时需要采用其它的方法对挠性变形造成的误差加以补偿,设定p点相对于载体坐标系是固定的,所以:
线加速度表达式可以进一步简化为:
理想情况下安装点应该在载体的摇摆中心,即rp=0,这样就不存在杆臂效应。根据实际情况,在传递匹配过程中主、子惯导均未安装在载体的摇摆中心,杆臂效应引起的误差通常不可忽略。上式后面两项就是由于杆臂效应引起的惯导敏感到的杆臂加速度基本表达式。定义表示杆臂加速度,则杆臂效应误差的基本方程为:
由于:
因此,进一步整理可得:
(2)挠曲变形的动态建模
载体变形可以分为两类:一类是静态变形,它并不是绝对不变的,只是变化周期比较长而已,因此也称其为准静态变形;另一类就检测而言,变换较快,也即动态挠性变形。
在近年对机体的研究中,通常把相应载体的动态结构变形视为马尔科夫过程,因为载体的动态变形是随机扰动干扰的随机变量,本发明中拟采用二阶马尔科夫过程作为载体动态变形的模型,并且认为各个轴的动态变形过程是独立的,即干扰形成的纵摇的噪声和干扰形成的横滚的噪声是相互独立的。动态变形的二阶马尔科夫过程如下:
动态变形角速率运动方程:
其中,βx=2.146/τi(i=x,y,z),τi为相关时间,可以视具体的载体情况而定,Wi(t)一般认为是具有一定方差的白噪声,如果是有色噪声,则需要进行白化处理,其方差满足: 表示三个弹性变形角λx,λy,λz的方差。
进一步地,步骤4所述的将MEMS子惯导解算出的速度、姿态相对于高精度主惯导解算出的速度、姿态偏差量作为子惯导的量测信息,建立以速度加姿态匹配方式的传递对准卡尔曼滤波器,具体如下:
(1)速度加姿态匹配的误差模型
子惯导中各项速度矢量关系为:
由惯导基本方程可知:
将速度矢量公式左右两边对时间求导,代入上式,并向导航坐标系投影可知:
进一步整理可得:
子惯导相对i系的加速度为:
进一步可知:
同理可知主惯导中:
子惯导中:
主惯导中:
组合上式可知:
且:
进一步可得:
其中:
进一步得到:
假设杆臂效应和挠性运动引起的误差项已经得到补偿,整理可得:
式中,[μ×]与[θ×]分别表示静态变形角与动态变形角的反对称阵。上式忽略二阶小项,可近似为:
进一步得考虑静态变形角与动态变形角时的姿态差方程为:
整理后得到姿态量测方程为:
式中,φ表示主、子惯导解算的姿态偏差量,Zφ表示主、子惯导去掉静态变形角与动态变形角影响的姿态差。
(2)速度加姿态匹配方式的卡尔曼滤波模型
卡尔曼滤波算法本质上利用从初始时刻到当前时刻的所有测量信息,采用迭代方法,不需要保存之前的测量量,同时利用状态和量测方程。在利用量测方程的基础上,将状态方程也纳入滤波算法中,同时利用状态自身的变化规律和测量量,最大程度地提高炮口惯导估计精度。
Kalman滤波主要采用离散递推的表达形式,它的状态空间模型如下:
其中,Xk为系统在k时刻的状态向量,也就是要求的被估计状态量;φk,k-1为k-1时刻到k时刻的状态转移矩阵;Γk-1为系统噪声分配矩阵,它表示由k-1时刻到k时刻的各个系统噪声分别影响k时刻各个状态量的程度;Wk-1代表k-1时刻的系统噪声矢量;Zk表示的是系统在k时刻的量测矢量;Hk为k时刻的系统量测矩阵;Vk表示k时刻的量测噪声矢量。同时,根据卡尔曼滤波的要求,Wk和Vk为相互独立的零均值高斯白噪声矢量序列,满足:
上式为卡尔曼滤波过程中噪声需要满足的条件,同时由于Qk为系统的噪声方差阵,而系统的某个状态量可能并不存在噪声,因此Qk为非负定矩阵;Rk为量测噪声方差阵,而每个量测量都含有噪声,因此Rk为正定矩阵。
卡尔曼滤波算法可以由以下几个方程进行表示:
(1)状态一步预测
(2)状态一步预测均方误差阵
(3)滤波增益
(4)状态估计
(5)状态估计均方误差阵
Pk=(I-KkHk)Pk|k-1 (75)
即:
量测方程z=Hx+v展开为
那么,系统转换矩阵为
观测矩阵为
进一步地,步骤5所述在导航更新阶段,子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,进行导航状态更新,完成炮口的振动测量,具体如下:
传递对准结束后,子惯导能从状态估计量中获取当前陀螺仪的零漂及加速度计的零偏,以及主、子惯导的失准角等。子惯导利用获取的三个欧拉角得到从载体坐标系到导航坐标系的方向余弦矩阵,结合步骤2中的姿态更新算法可以实现子惯导的实时位置姿态测量。
由于子惯导与炮口固连,所以子惯导的实时位置姿态信息即为炮口的实时振动情况,至此完成炮口的振动测量。
综上所述,本发明在炮塔处安装高精度主惯导,在身管炮口处安装MEMS子惯导的接触式测量方式,相对传统光学等非接触式测量方式,安装方便、稳定性高,避免了传统光学方式的易受干扰、安装困难、仪器校准繁琐等缺点;在初始对准阶段,采用高精度主惯导对MEMS子惯导进行传递对准,属于惯导精对准范畴,可以保证MEMS子惯导有准确的初始惯导信息,提高了炮口振动测量的可靠性和准确性;在导航更新阶段,子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,利用姿态更新算法不断迭代解算,可以保证MEMS子惯导的位姿输出准确性,提高了炮口振动测量方法的实时性和可靠性。
Claims (10)
1.一种基于主子惯导结合的行进间炮口振动测量方法,其特征在于,包括以下步骤:
步骤1、根据火炮平台,设计主、子惯导安装位置,包括主惯导和MEMS子惯导;
步骤2、根据火炮行进间主惯导、MEMS子惯导传感器输出,设计基于陀螺仪角增量更新的姿态更新算法;
步骤3、在传递对准阶段,根据火炮身管特性进行外杆臂误差与挠曲形变的动态建模,对杆臂效应及挠曲形变进行补偿;
步骤4、将MEMS子惯导解算出的速度、姿态,相对于主惯导解算出的速度、姿态偏差量作为MEMS子惯导的量测信息,建立以速度加姿态匹配方式的传递对准卡尔曼滤波器;
步骤5、在导航更新阶段,MEMS子惯导利用传递对准结束时刻的对准误差,作为导航解算的初始误差,进行导航状态更新,完成炮口的振动测量。
2.根据权利要求1所述的基于主子惯导结合的行进间炮口振动测量方法,其特征在于,步骤1中,根据火炮平台,设计主、子惯导安装位置,包括主惯导和MEMS子惯导,具体如下:
所述主惯导固连于炮塔,保持水平状态,炮塔进行航向运动带动主惯导一同运动;
所述MEMS子惯导固连于火炮身管前端,用于测量火炮身管前端炮口的位姿。
5.根据权利要求3所述的基于主子惯导结合的行进间炮口振动测量方法,其特征在于,所述步骤2.2,具体如下:
步骤2.2.1、由陀螺仪的更新数据计算得到角增量Δ:
式中,ωx、ωy、ωz表示仪输出的三轴角速度标量值,Tm为采样时间;
步骤2.2.2、利用角增量对四元数进行更新:
式中,q1|k+1、q2|k+1、q3|k+1、q4|k+1分别为k+1时刻四元数的q1、q2、q3、q4值,q1|k、q2|k、q3|k、q4|k分别为k时刻四元数的q1、q2、q3、q4值;
步骤2.2.3、四元数进行归一化处理:
其中,q1'|k+1、q'2|k+1、q'3|k+1、q'4|k+1分别为q1|k+1、q2|k+1、q3|k+1、q4|k+1归一化处理后的值;进行归一化使得四元数变为单位四元数,四个值的平方和为1;
步骤2.2.4、根据单位四元数得到方向余弦矩阵,公式为:
步骤2.2.5、根据方向余弦矩阵得到欧拉角如下:
步骤2.2.6、根据方向余弦矩阵信息和比力信息,得到当前加速度三轴的分量,区分三轴分量能够对重力分量进行补偿,除去重力分量获得导航坐标系下的运动加速度,对运动加速度进行牛顿力学积分得到速度和位置,公式为:
6.根据权力要求1所述的基于主子惯导结合的行进间炮口振动测量方法,其特征在于,步骤3中的外杆臂误差补偿,具体如下:
定义惯性坐标系为Oixiyizi,载体坐标系为Obxbybzb,Ob是载体的摇摆中心,子惯导的加速度计安装在载体坐标系中的固定点p,为载体坐标系原点的位置矢量,为p点相对于惯性坐标系原点的位置矢量,为p点相对于载体坐标系原点的位置矢量,则p点相对于惯性坐标系的线加速度表达式为:
上式后面两项就是由于杆臂效应引起的惯导敏感到的杆臂加速度基本表达式;
8.根据权利要求1所述的基于主子惯导结合的行进间炮口振动测量方法,其特征在于,步骤4中的MEMS子惯导解算出的速度、姿态,相对于主惯导解算出的速度、姿态偏差量,具体如下:
主、子惯导的速度差微分方程为:
式中,表示主子惯导的速度差,为子惯导系统的姿态矩阵,φ×表示主、子惯导的初始安装误差角对应的反对称矩阵,ξ表示主、子惯导的安装误差角估计值;表示主惯导在子惯导坐标系下感受到的比力;表示地球在导航坐标系下的自转角速率;表示子惯导加速度计误差;
姿态量测方程为:
式中,φ表示主、子惯导解算的姿态偏差量;Zφ表示主、子惯导去掉静态变形角与动态变形角影响的姿态差;μ表示静态变形角,包括安装误差;θ表示动态变形角,即挠曲变形。
9.根据权利要求1所述的基于主子惯导结合的行进间炮口振动测量方法,其特征在于,步骤4中所述的速度加姿态匹配方式的卡尔曼滤波模型,具体如下:
(1)状态一步预测
(2)状态一步预测均方误差阵
其中,Pk|k-1为状态一步预测均方误差阵;Pk-1为k-1时刻状态最优估计的均方误差阵;
(3)滤波增益
(4)状态估计
(5)状态估计均方误差阵
Pk=(I-KkHk)Pk|k-1(21)。
10.根据权利要求1所述的基于主子惯导结合的行进间炮口振动测量方法,其特征在于,所述步骤5具体如下:
传递对准结束后,子惯导从状态估计量中获取当前陀螺仪的零漂及加速度计的零偏,以及主、子惯导的失准角;子惯导利用获取的三个欧拉角得到从载体坐标系到导航坐标系的方向余弦矩阵,结合步骤2中的姿态更新算法,实现子惯导的实时位置姿态测量;
由于子惯导与炮口固连,所以子惯导的实时位置姿态信息即为炮口的实时振动情况。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211568434.2A CN116429095A (zh) | 2022-12-08 | 2022-12-08 | 一种基于主子惯导结合的行进间炮口振动测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211568434.2A CN116429095A (zh) | 2022-12-08 | 2022-12-08 | 一种基于主子惯导结合的行进间炮口振动测量方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116429095A true CN116429095A (zh) | 2023-07-14 |
Family
ID=87091337
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211568434.2A Pending CN116429095A (zh) | 2022-12-08 | 2022-12-08 | 一种基于主子惯导结合的行进间炮口振动测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116429095A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117405101A (zh) * | 2023-09-11 | 2024-01-16 | 北京国卫星通科技有限公司 | 惯导数据采集与分析系统 |
CN117824576A (zh) * | 2023-12-28 | 2024-04-05 | 南京理工大学 | 一种基于位姿观测的火炮身管振动惯性测量方法及装置 |
-
2022
- 2022-12-08 CN CN202211568434.2A patent/CN116429095A/zh active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117405101A (zh) * | 2023-09-11 | 2024-01-16 | 北京国卫星通科技有限公司 | 惯导数据采集与分析系统 |
CN117824576A (zh) * | 2023-12-28 | 2024-04-05 | 南京理工大学 | 一种基于位姿观测的火炮身管振动惯性测量方法及装置 |
CN117824576B (zh) * | 2023-12-28 | 2024-08-23 | 南京理工大学 | 一种基于位姿观测的火炮身管振动惯性测量方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110398257B (zh) | Gps辅助的sins系统快速动基座初始对准方法 | |
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN111323050B (zh) | 一种捷联惯导和多普勒组合系统标定方法 | |
CN109596018B (zh) | 基于磁测滚转角速率信息的旋转弹飞行姿态高精度估计方法 | |
CN101413800B (zh) | 导航/稳瞄一体化系统的导航、稳瞄方法 | |
CN116429095A (zh) | 一种基于主子惯导结合的行进间炮口振动测量方法 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
KR100898169B1 (ko) | 관성항법시스템의 초기정렬 방법 | |
CN108731676B (zh) | 一种基于惯性导航技术的姿态融合增强测量方法及系统 | |
CN104880189B (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
CN112857398B (zh) | 一种系泊状态下舰船的快速初始对准方法和装置 | |
CN106403952A (zh) | 一种动中通低成本组合姿态测量方法 | |
CN108507572B (zh) | 一种基于mems惯性测量单元的姿态定位误差修正方法 | |
CN114877915A (zh) | 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法 | |
CN111141285B (zh) | 一种航空重力测量装置 | |
CN112254717A (zh) | 一种基于冷原子干涉陀螺仪的惯性导航装置及方法 | |
CN110375773B (zh) | Mems惯导系统姿态初始化方法 | |
CN115523919A (zh) | 一种基于陀螺漂移优化的九轴姿态解算方法 | |
CN110940357A (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
Carratù et al. | Self-alignment procedure for IMU in automotive context | |
CN114264304B (zh) | 复杂动态环境高精度水平姿态测量方法与系统 | |
CN113029197B (zh) | 一种针对柔性杆臂的传递对准方法 | |
CN113267183B (zh) | 一种多加速度计惯导系统的组合导航方法 | |
CN113188565B (zh) | 一种机载分布式pos传递对准量测异常处理方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |