CN111123972B - Inertial measurement combined rotation modulation method based on course angle tracking - Google Patents

Inertial measurement combined rotation modulation method based on course angle tracking Download PDF

Info

Publication number
CN111123972B
CN111123972B CN201911230138.XA CN201911230138A CN111123972B CN 111123972 B CN111123972 B CN 111123972B CN 201911230138 A CN201911230138 A CN 201911230138A CN 111123972 B CN111123972 B CN 111123972B
Authority
CN
China
Prior art keywords
inertial measurement
inertial
psi
measurement unit
rotation
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
CN201911230138.XA
Other languages
Chinese (zh)
Other versions
CN111123972A (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 Aerospace Era Laser Navigation Technology Co ltd
Original Assignee
Beijing Aerospace Era Laser Navigation Technology Co ltd
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 Aerospace Era Laser Navigation Technology Co ltd filed Critical Beijing Aerospace Era Laser Navigation Technology Co ltd
Priority to CN201911230138.XA priority Critical patent/CN111123972B/en
Publication of CN111123972A publication Critical patent/CN111123972A/en
Application granted granted Critical
Publication of CN111123972B publication Critical patent/CN111123972B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • 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/165Navigation; 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

The invention relates to an inertial measurement combined rotation modulation method based on course angle tracking, which comprises the following steps: 1) Electrifying the inertial set to keep the inertial instrument in a normal running state; 2) Sending a navigation instruction to an inertial measurement unit, and enabling a system to enter an initial alignment state; 3) Acquiring inertial measurement unit initial position heading angle psi after alignment 0 And the initial heading angle psi 0 Transmitting to a rotation control system; 4) And the inertial measurement unit enters a navigation state and starts to perform rotation modulation based on course angle tracking. The invention inhibits the horizontal error in the inertial navigation unit navigation process by rotation modulation, thereby improving the navigation precision.

Description

