[go: up one dir, main page]

CN114964224B - Error autonomous suppression method for micro inertial navigation system - Google Patents

Error autonomous suppression method for micro inertial navigation system Download PDF

Info

Publication number
CN114964224B
CN114964224B CN202210408307.XA CN202210408307A CN114964224B CN 114964224 B CN114964224 B CN 114964224B CN 202210408307 A CN202210408307 A CN 202210408307A CN 114964224 B CN114964224 B CN 114964224B
Authority
CN
China
Prior art keywords
squares
observation
equation
roll angle
variables
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.)
Active
Application number
CN202210408307.XA
Other languages
Chinese (zh)
Other versions
CN114964224A (en
Inventor
尚克军
邓继权
邹思远
郭玉胜
刘冲
刘洋
周亚男
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Automation Control Equipment Institute BACEI
Original Assignee
Beijing Automation Control Equipment Institute BACEI
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Automation Control Equipment Institute BACEI filed Critical Beijing Automation Control Equipment Institute BACEI
Priority to CN202210408307.XA priority Critical patent/CN114964224B/en
Publication of CN114964224A publication Critical patent/CN114964224A/en
Application granted granted Critical
Publication of CN114964224B publication Critical patent/CN114964224B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/183Compensation of inertial measurements, e.g. for temperature effects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manufacturing & Machinery (AREA)
  • Navigation (AREA)

Abstract

本发明提供了一种微惯导系统误差自主抑制方法,所述方法包括:实时获取弹体的滚动角;构建最小二乘状态变量;构建最小二乘观测变量;根据最小二乘状态变量和最小二乘观测变量获取最小二乘量测方程,并根据最小二乘量测方程进行最小二乘估计,得到对准初始时刻的滚动角估计值;构建卡尔曼滤波状态方程;构建卡尔曼滤波观测方程;根据卡尔曼滤波状态方程和卡尔曼滤波观测方程进行卡尔曼滤波,以获取陀螺标度因数误差估计值和修正后的陀螺标度因数,从而实现微惯导系统误差的自主抑制。本发明能够解决现有技术中制导炮弹用微惯导系统会由于量级高且持续时间长的炮弹发射冲击导致陀螺标度因数产生较大的变化,进而导致微惯导系统性能下降的技术问题。

The invention provides a micro-inertial navigation system error autonomous suppression method. The method includes: obtaining the rolling angle of the projectile in real time; constructing the least squares state variables; constructing the least squares observation variables; according to the least squares state variables and the minimum The least squares measurement equation is obtained by multiplying the square observation variables, and the least squares estimation is performed based on the least squares measurement equation to obtain the rolling angle estimate at the initial moment of alignment; the Kalman filter state equation is constructed; the Kalman filter observation equation is constructed ; Carry out Kalman filtering based on the Kalman filtering state equation and the Kalman filtering observation equation to obtain the gyro scale factor error estimate and the corrected gyro scale factor, thereby achieving autonomous suppression of micro-inertial navigation system errors. The present invention can solve the technical problem in the prior art that the micro-inertial navigation system for guided artillery shells will cause a large change in the gyro scale factor due to the impact of high-magnitude and long-lasting artillery shell launches, thereby leading to a decrease in the performance of the micro-inertial navigation system. .

Description

Error autonomous suppression method for micro inertial navigation system
Technical Field
The application relates to the technical field of micro inertial navigation systems for high-speed rotating guided projectiles, in particular to an autonomous error suppression method for a micro inertial navigation system.
Background
The high overload micro inertial navigation system has the characteristics of small volume, light weight, strong autonomy, good concealment and the like, has the outstanding characteristic of resisting the high overload severe mechanical environment, and has wide application prospect in the application fields of manufacturing guided shells, electromagnetic guide rail shells, ultra-remote guided shells and the like.
The guided projectile simultaneously has high-speed rotation motion in the flight process, namely, the guided projectile rotates around the longitudinal axis of the guided projectile while advancing, and certain stability can be obtained through the gyroscopic effect generated by the high-speed rotation. The rotation speed of the guided projectile outlet is usually tens of revolutions per second, and even though the micro inertial navigation system is powered on at the moment, the projectile rotation speed is usually more than ten revolutions per second, which requires the angular rate measurement range of the micro inertial navigation system to be up to about thousands of degrees per second, and the rotation axis scale factor error can have a critical influence on the precision of the micro inertial navigation system for the micro inertial navigation system due to the high-speed rotation of the projectile in the flight process.
The micro inertial navigation system for guided projectiles is usually powered on in the air after being launched to complete initial alignment and combined navigation, the magnitude of the projectile is up to 10000g in the launching process, and the launching impact with the duration of about 10ms can cause the gyro scale factor to change greatly, so that the performance of the micro inertial navigation system is reduced.
Disclosure of Invention
The application provides an autonomous error suppression method for a micro inertial navigation system, which can solve the technical problem that the performance of the micro inertial navigation system is reduced because the gyroscope scale factor is greatly changed due to the projectile emission impact with high measurement level and long duration time in the prior art.
According to an aspect of the application, there is provided an autonomous error suppression method for a micro inertial navigation system, the method comprising:
acquiring the rolling angle of the projectile body in real time by utilizing a micro inertial navigation system;
constructing a least square state variable according to the rolling angle of the alignment initial moment;
constructing a least square observation variable according to the rolling angle at the current moment;
acquiring a least square measurement equation according to the least square state variable and the least square observation variable, and carrying out least square estimation according to the least square measurement equation to obtain a rolling angle estimation value aiming at the initial moment;
a Kalman filtering state equation is constructed by taking the rolling angle error, the gyro scale factor error and the gyro zero position as Kalman filtering state variables;
constructing a Kalman filtering observation equation by taking a difference value of rolling angle estimated values of alignment initial moments obtained by least square estimation of adjacent filtering moments as a Kalman filtering observation variable;
and carrying out Kalman filtering according to a Kalman filtering state equation and a Kalman filtering observation equation to obtain a gyro scale factor error estimated value and a corrected gyro scale factor, thereby realizing autonomous suppression of the micro inertial navigation system error.
Preferably, the Kalman filter state equation is constructed by:
wherein ,
in the formula ,is Kalman filtering state variable, F is continuous state equation state transition matrix, +.>Is the random noise vector of the system, delta gamma is the rolling angle error, delta k x For the error of the scale factor of the X-axis gyro epsilon bx Is X-axis gyro zero position->The rotational axis angular rate is sensitive to the X-axis gyroscope.
Preferably, the Kalman filter observation equation is constructed by:
in the formula ,for Kalman filtering observation variables, +.>For Kalman filtering observation matrix, +.>For observing noise +.>Rolling angle estimation value of alignment initial time obtained for least square estimation of current filtering time,And (3) estimating a rolling angle estimation value of the alignment initial moment for least square estimation of the last filtering moment.
Preferably, the real-time obtaining the roll angle of the projectile body by using the micro inertial navigation system comprises:
acquiring angular rate information under a navigation coordinate system output by a micro inertial navigation system;
acquiring angular rate information under a carrier coordinate system according to the angular rate information under the navigation coordinate system;
and acquiring the rolling angle of the projectile body according to the angular rate information under the carrier coordinate system.
Preferably, the angular rate information in the carrier coordinate system is obtained by:
wherein ,
the roll angle of the projectile was obtained by:
wherein ,
in the formula ,for the carrier coordinate system X-axis gyro angular rate, < >>For the carrier coordinate system Y-axis gyro angular rate, < >>For the carrier coordinate system Z-axis gyro angular rate, < >>For scrolling angular rate +.>For course angular rate, ++>For pitch rate, c 1 C for a conversion matrix rotating around the X-axis 3 For a conversion matrix rotating around the Z axis, gamma is the roll angle of the projectile, theta is the pitch angle of the projectile, +.>Is the heading angle of the projectile.
Preferably, the least squares state variable is constructed by:
X=[cos(γ 0 ) sin(γ 0 )] T
the least squares observed variable is constructed by:
Z=[sin(γ) cos(γ)] T
wherein X is a least squares state variable, gamma 0 To align the roll angle at the initial time, Z is the least squares observation variable and γ is the roll angle at the current time.
Preferably, obtaining a least square measurement equation according to the least square state variable and the least square observation variable, and performing least square estimation according to the least square measurement equation, the obtaining a roll angle estimation value aligned with the initial time includes:
acquiring a least square observation matrix according to the least square state variable and the least square observation variable;
acquiring a least square measurement equation according to the least square state variable, the least square observation variable and the least square observation matrix;
acquiring a least square measurement equation set according to the least square measurement equation, wherein the least square measurement equation set comprises r least square measurement equations, and r is the measurement times during alignment;
and obtaining the estimated value of the least square state variable according to the least square measurement equation set, thereby obtaining the estimated value of the rolling angle of the alignment initial moment obtained by least square estimation.
Preferably, the least squares observation matrix is obtained by:
the least squares measurement equation is obtained by:
Z=HX+V;
obtaining a least square measurement equation set through the following steps:
wherein H is a least squares observation matrix, t is time, V is measurement noise, Z 1 、Z 2 、......、Z r The least squares observed variable, H, measured first, second, &..the r-th time, respectively 1 、H 2 、......、H r A least squares observation matrix, V, of the first, second, & gt 1 、V 2 、......、V r The measurement noise of the first, second, and r-th measurements, respectively.
Preferably, the estimated value of the least squares state variable is obtained by:
the roll angle estimation value of the alignment initial moment obtained by least square estimation is obtained by the following formula:
in the formula ,estimated value for least squares state variable, < >>For aligning the roll angle estimate at the initial moment, +.>Is the first element of the estimate of the least squares state variable,/for>Is the second element of the estimate of the least squares state variable.
According to a further aspect of the present application there is provided a computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor implementing any of the methods described above when executing the computer program.
By applying the technical scheme of the application, the rolling angle of the projectile body is obtained in real time by utilizing the micro inertial navigation system, the rolling angle estimated value at the initial alignment time is estimated by least square, then a Kalman filtering method is adopted, and the difference value of the rolling angle estimated values at the initial alignment time obtained by least square estimation at the adjacent filtering time is used as a Kalman filtering observation variable to obtain the gyro scale factor error estimated value and the corrected gyro scale factor, thereby realizing the autonomous suppression of the micro inertial navigation system error and improving the navigation precision of the micro inertial navigation system. The method is convenient for engineering realization and does not depend on external auxiliary information, can be widely applied to the field of guided missiles rotating at high speed, and has very important significance for a micro inertial navigation system for guided missiles.
Drawings
The accompanying drawings, which are included to provide a further understanding of embodiments of the application and are incorporated in and constitute a part of this specification, illustrate embodiments of the application and together with the description serve to explain the principles of the application. It is evident that the drawings in the following description are only some embodiments of the present application and that other drawings may be obtained from these drawings without inventive effort for a person of ordinary skill in the art.
FIG. 1 illustrates a flow chart of a method for error autonomous suppression of a micro inertial navigation system provided in accordance with one embodiment of the present application;
FIG. 2 illustrates a graph of a gyroscope scale factor estimation provided in accordance with one embodiment of the present application.
Detailed Description
It should be noted that, without conflict, the embodiments of the present application and features of the embodiments may be combined with each other. The following description of the embodiments of the present application will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present application, but not all embodiments. The following description of at least one exemplary embodiment is merely exemplary in nature and is in no way intended to limit the application, its application, or uses. All other embodiments, which can be made by those skilled in the art based on the embodiments of the application without making any inventive effort, are intended to be within the scope of the application.
It is noted that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of exemplary embodiments according to the present application. As used herein, the singular is also intended to include the plural unless the context clearly indicates otherwise, and furthermore, it is to be understood that the terms "comprises" and/or "comprising" when used in this specification are taken to specify the presence of stated features, steps, operations, devices, components, and/or combinations thereof.
The relative arrangement of the components and steps, numerical expressions and numerical values set forth in these embodiments do not limit the scope of the present application unless it is specifically stated otherwise. Meanwhile, it should be understood that the sizes of the respective parts shown in the drawings are not drawn in actual scale for convenience of description. Techniques, methods, and apparatus known to one of ordinary skill in the relevant art may not be discussed in detail, but should be considered part of the specification where appropriate. In all examples shown and discussed herein, any specific values should be construed as merely illustrative, and not a limitation. Thus, other examples of the exemplary embodiments may have different values. It should be noted that: like reference numerals and letters denote like items in the following figures, and thus once an item is defined in one figure, no further discussion thereof is necessary in subsequent figures.
As shown in fig. 1, the application provides an autonomous error suppression method for a micro inertial navigation system, which comprises the following steps:
s10, acquiring a rolling angle of the projectile body in real time by utilizing a micro inertial navigation system;
s20, constructing a least square state variable according to the rolling angle of the alignment initial moment;
s30, constructing a least square observation variable according to the rolling angle at the current moment;
s40, acquiring a least square measurement equation according to the least square state variable and the least square observation variable, and carrying out least square estimation according to the least square measurement equation to obtain a rolling angle estimated value aligned with the initial moment;
s50, constructing a Kalman filtering state equation by taking the rolling angle error, the gyro scale factor error and the gyro zero position as Kalman filtering state variables;
s60, constructing a Kalman filtering observation equation by taking a difference value of rolling angle estimated values of alignment initial moments obtained by least square estimation of adjacent filtering moments as a Kalman filtering observation variable;
s70, kalman filtering is carried out according to a Kalman filtering state equation and a Kalman filtering observation equation to obtain a gyro scale factor error estimated value and a corrected gyro scale factor, so that autonomous suppression of micro inertial navigation system errors is realized.
According to the application, the rolling angle of the projectile body is obtained in real time by utilizing the micro inertial navigation system, the rolling angle estimated value of the alignment initial moment is estimated by least square, then a Kalman filtering method is adopted, and the difference value of the rolling angle estimated values of the alignment initial moment obtained by least square estimation of adjacent filtering moments is used as a Kalman filtering observation variable to obtain a gyro scale factor error estimated value and a corrected gyro scale factor, so that the autonomous suppression of the micro inertial navigation system error is realized, and the navigation precision of the micro inertial navigation system is improved. The method is convenient for engineering realization and does not depend on external auxiliary information, can be widely applied to the field of guided missiles rotating at high speed, and has very important significance for a micro inertial navigation system for guided missiles.
According to one embodiment of the present application, in S10 of the present application, acquiring the roll angle of the projectile in real time using the micro inertial navigation system includes:
s11, acquiring angular rate information under a navigation coordinate system output by a micro inertial navigation system;
s12, acquiring angular rate information under a carrier coordinate system according to the angular rate information under the navigation coordinate system;
s13, acquiring the rolling angle of the projectile body according to the angular rate information under the carrier coordinate system.
Specifically, in S12 of the present application, the angular rate information in the carrier coordinate system is obtained by the following formula:
wherein ,
will c 1 、c 3 Substituting the above formula and expanding to obtain:
from the above, it is possible to obtain
Order theThen it can be derived from the above equation:
the roll angle of the projectile can be calculated from the above equation as follows:
in the formula ,for the carrier coordinate system X-axis gyro angular rate, < >>For the carrier coordinate system Y-axis gyro angular rate, < >>For the carrier coordinate system Z-axis gyro angular rate, < >>For scrolling angular rate +.>For course angular rate, ++>For pitch rate, c 1 C for a conversion matrix rotating around the X-axis 3 For a transition matrix rotating about the Z-axis, gamma is the roll angle of the projectile and θ is the projectilePitch angle of->Is the heading angle of the projectile.
According to the application, as can be seen from the analysis, the measurement errors of the angular rates of the Y-axis gyroscope and the Z-axis gyroscope can greatly influence the calculation result of the rolling angle, and the calculation result is singular due to the influence of factors such as gyroscope measurement noise and the like by directly calculating by using the method, so that the rolling angle is estimated by using a least square algorithm, and the estimation precision and reliability of the rolling angle are improved.
According to one embodiment of the present application, in S20 of the present application, a least squares state variable is constructed by:
X=[cos(γ 0 ) sin(γ 0 )] T
in S30 of the present application, a least squares observation variable is constructed by:
Z=[sin(γ) cos(γ)] T
wherein X is a least squares state variable, gamma 0 To align the roll angle at the initial time, Z is the least squares observation variable and γ is the roll angle at the current time.
According to one embodiment of the present application, in S40 of the present application, obtaining a least square measurement equation according to a least square state variable and a least square observation variable, and performing least square estimation according to the least square measurement equation, obtaining a roll angle estimation value aligned to an initial time includes:
s41, acquiring a least square observation matrix according to a least square state variable and a least square observation variable;
s42, acquiring a least square measurement equation according to the least square state variable, the least square observation variable and the least square observation matrix;
s43, acquiring a least square measurement equation set according to the least square measurement equation, wherein the least square measurement equation set comprises r least square measurement equations, and r is the measurement times during the alignment period;
s44, obtaining an estimated value of the least square state variable according to the least square measurement equation set, and accordingly obtaining a rolling angle estimated value of the alignment initial moment obtained through least square estimation.
Specifically, in S41 of the present application, the least squares observation matrix is obtained by:
in S42 of the present application, the least squares measurement equation is obtained by:
Z=HX+V;
in S43 of the present application, a system of least squares measurement equations is obtained by:
wherein H is a least squares observation matrix, t is time, V is measurement noise, Z 1 、Z 2 、......、Z r The least squares observed variable, H, measured first, second, &..the r-th time, respectively 1 、H 2 、......、H r A least squares observation matrix, V, of the first, second, & gt 1 、V 2 、......、V r The measurement noise of the first, second, and r-th measurements, respectively.
Further, in S44 of the present application, the estimated value of the least squares state variable is obtained by:
the roll angle estimation value of the alignment initial moment obtained by least square estimation is obtained by the following formula:
in the formula ,estimated value for least squares state variable, < >>For aligning the roll angle estimate at the initial moment, +.>Is the first element of the estimate of the least squares state variable,/for>Is the second element of the estimate of the least squares state variable.
According to one embodiment of the present application, in S50 of the present application, a kalman filter state equation is constructed by:
wherein ,
in the formula ,is Kalman filtering state variable, F is continuous state equation state transition matrix, +.>Is the random noise vector of the system, delta gamma is the rolling angle error, delta k x For the error of the scale factor of the X-axis gyro epsilon bx Is X-axis gyro zero position->The rotational axis angular rate is sensitive to the X-axis gyroscope.
According to one embodiment of the present application, in S60 of the present application, a kalman filter observation equation is constructed by:
in the formula ,for Kalman filtering observation variables, +.>For Kalman filtering observation matrix, +.>For observing noise +.>Rolling angle estimation value of alignment initial time obtained for least square estimation of current filtering time,And (3) estimating a rolling angle estimation value of the alignment initial moment for least square estimation of the last filtering moment.
The application also provides a computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor implementing any of the methods described above when executing the computer program.
Taking certain model flight test data as an example, the method is used for estimating the gyro scale factor error to obtain a Kalman filtering estimation result as shown in figure 2.
As can be seen from FIG. 2, the gyro scale factor error can be estimated rapidly, and the gyro scale factor is corrected by using the result of estimation, so that the measurement accuracy of the micro inertial navigation system can be improved greatly.
In summary, the application provides an autonomous error suppression method for a micro inertial navigation system, which comprises the steps of acquiring a roll angle of a projectile body in real time by using the micro inertial navigation system, estimating a roll angle estimated value at an alignment initial moment by least square, and using a Kalman filtering method to acquire a gyro scale factor error estimated value and a corrected gyro scale factor by using a difference value of the roll angle estimated values at the alignment initial moment, which is obtained by least square estimation at adjacent filtering moments, as a Kalman filtering observation variable, thereby realizing autonomous error suppression of the micro inertial navigation system and improving navigation precision of the micro inertial navigation system. The method is convenient for engineering realization and does not depend on external auxiliary information, can be widely applied to the field of guided missiles rotating at high speed, and has very important significance for a micro inertial navigation system for guided missiles.
Spatially relative terms, such as "above … …," "above … …," "upper surface at … …," "above," and the like, may be used herein for ease of description to describe one device or feature's spatial location relative to another device or feature as illustrated in the figures. It will be understood that the spatially relative terms are intended to encompass different orientations in use or operation in addition to the orientation depicted in the figures. For example, if the device in the figures is turned over, elements described as "above" or "over" other devices or structures would then be oriented "below" or "beneath" the other devices or structures. Thus, the exemplary term "above … …" may include both orientations of "above … …" and "below … …". The device may also be positioned in other different ways (rotated 90 degrees or at other orientations) and the spatially relative descriptors used herein interpreted accordingly.
In addition, the terms "first", "second", etc. are used to define the components, and are only for convenience of distinguishing the corresponding components, and the terms have no special meaning unless otherwise stated, and therefore should not be construed as limiting the scope of the present application.
The above description is only of the preferred embodiments of the present application and is not intended to limit the present application, but various modifications and variations can be made to the present application by those skilled in the art. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included in the protection scope of the present application.

Claims (7)

1.一种微惯导系统误差自主抑制方法,其特征在于,所述方法包括:1. A method for autonomous error suppression in a micro inertial navigation system, characterized in that the method comprises: 利用微惯导系统实时获取弹体的滚动角,具体包括:获取微惯导系统输出的导航坐标系下的角速率信息;根据导航坐标系下的角速率信息获取载体坐标系下的角速率信息;根据载体坐标系下的角速率信息获取弹体的滚动角;The roll angle of the projectile is obtained in real time using a micro inertial navigation system, specifically including: obtaining angular rate information in the navigation coordinate system output by the micro inertial navigation system; obtaining angular rate information in the carrier coordinate system based on the angular rate information in the navigation coordinate system; and obtaining the roll angle of the projectile based on the angular rate information in the carrier coordinate system. 根据对准初始时刻的滚动角构建最小二乘状态变量;Construct least-squares state variables based on the roll angle at the initial alignment time; 根据当前时刻的滚动角构建最小二乘观测变量;Construct least-squares observation variables based on the current roll angle; 根据最小二乘状态变量和最小二乘观测变量获取最小二乘量测方程,并根据最小二乘量测方程进行最小二乘估计,得到对准初始时刻的滚动角估计值;The least squares measurement equation is obtained based on the least squares state variables and least squares observation variables, and the least squares estimation is performed based on the least squares measurement equation to obtain the estimated value of the roll angle at the initial alignment time. 以滚动角误差、陀螺标度因数误差和陀螺零位作为卡尔曼滤波状态变量构建卡尔曼滤波状态方程;The Kalman filter state equation is constructed using roll angle error, gyroscope scale factor error, and gyroscope zero position as Kalman filter state variables; 以相邻滤波时刻最小二乘估计得到的对准初始时刻的滚动角估计值的差值作为卡尔曼滤波观测变量构建卡尔曼滤波观测方程;The Kalman filter observation equation is constructed by using the difference between the roll angle estimates obtained by least squares estimation at adjacent filtering times as the Kalman filter observation variables; 根据卡尔曼滤波状态方程和卡尔曼滤波观测方程进行卡尔曼滤波,以获取陀螺标度因数误差估计值和修正后的陀螺标度因数,从而实现微惯导系统误差的自主抑制;Kalman filtering is performed based on the Kalman filter state equation and the Kalman filter observation equation to obtain the gyroscope scaling factor error estimate and the corrected gyroscope scaling factor, thereby achieving autonomous suppression of errors in the micro inertial navigation system. 其中,通过下式获取载体坐标系下的角速率信息:The angular velocity information in the carrier coordinate system is obtained by the following formula: 其中, in, 通过下式获取弹体的滚动角:The roll angle of the projectile is obtained by the following formula: 其中, in, 式中,为载体坐标系X轴陀螺角速率,为载体坐标系Y轴陀螺角速率,为载体坐标系Z轴陀螺角速率,为滚动角速率,为航向角速率,为俯仰角速率,c1为绕X轴转动的转换矩阵,c3为绕Z轴转动的转换矩阵,γ为弹体的滚动角,θ为弹体的俯仰角,为弹体的航向角;In the formula, The gyro angular rate is the X-axis of the carrier coordinate system. The gyro angular rate along the Y-axis of the carrier coordinate system. The gyro angular rate is the Z-axis of the carrier coordinate system. The rolling angular velocity, For the heading angular rate, Let be the pitch rate, c1 be the transformation matrix for rotation about the X-axis, c3 be the transformation matrix for rotation about the Z-axis, γ be the roll angle of the projectile, and θ be the pitch angle of the projectile. The heading angle of the projectile; 通过下式构建最小二乘状态变量:The least squares state variables are constructed using the following formula: X=[cos(γ0) sin(γ0)]TX=[cos(γ 0 ) sin(γ 0 )] T ; 通过下式构建最小二乘观测变量:The least squares observation variables are constructed using the following formula: Z=[sin(γ) cos(γ)]TZ = [sin(γ) cos(γ)] T ; 通过下式获取最小二乘观测矩阵:The least squares observation matrix is obtained using the following formula: 通过下式构建卡尔曼滤波状态变量:The Kalman filter state variables are constructed using the following formula: 通过下式构建卡尔曼滤波观测变量:The Kalman filter observation variables are constructed using the following formula: 式中,X为最小二乘状态变量,γ0为对准初始时刻的滚动角,Z为最小二乘观测变量,γ为当前时刻的滚动角,H为最小二乘观测矩阵,t为时间,为载体坐标系X轴陀螺角速率,为卡尔曼滤波状态变量,δγ为滚动角误差,δkx为X轴陀螺标度因数误差,εbx为X轴陀螺零位,为卡尔曼滤波观测变量,为当前滤波时刻最小二乘估计得到的对准初始时刻的滚动角估计值,为上一滤波时刻最小二乘估计得到的对准初始时刻的滚动角估计值。In the formula, X is the least squares state variable, γ0 is the roll angle at the initial alignment time, Z is the least squares observation variable, γ is the roll angle at the current time, H is the least squares observation matrix, and t is time. The gyro angular rate is the X-axis of the carrier coordinate system. Here, δγ is the Kalman filter state variable, δkx is the roll angle error, δkx is the X-axis gyroscope scale factor error, and εbx is the X-axis gyroscope zero position. For Kalman filter observation variables, The roll angle estimate at the initial alignment time is obtained from the least squares estimation at the current filtering time. The roll angle estimate for the initial alignment time is obtained from the least squares estimation at the previous filtering time. 2.根据权利要求1所述的方法,其特征在于,通过下式构建卡尔曼滤波状态方程:2. The method according to claim 1, characterized in that the Kalman filter state equation is constructed by the following formula: 其中, in, 式中,F为连续状态方程状态转移矩阵,为系统随机噪声向量,为X轴陀螺敏感的旋转轴角速率。In the formula, F is the state transition matrix of the continuous state equation. Let the system be a random noise vector. The rotational axis angular rate is sensitive to the X-axis gyroscope. 3.根据权利要求1所述的方法,其特征在于,通过下式构建卡尔曼滤波观测方程:3. The method according to claim 1, characterized in that the Kalman filter observation equation is constructed by the following formula: 式中,为卡尔曼滤波观测矩阵,为观测噪声。In the formula, The Kalman filter observation matrix, To observe noise. 4.根据权利要求1所述的方法,其特征在于,根据最小二乘状态变量和最小二乘观测变量获取最小二乘量测方程,并根据最小二乘量测方程进行最小二乘估计,得到对准初始时刻的滚动角估计值包括:4. The method according to claim 1, characterized in that, obtaining the least squares measurement equation based on the least squares state variables and the least squares observation variables, and performing least squares estimation based on the least squares measurement equation to obtain the estimated value of the roll angle at the initial alignment time includes: 根据最小二乘状态变量和最小二乘观测变量获取最小二乘观测矩阵;Obtain the least squares observation matrix based on the least squares state variables and least squares observation variables; 根据最小二乘状态变量、最小二乘观测变量和最小二乘观测矩阵获取最小二乘量测方程;The least squares measurement equation is obtained based on the least squares state variables, least squares observation variables, and least squares observation matrix. 根据最小二乘量测方程获取最小二乘量测方程组,其中,最小二乘量测方程组包括r个最小二乘量测方程,r为对准期间测量次数;The least square measurement equation set is obtained based on the least square measurement equation, where the least square measurement equation set includes r least square measurement equations, and r is the number of measurements during the alignment period; 根据最小二乘量测方程组获取最小二乘状态变量的估计值,从而得到最小二乘估计得到的对准初始时刻的滚动角估计值。The least squares state variables are estimated by obtaining the least squares measurement equations, and thus the roll angle estimate at the initial alignment time is obtained by the least squares estimation. 5.根据权利要求4所述的方法,其特征在于,通过下式获取最小二乘量测方程:5. The method according to claim 4, characterized in that the least squares measurement equation is obtained by the following formula: Z=HX+V;Z = HX + V; 通过下式获取最小二乘量测方程组:The least squares measurement equations are obtained using the following formula: 式中,V为量测噪声,Z1、Z2、......、Zr分别为第一、第二、......、第r次测量的最小二乘观测变量,H1、H2、......、Hr分别为第一、第二、......、第r次测量的最小二乘观测矩阵,V1、V2、......、Vr分别为第一、第二、......、第r次测量的量测噪声。In the formula, V represents the measurement noise, Z1 , Z2 , ..., Zr represent the least squares observation variables of the first, second, ..., rth measurements, respectively, H1 , H2 , ..., Hr represent the least squares observation matrices of the first, second, ..., rth measurements, respectively, and V1 , V2 , ..., Vr represent the measurement noise of the first, second, ..., rth measurements, respectively. 6.根据权利要求4或5所述的方法,其特征在于,通过下式获取最小二乘状态变量的估计值:6. The method according to claim 4 or 5, characterized in that the estimated value of the least squares state variable is obtained by the following formula: 通过下式得到最小二乘估计得到的对准初始时刻的滚动角估计值:The estimated roll angle at the initial alignment moment is obtained by least squares estimation using the following formula: 式中,为最小二乘状态变量的估计值,为对准初始时刻的滚动角估计值,为最小二乘状态变量的估计值的第一个元素,为最小二乘状态变量的估计值的第二个元素。In the formula, These are the least squares estimates of the state variables. To estimate the roll angle at the initial alignment time, The first element of the least squares estimate of the state variable. The second element is the estimate of the least squares state variable. 7.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至6任一所述方法。7. A computer device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that the processor executes the computer program to implement the method of any one of claims 1 to 6.
CN202210408307.XA 2022-04-19 2022-04-19 Error autonomous suppression method for micro inertial navigation system Active CN114964224B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210408307.XA CN114964224B (en) 2022-04-19 2022-04-19 Error autonomous suppression method for micro inertial navigation system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210408307.XA CN114964224B (en) 2022-04-19 2022-04-19 Error autonomous suppression method for micro inertial navigation system

Publications (2)

Publication Number Publication Date
CN114964224A CN114964224A (en) 2022-08-30
CN114964224B true CN114964224B (en) 2023-11-03

Family

ID=82971258

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210408307.XA Active CN114964224B (en) 2022-04-19 2022-04-19 Error autonomous suppression method for micro inertial navigation system

Country Status (1)

Country Link
CN (1) CN114964224B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116150552A (en) * 2023-02-20 2023-05-23 北京自动化控制设备研究所 A Calculation Method of Initial Attitude of Guided Projectile

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8914196B1 (en) * 2013-11-01 2014-12-16 Automotive Technologies International, Inc. Crash sensor systems utilizing vehicular inertial properties
CN106940193A (en) * 2017-02-13 2017-07-11 哈尔滨工业大学 A kind of ship self adaptation based on Kalman filter waves scaling method
CN107478223A (en) * 2016-06-08 2017-12-15 南京理工大学 A kind of human body attitude calculation method based on quaternary number and Kalman filtering
CN111121761A (en) * 2018-11-01 2020-05-08 北京自动化控制设备研究所 Method for determining micro-mechanical inertial navigation rolling angle based on airspeed
CN111504256A (en) * 2020-04-29 2020-08-07 中国北方工业有限公司 A Real-time Estimation Method of Roll Angle Based on Least Squares
CN113029199A (en) * 2021-03-15 2021-06-25 中国人民解放军国防科技大学 System-level temperature error compensation method of laser gyro inertial navigation system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8914196B1 (en) * 2013-11-01 2014-12-16 Automotive Technologies International, Inc. Crash sensor systems utilizing vehicular inertial properties
CN107478223A (en) * 2016-06-08 2017-12-15 南京理工大学 A kind of human body attitude calculation method based on quaternary number and Kalman filtering
CN106940193A (en) * 2017-02-13 2017-07-11 哈尔滨工业大学 A kind of ship self adaptation based on Kalman filter waves scaling method
CN111121761A (en) * 2018-11-01 2020-05-08 北京自动化控制设备研究所 Method for determining micro-mechanical inertial navigation rolling angle based on airspeed
CN111504256A (en) * 2020-04-29 2020-08-07 中国北方工业有限公司 A Real-time Estimation Method of Roll Angle Based on Least Squares
CN113029199A (en) * 2021-03-15 2021-06-25 中国人民解放军国防科技大学 System-level temperature error compensation method of laser gyro inertial navigation system

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Foot-Mounted Pedestrian Navigation Method Based on Gait Classification for Three-Dimensional Positioning;Deng Zhihong等;IEEE Sensors Journal;第第20卷卷(第第4期期);全文 *
一种无卫星辅助的制导弹药滚转角误差修正算法;高贤志等;导航定位与授时;第7卷(第5期);全文 *

Also Published As

Publication number Publication date
CN114964224A (en) 2022-08-30

Similar Documents

Publication Publication Date Title
CN107655493B (en) SINS six-position system-level calibration method for fiber-optic gyroscope
Guo et al. The soft iron and hard iron calibration method using extended Kalman filter for attitude and heading reference system
CN110887480B (en) Flight attitude estimation method and system based on MEMS sensor
CN109682377A (en) A kind of Attitude estimation method based on the decline of dynamic step length gradient
CN106989761B (en) A kind of spacecraft Guidance instrumentation on-orbit calibration method based on adaptive-filtering
CN110174121A (en) A kind of aviation attitude system attitude algorithm method based on earth&#39;s magnetic field adaptive correction
CN110702113B (en) Method for preprocessing data and calculating attitude of strapdown inertial navigation system based on MEMS sensor
JP2004512517A (en) Posture alignment of slave inertial measurement system
Hoang et al. Measurement optimization for orientation tracking based on no motion no integration technique
CN107883951A (en) A method and terminal for calculating three-dimensional attitude of an underwater robot
CN114964224B (en) Error autonomous suppression method for micro inertial navigation system
CN108871319B (en) Attitude calculation method based on earth gravity field and earth magnetic field sequential correction
CN105606093B (en) Inertial navigation method and device based on gravity real-Time Compensation
CN108627152A (en) A kind of air navigation aid of the miniature drone based on Fusion
CN111504256A (en) A Real-time Estimation Method of Roll Angle Based on Least Squares
CN109186634B (en) A MEMS inertial group navigation performance measurement method and device
CN111486870A (en) System-level calibration method for inclined strapdown inertial measurement unit
CN110779514A (en) Hierarchical Kalman fusion method and device for auxiliary attitude determination of bionic polarization navigation
CN105241319A (en) High-speed self-rotation guided cartridge aerial real-time alignment method
CN111238532B (en) Inertial measurement unit calibration method suitable for shaking base environment
CN111307114B (en) Measurement method of horizontal attitude of surface ship based on motion reference unit
CN112747770A (en) Speed measurement-based initial alignment method in carrier maneuvering
CN106595669A (en) Attitude calculation method of rotating body
CN111832690A (en) Calculation method of gyro measurement value of inertial navigation system based on particle swarm optimization algorithm
CN115931001A (en) Inertial measurement unit calibration method, device, computer equipment and storage medium

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
GR01 Patent grant
GR01 Patent grant