CN111504256A - Roll angle real-time estimation method based on least square method - Google Patents
Roll angle real-time estimation method based on least square method Download PDFInfo
- Publication number
- CN111504256A CN111504256A CN202010358933.3A CN202010358933A CN111504256A CN 111504256 A CN111504256 A CN 111504256A CN 202010358933 A CN202010358933 A CN 202010358933A CN 111504256 A CN111504256 A CN 111504256A
- Authority
- CN
- China
- Prior art keywords
- roll angle
- angle
- estimation
- roll
- axis
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
Abstract
The invention relates to a roll angle real-time estimation method based on a least square method, and belongs to the field of inertial navigation. The invention aims to solve the problems that a blind area exists in time magnetic measurement during roll angle measurement, the platform type inertial navigation has larger volume and higher cost, an MEMS gyroscope in the roll direction has high precision, small time-measuring range and low time-measuring precision when the range is large, an error accumulation exists in a strapdown inertial navigation system and the like, and the Z-shaped form is obtained according to a trajectory equation2×1=H2×2·X2×1A matrix equation of (c); estimating the pitch angle, the pitch angle speed and the yaw angle speed of the projectile body at n sampling moments according to the satellite navigation data, and obtaining the shape of Z by combining the data of a double-shaft gyroscope2n+1=H2n×2·X2×1A matrix equation of (c); further obtaining X containing roll angle information2×1Least squares estimation of (d); according to X2×1And determining the roll angle according to the least square estimation and the roll angle value range. Obtained by the methodThe roll angle precision is high, the error accumulation of a strapdown inertial navigation system is effectively avoided, and the problems of insufficient range and low precision of the MEMS gyroscope are solved.
Description
Technical Field
The invention belongs to the field of inertial navigation, and particularly relates to a method for estimating a roll angle of an aerial rotating carrier in real time based on a least square method.
Background
The requirement of modern war on the hitting precision of weapon system is higher and higher, and how to improve the hitting precision of the power-on guided ammunition after launching becomes a research hotspot. The strapdown inertial navigation system is an autonomous navigation system, can completely and autonomously provide continuous and complete navigation information, has strong external interference resistance and good short-term stability, basically does not influence the navigation precision by carrier mobility, has higher relative navigation precision, but has the problem that the navigation parameter error is accumulated along with time. The accurate guided munition using GNSS/SINS combined navigation not only has the advantages of high GNSS accuracy and strong SINS anti-jamming capability, but also can avoid the problems that the satellite signal is easy to interfere or lose and the trajectory can not be detected continuously when the GNSS is used alone to detect the trajectory, and the error accumulation exists when the SINS is used alone to detect the trajectory, so that the accurate guided munition is more and more applied to guided munitions.
The GNSS/SINS combined navigation system applied to guided munitions such as guided munitions is generally required to bear severe conditions such as high overload and high rotating speed in the launching process of a conventional platform, and both the SINS and the GNSS cannot work normally in the launching process. Thus, the SINS requires aerial alignment in a pitch stabilized or low speed rotating flight after the carrier enters the controlled segment. Through two stages of rough alignment and fine alignment, more accurate attitude information and inertial error information can be obtained, so that the ballistic parameters can be accurately calculated according to the alignment parameters in the ballistic correction process of the projectile, and the ballistic correction task can be reliably completed. However, when the SINS is aligned in the air, because the moment of guiding the projectile to be launched is subjected to great overload impact in the bore, the SINS cannot be electrified during launching, the initial alignment is not carried out before launching, the SINS normally works after the projectile is delivered out of the muzzle, and the projectile is in a rolling state in the bore, so that the rolling angle of the projectile after the projectile is delivered out of the muzzle is unknown, and the difficulty is brought to the air alignment of the SINS.
At present, in the aspect of research on initial roll angle, geomagnetic navigation and platform type inertial navigation are more applied. However, the geomagnetic measurement has a blind area and needs other navigation methods for assistance; the platform type inertial navigation has larger volume and higher cost, and is not suitable for being applied to low-cost guided munitions. In addition, the MEMS gyroscope in the rolling direction has the problems of high accuracy, small time-measuring range, and large measuring range, and low accuracy.
Disclosure of Invention
Technical problem to be solved
The invention aims to solve the technical problems that a rolling angle real-time estimation method based on a least square method is provided to overcome the problems that a blind area exists in magnetic measurement during the rolling angle measurement, a platform type inertial navigation device is large in size and high in cost, an MEMS gyroscope in a rolling direction is high in precision, small in time-measuring range and low in time-measuring precision, and a strapdown inertial navigation system has error accumulation.
(II) technical scheme
In order to solve the technical problem, the invention provides a roll angle real-time estimation method based on a least square method, which is characterized by comprising the following steps of:
step one, obtaining the shape as Z according to a ballistic equation2×1=H2×2·X2×1A matrix equation of (c); the matrix equation is
Wherein the content of the first and second substances,is the output of the y-axis and z-axis of the two-axis gyroscope,Andthe pitch angle, pitch angle speed and yaw angle speed of the projectile body are respectively, and gamma is the rolling angle of the projectile body;
estimating the pitch angle theta and the pitch angle speed of the projectile body at n sampling moments according to the satellite navigation dataAnd yaw rateCombining the data of the dual-axis gyroscope to obtain the shape of Z2n×1=H2n×2·X2×1A matrix equation of (c);
step three, obtaining X containing roll angle information according to the matrix equation of the step two2×1Least squares estimation of (d);
step four, according to X2×1And determining the roll angle gamma by the least square estimation and the roll angle range.
Further, the first step specifically includes:
from the ballistic equation, a system of equations can be obtained:
arranging into a matrix form to obtain:
wherein the content of the first and second substances,for the outputs of the y-axis and z-axis of the two-axis gyroscope, andthe pitch angle, pitch angle speed and yaw angle speed of the projectile body are respectively, and r is the roll angle of the projectile body.
Further, Z is2n×1Z for n sampling instants2×1Are combined in sequence to form H2n×2H for n sampling instants2×2Are combined in sequence.
Further, the third step specifically includes:
to make it possible to
Can obtain X2×1The least squares estimate of (d) is:
wherein Z is Z in the second step2n×1H is H in the second step2n×2,Is X2×1Is estimated by least squares.
Further, the roll angle γ is calculated by the formula:
wherein X (1) and X (2) are X2×1Least squares estimation ofThe first term and the second term of (1).
Further, the roll angle γ has a value range as follows:
(III) advantageous effects
The invention provides a rolling angle real-time estimation method based on a least square method, which obtains a shape like Z according to a trajectory equation2×1=H2×2·X2×1A matrix equation of (c); estimating the pitch angle theta and the pitch angle speed of the projectile body at n sampling moments according to satellite navigation dataYaw rateCombining the two-axis gyroscope data to obtain the shape z2n×1=H2n×2·X2×1A matrix equation of (c); obtaining X containing roll angle information according to the matrix equation of the second step2×1Least squares estimation of (d); according to X2×1And determining the roll angle gamma by the least square estimation and the roll angle range. The roll angle obtained by the method provided by the invention has high precision and meets the requirement of further precise alignment; in addition, the method adopts satellite navigation data to assist in roll angle estimation, and estimates the roll angle in real time by a least square method, so that the error accumulation problem of a strapdown inertial navigation system is effectively avoided, and the accuracy of the roll angle estimation result is higher; in addition, the invention adopts the y-axis and z-axis outputs of the dual-axis gyroscope to estimate the roll angle, thereby effectively solving the problems of high precision, small time-measuring range and low precision of the MEMS gyroscope on the x axis of the roll direction due to the over-high rotating speed of the projectile body.
Drawings
FIG. 1 is a rolling angle estimation result obtained by simulation analysis in Matlab according to the rolling angle real-time on-line estimation method based on the least square method of the present invention;
FIG. 2 shows the rolling angle estimation error obtained by simulation analysis in Matlab according to the present invention;
FIG. 3 is a rolling angle real-time online estimation method based on the least square method, which performs semi-physical simulation on a turntable to obtain a rolling angle estimation result;
FIG. 4 shows the estimated roll angle error obtained from the semi-physical simulation of the present invention.
Detailed Description
In order to make the objects, contents, and advantages of the present invention clearer, the following detailed description of the embodiments of the present invention will be made in conjunction with the accompanying drawings and examples.
The embodiment provides a roll angle real-time online estimation method based on a least square method, which comprises the following steps:
step one, obtaining the shape as Z according to a ballistic equation2×1=H2×2·X2×1A matrix equation of (c);
from the ballistic equation, a system of equations can be obtained:
arranging into a matrix form to obtain:
wherein the content of the first and second substances,is the output of the y-axis and z-axis of the two-axis gyroscope,Andthe pitch angle, pitch angle velocity and yaw angle velocity of the projectile body are respectively, and gamma is the roll angle of the projectile body.
Estimating the pitch angles of the projectiles at n sampling moments according to the satellite navigation dataPitch angular velocityAnd yaw rateCombining the data of the dual-axis gyroscope to obtain the shape of Z2n×1=H2n×2·X2×1And (4) matrix equation. Wherein, the sampling interval can be self-defined according to actual requirements, Z2n×1Z for n sampling instants2×1Are combined in sequence to form H2n×2H for n sampling instants2×2Are combined in sequence.
Step three, obtaining X containing roll angle information according to the matrix equation of the step two2×1Least squares estimation of (d);
to make it possible to
Can obtain X2×1The least squares estimate of (d) is:
wherein Z is Z obtained in the second step2n×1H is H obtained in the second step2n×2,Is X2×1Is estimated by least squares.
Step four, according to X2×1And determining the roll angle gamma by the least square estimation and the roll angle range.
The roll angle γ is calculated as:
wherein X (1) and X (2) are X2×1Least squares estimation ofThe first term and the second term of (1).
The roll angle γ is given by the following formula:
the real-time online rolling angle estimation method based on the least square method is subjected to simulation analysis in Matlab to obtain the rolling angle estimation result shown in FIG. 1 and the rolling angle estimation error shown in FIG. 2. It can be seen from fig. 2 that the roll angle error estimated based on the least square method is stable in the whole flight time of the projectile, the error fluctuates up and down within a range of +/-4 degrees, and the fluctuation range is smaller and smaller, so that the requirement of inertial navigation fine alignment on the roll angle estimation accuracy is met.
According to the rolling angle real-time online estimation method based on the least square method, provided by the invention, a semi-physical simulation experiment is carried out on the rolling angle real-time online estimation method. The experiment uses the biax revolving stage, is fixed in the revolving stage center with MIMU, lets the revolving stage rotate with fixed rotational speed simultaneously, does the pitch motion with the pitch angle rate that changes. The result of the roll angle estimation shown in fig. 3 and the roll angle estimation error shown in fig. 4 are obtained. As can be seen from the rolling angle error of FIG. 4, when the rotating speed of the turntable is 3r/s, the error range is within the range of +/-4 degrees, and the experimental result shows that the estimation method can maintain better performance under the condition of high rotating speed.
The above description is only a preferred embodiment of the present invention, and it should be noted that, for those skilled in the art, several modifications and variations can be made without departing from the technical principle of the present invention, and these modifications and variations should also be regarded as the protection scope of the present invention.
Claims (6)
1. A roll angle real-time estimation method based on a least square method is characterized by comprising the following steps:
step one, obtaining the shape as Z according to a ballistic equation2×1=H2×2·X2×1A matrix equation of (c); the matrix equation is
Wherein the content of the first and second substances,is the output of the y-axis and z-axis of the two-axis gyroscope,Andthe pitch angle, pitch angle speed and yaw angle speed of the projectile body are respectively, and gamma is the rolling angle of the projectile body;
estimating the pitch angle theta and the elevation angle speed of the projectile body at n sampling moments according to the satellite navigation dataAnd yaw rateCombining the data of the dual-axis gyroscope to obtain the shape of Z2n×1=H2n×2·X2×1A matrix equation of (c);
step three, obtaining X containing roll angle information according to the matrix equation of the step two2×1Least squares estimation of (d);
step four, according to X2×1And determining the roll angle gamma by the least square estimation and the roll angle range.
2. The method for real-time estimation of roll angle based on least square method as claimed in claim 1, wherein said step one includes:
from the ballistic equation, a system of equations can be obtained:
arranging into a matrix form to obtain:
3. The method of claim 1 for real-time estimation of roll angle based on least squares, wherein Z is2n×1Z for n sampling instants2×1Are combined in sequence to form H2n×2H for n sampling instants2×2Are combined in sequence.
4. The method for estimating roll angle in real time based on least square method as claimed in any one of claims 1-3, wherein the third step specifically comprises:
to make it possible to
Can obtain X2×1The least squares estimate of (d) is:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010358933.3A CN111504256A (en) | 2020-04-29 | 2020-04-29 | Roll angle real-time estimation method based on least square method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010358933.3A CN111504256A (en) | 2020-04-29 | 2020-04-29 | Roll angle real-time estimation method based on least square method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111504256A true CN111504256A (en) | 2020-08-07 |
Family
ID=71876566
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010358933.3A Pending CN111504256A (en) | 2020-04-29 | 2020-04-29 | Roll angle real-time estimation method based on least square method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111504256A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112386209A (en) * | 2020-10-08 | 2021-02-23 | 哈尔滨工业大学 | Positioning precision improving method based on movable magnetic gradiometer |
CN114199077A (en) * | 2020-11-10 | 2022-03-18 | 北京信息科技大学 | Trajectory correction electronic cabin and control method and device thereof |
CN114964224A (en) * | 2022-04-19 | 2022-08-30 | 北京自动化控制设备研究所 | Micro inertial navigation system error autonomous inhibition method |
CN116150552A (en) * | 2023-02-20 | 2023-05-23 | 北京自动化控制设备研究所 | Method for calculating initial attitude of guided projectile |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101561281A (en) * | 2009-05-19 | 2009-10-21 | 北京星箭长空测控技术股份有限公司 | Working method of strap-down magnetic inertia combination system |
CN103115604A (en) * | 2013-01-18 | 2013-05-22 | 北京理工大学 | Method for measuring roll angle of guided cartridge based on scanning laser beams |
CN104345326A (en) * | 2013-07-24 | 2015-02-11 | 古野电气株式会社 | Method and apparatus for calculating status, and movable body |
CN105115508A (en) * | 2015-08-27 | 2015-12-02 | 北京航天控制仪器研究所 | Post data-based rotary guided projectile quick air alignment method |
CN105184109A (en) * | 2015-10-27 | 2015-12-23 | 中国人民解放军国防科学技术大学 | Trajectory boosting segment state deviation parsing and calculating method under action of disturbance gravitation |
CN105424060A (en) * | 2015-11-18 | 2016-03-23 | 湖北航天技术研究院总体设计所 | Method for measuring installation errors of star sensor and strapdown inertial measurement unit of aircraft |
CN109059914A (en) * | 2018-09-07 | 2018-12-21 | 东南大学 | A kind of shell roll angle estimation method based on GPS and least squares filtering |
CN110044321A (en) * | 2019-03-22 | 2019-07-23 | 北京理工大学 | The method for resolving attitude of flight vehicle using Geomagnetism Information and angular rate gyroscope |
-
2020
- 2020-04-29 CN CN202010358933.3A patent/CN111504256A/en active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101561281A (en) * | 2009-05-19 | 2009-10-21 | 北京星箭长空测控技术股份有限公司 | Working method of strap-down magnetic inertia combination system |
CN103115604A (en) * | 2013-01-18 | 2013-05-22 | 北京理工大学 | Method for measuring roll angle of guided cartridge based on scanning laser beams |
CN104345326A (en) * | 2013-07-24 | 2015-02-11 | 古野电气株式会社 | Method and apparatus for calculating status, and movable body |
CN105115508A (en) * | 2015-08-27 | 2015-12-02 | 北京航天控制仪器研究所 | Post data-based rotary guided projectile quick air alignment method |
CN105184109A (en) * | 2015-10-27 | 2015-12-23 | 中国人民解放军国防科学技术大学 | Trajectory boosting segment state deviation parsing and calculating method under action of disturbance gravitation |
CN105424060A (en) * | 2015-11-18 | 2016-03-23 | 湖北航天技术研究院总体设计所 | Method for measuring installation errors of star sensor and strapdown inertial measurement unit of aircraft |
CN109059914A (en) * | 2018-09-07 | 2018-12-21 | 东南大学 | A kind of shell roll angle estimation method based on GPS and least squares filtering |
CN110044321A (en) * | 2019-03-22 | 2019-07-23 | 北京理工大学 | The method for resolving attitude of flight vehicle using Geomagnetism Information and angular rate gyroscope |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112386209A (en) * | 2020-10-08 | 2021-02-23 | 哈尔滨工业大学 | Positioning precision improving method based on movable magnetic gradiometer |
CN112386209B (en) * | 2020-10-08 | 2022-12-06 | 哈尔滨工业大学 | Positioning precision improving method based on movable magnetic gradiometer |
CN114199077A (en) * | 2020-11-10 | 2022-03-18 | 北京信息科技大学 | Trajectory correction electronic cabin and control method and device thereof |
CN114964224A (en) * | 2022-04-19 | 2022-08-30 | 北京自动化控制设备研究所 | Micro inertial navigation system error autonomous inhibition method |
CN114964224B (en) * | 2022-04-19 | 2023-11-03 | 北京自动化控制设备研究所 | Error autonomous suppression method for micro inertial navigation system |
CN116150552A (en) * | 2023-02-20 | 2023-05-23 | 北京自动化控制设备研究所 | Method for calculating initial attitude of guided projectile |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111504256A (en) | Roll angle real-time estimation method based on least square method | |
CN105606094B (en) | A kind of information condition matched filtering method of estimation based on MEMS/GPS combined systems | |
US20120104150A1 (en) | Projectile 3d attitude from 3-axis magnetometer and single-axis accelerometer | |
CN109373833B (en) | Combined measurement method suitable for initial attitude and speed of spinning projectile | |
CN109373832B (en) | Method for measuring initial parameters of rotating projectile muzzle based on magnetic rolling | |
CN105180728B (en) | Front data based rapid air alignment method of rotary guided projectiles | |
CN105486307B (en) | For the line-of-sight rate by line method of estimation of maneuvering target | |
CN105258698A (en) | Midair integrated navigation method for high-dynamic spinning guided cartridge | |
CN107883940A (en) | A kind of guided cartridge high dynamic attitude measurement method | |
CN105115508A (en) | Post data-based rotary guided projectile quick air alignment method | |
CN109724624A (en) | A kind of airborne adaptive Transfer alignment algorithm suitable for wing flexure deformation | |
CN110615104A (en) | Unmanned aerial vehicle weapon platform stable aiming control method | |
CN105241319B (en) | A kind of guided cartridge of spin at a high speed real-time alignment methods in the air | |
CN110007318B (en) | Method for judging GPS deception by single unmanned aerial vehicle based on Kalman filtering under wind field interference | |
CN113359856B (en) | Unmanned aerial vehicle designated course target point guiding method and system | |
CN110160519A (en) | Body attitude calculation method for pulse shape modification rocket projectile | |
CN109579833A (en) | A kind of Combinated navigation method in the vertical landing stage to recoverable carrier rocket | |
CN112445230B (en) | High-dynamic aircraft multi-mode guidance system and guidance method under large-span complex environment | |
CN112325841A (en) | Method for estimating installation error angle of communication-in-motion antenna | |
Bin et al. | Attitude dynamics aiding for line-of-sight angular rate reconstruction of strap-down seeker | |
CN114383603B (en) | Guided projectile aerial attitude identification method based on rotation modulation method | |
CN115685778A (en) | Radar-seeking aircraft miss distance estimation method based on radio frequency semi-physical simulation | |
CN113218423A (en) | Aerial coarse alignment method without reference attitude information during transmitting | |
CN105352528B (en) | A kind of ins error online compensation method applied to ballistic missile | |
CN109813302B (en) | Method for quickly determining optimal available navigation satellite |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200807 |