Inertial measurement combined rotation modulation method based on course angle tracking
Technical Field
The invention relates to a rotation modulation method in a strapdown inertial measurement combined navigation process, in particular to a strapdown inertial measurement combined rotation modulation method based on course angle tracking.
Background
The strapdown inertial measurement unit (abbreviated as an inertial measurement unit) is widely applied to the technical field of civil and military navigation due to the advantages of small volume, light weight, strong autonomy, comprehensive output parameters and the like, and the performance of the whole navigation system is often determined by the accuracy of the inertial measurement unit. Therefore, it is the focus of modern navigation technology research to improve the performance of the navigation system, i.e. improve the inertial measurement unit precision. There are two aspects of cut-in points in improving the navigation accuracy of the inertial navigation unit: firstly, the precision of an inertia device is improved; and secondly, compensating or eliminating the influence of the error of the inertial device on the navigation precision by an error compensation technology. The rotation modulation technology is an error compensation technology for the inertial measurement unit, the technology controls the inertial measurement unit to rotate according to a certain rotation scheme in a fixed period in the navigation process through a mechanical device, and navigation errors caused by errors of inertial measurement unit devices can be effectively inhibited through rotation and calculation, so that the precision of a navigation system is improved. The following problems tend to exist for conventional rotational modulation techniques:
(1) The common inertial measurement unit can complete rotation modulation only through a rotating mechanism, and the rotating mechanism usually comprises a series of components such as a rotating motor, a rotating shaft, a rotating frame, a sensor and a controller. Both excessive angular overshoots and speed fluctuations during rotation have a negative effect on the error suppression of the rotation modulation.
(2) In the rotation modulation technique, the rotation mechanism rotates according to a specified rotation scheme relative to the geographic coordinate system, but when the rotation mechanism is actually controlled in the inertial set, all the indexing control is relative to the inertial set coordinate system. Therefore, if the inertial set makes angular motion relative to the geographic coordinate system, the motion of the rotating mechanism relative to the geographic coordinate system is not completely the same as the design of the rotating scheme, so that an error of the inertial device cannot be modulated completely and effectively, and even an error compensation effect of the rotation modulation can be completely counteracted under the condition of large angular motion of the inertial set.
A single-axis rotation modulation technology is adopted in the positioning and orientation project, so that the inertial unit rotates around the zenith axis in a regular and continuous reciprocating manner, the device error in the horizontal direction is modulated, and the modulation effect is optimal after the whole rotation period is completed. In practical application, the course of the vehicle changes when the vehicle turns, the starting point and the ending point in the rotation period of the inertial set change compared with the initial moment of the inertial set, and the modulation effect is influenced.
Disclosure of Invention
The invention solves the technical problems that: the method overcomes the defects of the prior art, provides the inertial measurement combination rotation modulation method based on course angle tracking, and inhibits the horizontal error in the navigation process of the inertial measurement unit through rotation modulation, thereby improving the navigation precision.
The technical scheme of the invention is as follows: an inertial measurement combined rotation modulation method based on course angle tracking comprises the following steps:
1) Electrifying the inertial set to keep the inertial instrument in a normal running state;
2) Sending a navigation instruction to an inertial measurement unit, and enabling a system to enter an initial alignment state;
3) Acquiring inertial measurement unit initial position heading angle psi after alignment 0 And the initial heading angle psi 0 Transmitting to a rotation control system;
4) The inertial measurement unit enters a navigation state and starts to carry out rotation modulation based on course angle tracking;
the rotation modulation process is specifically as follows:
(41) The inertial measurement unit enters a navigation state, and the horizontal axis of the inertial measurement unit is positioned from an initial position P in the navigation process 0 Rotated clockwise 360 DEG to P' 0 Then rotates counterclockwise by 360 degrees to P 0 Circularly and reciprocally performing rotary modulation; the inertial measurement unit moves along with the carrier, the course angle psi is updated in real time, and the course angle psi of the inertial measurement unit is transmitted to the rotation control system in real time;
(42) The rotation control system is based on the received psi 0 And psi, calculating to obtain the difference value delta psi = psi-psi between the current inertial measurement combination position heading angle and the initial position heading angle 0
(43) Rotating deviceThe dynamic control system calculates and obtains new transposition information P according to the heading angle difference delta psi 0 + delta psi and P' 0 +Δψ;
(44) The rotation control system calculates and obtains the angle difference value delta P = P between the current position alpha of the horizontal shaft of the inertial measurement unit and the calculated transposition 0 +Δψ-α;
(45) The rotation control system calculates the control quantity of the rotation motor through a PID control algorithm according to the angle difference value
Figure BDA0002303319730000031
k p ,k i ,k d PID control parameters;
(46) The rotating motor drives the inertial measurement unit to rotate to the calculated transposition according to the control quantity;
(47) Repeating the step (41) to the step (46), and judging whether the inertial unit rotates to the calculated transposition position; if not, returning to the step (44); if so, jumping to step 48);
(48) After reaching the appointed transposition, the rotary modulation device turns to the next rotary modulation position.
The invention has the beneficial effects that:
(1) The joint working mode of the rotation control system and the navigation system is that the rotation control system and the navigation system are in real-time communication;
(2) Through the real-time communication between the rotation control system and the navigation system, the initial position of the rotation period in the rotation modulation process can be corrected in real time according to the course angle sent by the navigation system so as to keep the initial position always the same as the initial position in the geographic coordinate system, so that the rotation debugging effect can still exert the optimal effect when the inertial measurement unit has horizontal angular motion;
(3) The inertial measurement unit applying the rotation modulation method can effectively eliminate errors in the horizontal direction in the navigation process, and brings better navigation precision.
Drawings
FIG. 1 is a flow chart of the rotation modulation method with real-time tracking of course angle according to the present invention.
FIG. 2 is a block diagram of information communication between a navigation system and a rotational control system.
Detailed Description
Selecting one shaft in a two-shaft rotating mechanism of a strapdown inertial measurement unit (called an inertial measurement unit for short) according to the final installation position of the strapdown inertial measurement unit to carry out single-shaft rotation modulation, controlling the single-shaft rotating mechanism to drive the inertial measurement unit to rotate in a motion mode by an inertial measurement unit rotation control system according to sensor information returned by the inertial measurement unit and an angle sensor, and finally realizing that the rotation of the inertial measurement unit rotates relative to a rotation center shaft plane in a rotation period of a geographic coordinate system, and a terminal point of the inertial measurement unit is consistent with a shaft plane at the initial time of the inertial measurement unit and rotates back and forth around the shaft plane in any horizontal angular motion process by correcting a course angle sent by a navigation system in real time by the rotation control system. As shown in fig. 1, the rotational modulation for course angle tracking includes the following steps:
(1) Navigation system completes initial alignment to acquire heading angle psi of initial position 0 And sending the initial heading angle to a rotation control system (as shown in fig. 2);
(2) After initial alignment, the inertial measurement unit enters a navigation working state, a rotation control system performs rotation modulation according to a set rotation modulation scheme in the navigation process, and the transposition information of the rotation modulation scheme is arranged as follows:
21. obtaining an initial value psi of inertial measurement unit course angle when alignment is finished 0 When the carrier and the inertial set rotating mechanism are kept static, the rotation control system records the position information of the inertial set rotating mechanism at the moment and records the position information as a rotation modulation initial position P 0
22. With P 0 Is a primary position rotating mechanism rotates clockwise by 360 degrees to P' 0 Noted as a second position;
23. from P' 0 The second position rotates anticlockwise by 360 degrees and returns to the initial position P 0
24. Repeating steps 22-23;
(3) The inertial navigation system acquires a current position heading angle psi in real time and sends the current position heading angle psi to the rotation control system;
(4) And the rotation control system corrects the position of the rotating central axis according to the real-time course angle information sent by the navigation system, so that the central axis modulated by the rotation of the inertial measurement unit is always consistent with the initial course angle.
The invention has the following implementation steps:
1) Electrifying the inertial set to keep the inertial instrument in a normal running state;
2) Sending a navigation instruction to an inertial measurement unit, and enabling a system to enter an initial alignment state;
3) Acquiring inertial measurement unit initial position course angle psi after alignment 0 And the initial heading angle psi 0 And (2) transmitting the data to a rotation control system, wherein the rotation control system is used for setting corresponding rotation modulation indexes, and the indexes are set as follows (shown in figure 1):
31. obtaining an initial value psi of inertial measurement unit course angle when the alignment is finished 0 When the carrier and the inertial set rotating mechanism are kept static, the rotation control system records the position information of the inertial set rotating mechanism at the moment and records the position information as a rotation modulation initial position P 0
32. With P 0 Is a primary position rotating mechanism rotates clockwise by 360 degrees to P' 0 Recording as a second position;
33. from P' 0 The second position rotates counterclockwise 360 DEG back to the initial position P 0
34. Repeating steps 32-33;
4) And then the inertial measurement unit enters a navigation state, and rotation modulation based on course angle tracking is started, wherein the rotation modulation process specifically comprises the following steps:
(41) The inertial measurement unit enters a navigation state, the inertial measurement unit carries out rotation modulation according to the rotation scheme shown in 3) in the navigation process, the heading angle psi is updated in real time, and the heading angle psi of the inertial measurement unit is transmitted to a rotation control system in real time;
(42) The rotation control system is based on the received psi 0 And psi, calculating to obtain the difference value delta psi = psi-psi between the current inertial measurement combination position course angle and the initial position course angle 0
(43) The rotation control system calculates new transposition information P according to the course angle difference value 0 + delta psi and P' 0 + Δ ψ; the rotation control system calculates and obtains the angle difference value delta P = P between the current position alpha of the horizontal shaft of the inertial measurement unit and the calculated transposition 0 +Δψ-α;
(44) The rotation control system calculates the current position alpha of the horizontal shaft of the inertial measurement unit and calculates the backward rotationAngular difference of bits Δ P = P 0 +Δψ-α;
(45) The rotation control system calculates the control quantity of the rotation motor through a PID control algorithm according to the angle difference value
Figure BDA0002303319730000051
k p ,k i ,k d For PID control parameter, adopt KI control in this scheme, the control parameter sets up to: k is a radical of p =9.5,k i =0.01,k d =0;
(46) The rotating motor drives the inertial measurement unit to rotate to the calculated transposition P according to the control quantity 0 + delta psi and P' 0 +Δψ;
(47) Repeating the step (41) to the step (46), and judging whether the inertial measurement unit rotates to the calculated transposition position; if not, repeating 44-47; if so, jumping to step 48 (shown in FIG. 1);
(48) After reaching the designated index, the next rotary modulation position is turned and 41-48 are repeated.

Claims (1)

1. An inertial measurement combination rotation modulation method based on course angle tracking is characterized by comprising the following steps:
1) Electrifying the inertial set to keep the inertial instrument in a normal running state;
2) Sending a navigation instruction to an inertial measurement unit, and enabling a system to enter an initial alignment state;
3) Acquiring inertial measurement unit initial position heading angle psi after alignment 0 And the initial heading angle psi 0 Transmitting to a rotation control system;
4) The inertial measurement unit enters a navigation state and starts to carry out rotation modulation based on course angle tracking;
the rotation modulation process is specifically as follows:
(41) The inertial unit enters a navigation state, and the horizontal axis of the inertial unit is positioned from an initial position P in the navigation process 0 Rotated clockwise 360 DEG to P' 0 Then rotates counterclockwise by 360 DEG to P 0 Circularly and reciprocally performing rotary modulation; the inertial group moves along with the carrier, the course angle psi is updated in real time, and the course angle psi of the inertial group is realThe time is transmitted to a rotation control system;
(42) The rotation control system is based on the received psi 0 And psi, calculating to obtain the difference value delta psi = psi-psi between the current inertial measurement combination position course angle and the initial position course angle 0
(43) The rotation control system calculates to obtain new transposition information P according to the heading angle difference delta psi 0 + delta psi and P' 0 +Δψ;
(44) The rotation control system calculates the current position alpha of the horizontal shaft of the inertial measurement unit and the angle difference delta P = P of the calculated transposition 0 +Δψ-α;
(45) The rotation control system calculates the control quantity of the rotation motor through a PID control algorithm according to the angle difference value
Figure QLYQS_1
k p ,k i ,k d PID control parameters;
(46) The rotating motor drives the inertial measurement unit to rotate to the calculated transposition according to the control quantity;
(47) Repeating the step (41) to the step (46), and judging whether the inertial measurement unit rotates to the calculated transposition position; if not, returning to the step (44); if in place, go to step 48);
(48) After reaching the appointed indexing position, the rotary drum rotates to the next rotary modulation position.
CN201911230138.XA 2019-12-04 2019-12-04 Inertial measurement combined rotation modulation method based on course angle tracking Active CN111123972B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911230138.XA CN111123972B (en) 2019-12-04 2019-12-04 Inertial measurement combined rotation modulation method based on course angle tracking

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911230138.XA CN111123972B (en) 2019-12-04 2019-12-04 Inertial measurement combined rotation modulation method based on course angle tracking

Publications (2)

Publication Number Publication Date
CN111123972A CN111123972A (en) 2020-05-08
CN111123972B true CN111123972B (en) 2023-04-14

Family

ID=70497374

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911230138.XA Active CN111123972B (en) 2019-12-04 2019-12-04 Inertial measurement combined rotation modulation method based on course angle tracking

Country Status (1)

Country Link
CN (1) CN111123972B (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102033546A (en) * 2010-11-09 2011-04-27 上海交通大学 Low-altitude airship flight control system and flight control method thereof
CN102589547A (en) * 2012-03-22 2012-07-18 哈尔滨工程大学 Electric control rotating platform and position measuring method for inertial navigation instrument
CN102620734A (en) * 2012-04-09 2012-08-01 北京自动化控制设备研究所 Single-axis rotating micro-mechanical inertial navigation modulation method
CN103900607A (en) * 2014-03-06 2014-07-02 哈尔滨工程大学 Rotation type strapdown inertial navigation system transposition method based on inertial system
CN104482941A (en) * 2014-12-08 2015-04-01 河北汉光重工有限责任公司 Systematic compensation method of fixed-precision navigation of ship optical inertial navigation system when in long voyage
CN105588565A (en) * 2016-03-08 2016-05-18 哈尔滨工程大学 Strapdown inertial navigation system double-shaft rotation modulation method based on redundancy configuration
CN108195400A (en) * 2017-12-22 2018-06-22 清华大学 The moving alignment method of strapdown micro electro mechanical inertia navigation system

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7900725B2 (en) * 2002-06-11 2011-03-08 Segway Inc. Vehicle control by pitch modulation
US9274136B2 (en) * 2013-01-28 2016-03-01 The Regents Of The University Of California Multi-axis chip-scale MEMS inertial measurement unit (IMU) based on frequency modulation
US10281930B2 (en) * 2016-07-25 2019-05-07 Qualcomm Incorporated Gimbaled universal drone controller
US11300958B2 (en) * 2017-07-13 2022-04-12 Waymo Llc Sensor adjustment based on vehicle motion
US10447973B2 (en) * 2017-08-08 2019-10-15 Waymo Llc Rotating LIDAR with co-aligned imager

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102033546A (en) * 2010-11-09 2011-04-27 上海交通大学 Low-altitude airship flight control system and flight control method thereof
CN102589547A (en) * 2012-03-22 2012-07-18 哈尔滨工程大学 Electric control rotating platform and position measuring method for inertial navigation instrument
CN102620734A (en) * 2012-04-09 2012-08-01 北京自动化控制设备研究所 Single-axis rotating micro-mechanical inertial navigation modulation method
CN103900607A (en) * 2014-03-06 2014-07-02 哈尔滨工程大学 Rotation type strapdown inertial navigation system transposition method based on inertial system
CN104482941A (en) * 2014-12-08 2015-04-01 河北汉光重工有限责任公司 Systematic compensation method of fixed-precision navigation of ship optical inertial navigation system when in long voyage
CN105588565A (en) * 2016-03-08 2016-05-18 哈尔滨工程大学 Strapdown inertial navigation system double-shaft rotation modulation method based on redundancy configuration
CN108195400A (en) * 2017-12-22 2018-06-22 清华大学 The moving alignment method of strapdown micro electro mechanical inertia navigation system

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
V.P. Petkov ; B.E. Boser.A fourth-order /spl Sigma//spl Delta/ interface for micromachined inertial sensors.《IEEE Journal of Solid-State Circuits 》.2005,第40卷(第40期),全文. *
刘建 ; 王玮 ; .旋转型惯导系统自标定中的电机控制.自动化与仪表.2013,(第10期),全文. *
彭惠,等.旋转调制惯导用转位机构及高精度控制技术.《现代防御技术》.2018,第46卷(第46期),全文. *
车晓蕊 ; 李杰 ; 马喜宏 ; 邹姗蓉 ; 张艳艳 ; 张佳宇 ; .一种冗余配置的单轴旋转式微惯导系统设计.科学技术与工程.2018,(第15期),全文. *
邓志红 ; 蔡山波 ; 王博 ; 付梦印 ; .一种旋转调制惯导系统的复合旋转控制算法.系统工程与电子技术.2016,第38卷(第11期),全文. *

Also Published As

Publication number Publication date
CN111123972A (en) 2020-05-08

Similar Documents

Publication Publication Date Title
CN111381217B (en) Missile-borne SAR motion compensation method based on low-precision inertial navigation system
CN108983672B (en) Control system applied to high-precision six-degree-of-freedom optical assembly adjusting mechanism
CN108333938B (en) Multi-closed-loop composite gyro stability control method
CN108052122A (en) A kind of method of the antenna tracking of boat-carrying communication in moving
CN102052921B (en) Method for determining initial heading of single-axis rotating strapdown inertial navigation system
CN109343539A (en) Motion control method, device, robot and storage medium
CN111123972B (en) Inertial measurement combined rotation modulation method based on course angle tracking
CN110388941A (en) A kind of vehicle attitude alignment methods based on adaptive-filtering
CN110388942A (en) A kind of vehicle-mounted posture fine alignment system based on angle and speed increment
US20210293583A1 (en) Method for checking the setting of an angular position sensor of a rotor for a vehicle
CN102564459B (en) Method for calibrating single-shaft-rotation modulation strapdown inertial navigation system at sea
CN112729332B (en) Alignment method based on rotation modulation
CN112697143B (en) High-precision carrier dynamic attitude measurement method and system
CN116047997A (en) RTCP compensation method and device for numerical control machine tool
CN112882378A (en) Method for improving stability precision of photoelectric turntable based on system identification
CN111831019B (en) Motor position data compensation method and motor control system
CN116465432A (en) Course error-based four-position horizontal gyro zero bias residual error compensation method
CN111024128A (en) Method for transmitting and aligning stable state of optical axis of airborne photoelectric pod
JP5658084B2 (en) Astronomical tracking system
US20210247768A1 (en) Method and system for controlling movement of a device
CN114187359A (en) Laser radar fixed pose calibration method and system based on pose increment constraint
CN114019954A (en) Course installation angle calibration method and device, computer equipment and storage medium
CN111123381B (en) Method for reducing horizontal acceleration influence for platform type gravimeter
CN113124881A (en) Fault recovery method of synchronous positioning and composition system based on magnetic beacon
CN110926503A (en) MEMS gyroscope calibration method capable of resisting stronger magnetic field interference

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