CN110057383B - Lever arm error calibration method of AUV (autonomous Underwater vehicle) push navigation system - Google Patents
Lever arm error calibration method of AUV (autonomous Underwater vehicle) push navigation system Download PDFInfo
- Publication number
- CN110057383B CN110057383B CN201910365817.1A CN201910365817A CN110057383B CN 110057383 B CN110057383 B CN 110057383B CN 201910365817 A CN201910365817 A CN 201910365817A CN 110057383 B CN110057383 B CN 110057383B
- Authority
- CN
- China
- Prior art keywords
- auv
- lever arm
- carrier
- coordinate system
- navigation system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
The invention relates to a lever arm error calibration method of an AUV (autonomous underwater vehicle) push navigation system, belonging to the field of underwater vehicles. Aiming at calibrating a lever arm error generated by a Doppler Velocity sonar (DVL) not being installed at an AUV mass center together with an AHRS (Attitude and Heading Reference System) in an AUV positioning navigation System, an error calibration model suitable for a Kalman filtering algorithm is constructed, and the length of the lever arm is identified by adopting a simple and feasible rotary motion mode. The method has the advantages that the requirement on inertial base navigation equipment is reduced because the AHRS is not required to provide heave information, the scheme has good universality, the method is suitable for solving the problem of lever arm length identification of various AUVs, and the positioning accuracy of the AUV positioning navigation system can be effectively improved through compensation of lever arm errors in the AUV positioning navigation system; meanwhile, the scheme can be directly obtained, the DVL, the AHRS and the center of mass (or the floating center) are not required to be positioned on the same straight line, namely, the corresponding lever arm length can be directly obtained no matter where the center of mass (the floating center) of the AUV is positioned, and the application prospect is wide.
Description
Technical Field
The invention relates to an AUV (Autonomous Underwater Vehicle) push navigation system lever arm error calibration method, belonging to the field of Underwater vehicles.
Background
An underwater locating navigation system composed of a DVL and an AHRS is an autonomous underwater navigation method commonly used by an AUV (autonomous underwater vehicle), wherein the DVL is theoretically installed on a rotation center of the AUV, but is limited by an AUV space, the DVL is usually far away from the rotation center of the AUV, a lever arm error exists, and the positioning accuracy of the locating navigation system is greatly influenced.
The invention designs a calibration method for lever arm errors of an AUV (autonomous Underwater vehicle) push navigation system, which improves the positioning accuracy of the AUV push navigation system by compensating the lever arm errors of the push navigation system.
A paper entitled "application and design of an H ∞ filter in compensation of the arm effect" published as 11/2009, employs H ∞ filtering to improve the accuracy of transfer alignment in the presence of flexural deformations in the length of the arm. However, the method needs the assistance of a high-precision inertial navigation system, the AUV generally adopts a low-cost commercial inertial unit, the length of the AUV hull is short, and the influence of deflection deformation on the error estimation of the lever arm is very small.
In the paper entitled "alignment lever arm error compensation algorithm between carrier advances" published in 2019, the length of a lever arm is measured by adopting a mechanical equation method, the lever arm is combined with an error model of a system to construct a Kalman state measurement equation, and the lever arm error identification of an inertial navigation system is realized by a 5-order CKF algorithm. However, the method is relatively large in calculated amount, high in requirement on the precision of the inertial element and not suitable for on-line arm lever error identification of the AUV position-pushing navigation system based on the low-cost commercial inertial unit.
Disclosure of Invention
The invention aims to solve the problem of lever arm error calibration in an AUV (autonomous underwater vehicle) positioning navigation system, and provides a lever arm error calibration method for the AUV positioning navigation system.
The invention aims to realize the calibration method of the lever arm error of the AUV (autonomous Underwater vehicle) push navigation system, which specifically comprises the following steps:
step 1, determining the motion mode of the AUV as rotary motion;
step 2, analyzing the system of the AUV rotary motion according to the characteristics of the AUV rotary motion, and constructing a lever arm error model suitable for a Kalman filtering algorithm;
step 3, determining system state quantity and observation quantity, constructing a state equation and an observation equation, and performing optimal estimation on the lever arm length of the AUV according to Kalman filtering;
and 4, calibrating positioning errors of the positioning navigation system caused by the lever arm effect according to the optimal estimation of the length of the AUV lever arm.
The invention also includes such structural features:
a lever arm error calibration method of an AUV (autonomous Underwater vehicle) push navigation system comprises the following steps in step 1:
step 1.1, DVL on AUV is positioned at the bow, and origin o of AUV carrying system b b Coincident with AUV centroid, x b The axis points to the bow direction of the boat b Axis perpendicular to x b Axis pointing in starboard direction, z b Axis perpendicular to x b -y b Plane, downward satisfying right hand rule, R CA The DVL mounting point is the distance from the center of mass under the carrier system, and the lever arm length vector isA lever arm error is present;
step 1.2, when the AUV navigates underwater, angular motion can be generated,output value of DVL in carrier coordinate system for point A, V bx At the point speed of A lineAlong a carrier coordinate system x b Component of the axis, V by At the point speed of A lineAlong the carrier coordinate system y b Component of the axis, ω bx ,ω by ,ω bz Angular velocities at points A, respectivelyProjection components in the carrier coordinate system;
step 1.3, origin o of azimuth follow-up horizontal coordinate system b b′ Coincident with the origin of the vector system b, x b′ The axial direction is consistent with the AUV heading and is y b′ Form a local horizontal coordinate system, z b′ The axis is vertical downwards, and the three meet the right-hand rule;
step 1.4, R is the radius of the rotation motion of the AUV in the azimuth follow-up coordinate system, the rotation motion direction of the AUV and z b′ The coordinate of the rotation radius under the azimuth follow-up horizontal coordinate system isAnd z b′ Shaft counter-clockwise rotationThe rotation time is negative, and the rotation radius is the coordinate under the azimuth follow-up horizontal coordinate systemGamma is the roll angle of AUV movement, and theta is the pitch angle of AUV movement.
A lever arm error calibration method of an AUV (autonomous Underwater vehicle) push navigation system comprises the following steps in step 2:
and 2.1, analyzing the rotary motion system, wherein when the AUV does not have rolling and pitching motions, the linear speed at the C point of the carrier coordinate system is as follows:whileSo under the carrier coordinate systemUnder the carrier system, the lever arm coordinate along the positive direction of the transverse rolling shaft of the carrier system of the AUV isLinear velocity error under the carrier system at point aIs composed of
Step 2.2, analyzing the rotary motion system, wherein pitching and rolling motions exist when the AUV does rotary motion, so that the rotary linear velocity of the AUV in the carrier coordinate system b isWhereinArranged under an orientation follow-up horizontal coordinate system R DC Has the coordinates ofThe rotational linear velocity of AUV under the carrier system isAnd alsoThe output value of the DVL, i.e., the a-point velocity, is thus expressed as:and the carrier system is b below R CA The coordinates of (a) are:namely, it isTo obtainSuppose that:to obtain
A lever arm error calibration method of an AUV (autonomous Underwater vehicle) push navigation system comprises the following steps in step 3:
step 3.1 Lever arm LengthWith [ R ] CA V by ] T And establishing a Kalman filtering equation as a state variable of the system, wherein the state equation is as follows:w is white Gaussian noise satisfying a zero-mean normal distribution, and the observation equation isv is white gaussian noise satisfying a zero-mean normal distribution;
step 3.2, carrying out lever arm length R in the AUV positioning navigation system according to Kalman filtering CA And carrying out optimal estimation.
A lever arm error calibration method of an AUV (autonomous Underwater vehicle) push navigation system, wherein the step 4 specifically comprises the following steps:
Step 4.2, according toThe velocity of the point A is obtainedBy compensating for speed error at point AObtaining the speed of C point line
Compared with the prior art, the invention has the beneficial effects that:
according to the method, the lever arm error between the DVL installation position and the AUV rotation central point in the underwater locating navigation system can be effectively identified by constructing the error calibration model suitable for the Kalman filtering algorithm, and the locating precision of the underwater locating navigation system is improved. The invention adopts a rotary motion mode to identify the length of the lever arm, and the scheme is simple and easy to implement; the heave information is not required to be provided by an AHRS (attitude and heading reference system), the requirement on inertial-based navigation equipment is reduced, the scheme is good in universality and suitable for solving the problem of lever arm length identification of various AUVs (autonomous underwater vehicles); meanwhile, the scheme can be directly obtained, the DVL, the AHRS and the center of mass (or the floating center) are not required to be positioned on the same straight line, namely the corresponding lever arm length can be directly obtained no matter where the center of mass (the floating center) of the AUV is positioned.
Drawings
FIG. 1 is a general flow chart of calibration of lever arm error of the AUV push navigation system;
FIG. 2 is a projection of the radius of rotation under the hull;
FIG. 3 is a schematic diagram of the velocity at different points of the AUV in the slewing motion;
FIG. 4 is a graphical illustration of the constant velocity error of the AUV, i.e., the lever arm error;
FIG. 5 is a schematic diagram of the DVL, AHRS and centroid not being collinear;
FIG. 6 is a simulation result of lever arm length estimation.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings and specific embodiments.
The invention relates to the field of underwater autonomous navigation, and provides a lever arm error calibration method suitable for an AUV (autonomous underwater vehicle) positioning navigation system. Aiming at the lever arm error generated by a Doppler Velocity sonar (DVL) not being installed at an AUV mass center together with an Attitude and Heading Reference System (AHRS) in an AUV positioning navigation System, an error calibration model suitable for a Kalman filtering algorithm is constructed, and the length of the lever arm is identified by adopting a simple and easy rotary motion mode. The method has the advantages that the AHRS is not needed to provide heaving information, the requirement on inertial base navigation equipment is reduced, the scheme universality is good, the method is suitable for solving the problem of lever arm length identification of various AUVs, and the positioning accuracy of the AUV positioning navigation system can be effectively improved by compensating the error of the lever arm in the AUV positioning navigation system.
Embodiment mode 1: the method for calibrating the lever arm error of the AUV positioning navigation system in the embodiment comprises the following steps:
(1) According to the cause of the lever arm error of the AUV push navigation system shown in FIG. 4, the DVL on the AUV is positioned at the bow, the installation position is far away from the rotation center of the AUV, and the lever arm error exists. When the AUV navigates underwater, angular motion cannot be avoided, and the DVL senses the linear speed on a circle with the rotation center as the origin and the distance from the mounting point to the rotation center as the radius, so that a navigation system of the AUV generates a constant speed error and a constant speed error; determining the motion mode of the AUV as rotary motion, and calibrating the lever arm error of the AUV pushing navigation system;
(2) Analyzing a system for performing rotary motion on the AUV; when the AUV does the rotary motion, the AUV has the pitching and rolling motions, and the length of the lever arm is determined according to the characteristics of the rotary motion
(3) And constructing an error calibration model suitable for a Kalman filtering algorithm according to the rotary motion system of the AUV. Determining a state equation and an observation equation of the system according to the state quantity and the observed quantity of the system, and establishing a Kalman filtering equation; with [ R ] CA V by ] T And establishing a Kalman filtering equation as a state variable to calibrate a lever arm in the AUV positioning navigation system, wherein the state equation is as follows:w is white Gaussian noise satisfying a zero-mean normal distribution, and the observation equation isWherein v is white gaussian noise satisfying a zero-mean normal distribution;
(4) Optimally estimating the lever arm length of the AUV by a Kalman filtering model, specifically estimating the lever arm length R in an AUV positioning navigation system according to Kalman filtering CA Carrying out optimal estimation;
(5) Calibrating the lever arm error of the AUV positioning navigation system according to the optimal estimation of the length of the lever arm of the AUV, specifically, calibrating the error of the lever arm of the AUV positioning navigation system by using the length R of the lever arm CA Calibrating the lever arm error in the AUV position-pulling navigation system by the optimal estimation;
embodiment mode 2: this embodiment differs from embodiment 1 in that: the step (1) is specifically as follows:
(1.1) origin o of AUV Carrier b, as shown in FIG. 2 b Coincident with AUV centroid, x b The axis points to the bow direction of the boat b Axis perpendicular to x b The shaft is provided with a plurality of axial grooves,pointing in the starboard direction, z b Axis perpendicular to x b -y b A plane, downward meeting right hand rules; r CA The distance from the DVL mounting point to the center of mass under the carrier system is defined as the lever arm length vectorAs shown in the figure 3 of the drawings,the output value of the DVL under the carrier coordinate system is the point A. V bx At the point speed of A lineAlong a carrier coordinate system x b Component of the axis, V by Is at the A point line speedAlong the carrier coordinate system y b Component of the axis, ω bx ,ω by ,ω bz Angular velocities at points A, respectivelyProjection components in the carrier coordinate system.
(1.2) origin o of azimuth follow-up horizontal coordinate system b b′ Coincident with the origin of the vector system b, x b′ The axial direction is consistent with the AUV heading and is y b′ Constituting a local horizontal coordinate system. z is a radical of b′ The axis is vertical downwards, and the three meet the right-hand rule.
And (1.3) R is the radius of the rotary motion of the orientation following coordinate system AUV. Direction of rotational movement of AUV and z as shown in FIG. 2 b′ The same-direction clockwise rotation of the shaft is positive, and the coordinates of the gyration radius under an azimuth follow-up horizontal coordinate system are as follows:and z b′ When the shaft rotates anticlockwise in the opposite direction, the rotation radius is negative, and the coordinate of the rotation radius under the azimuth follow-up horizontal coordinate system is as follows:gamma is a roll angle during AUV motion, and theta is a pitch angle during AUV motion;
embodiment mode 3: this embodiment differs from embodiment 1 in that: the step (2) is specifically as follows:
(2.1) aiming at the rod arm error in the positioning navigation system of the AUV, constructing an error calibration model suitable for a Kalman filtering algorithm to identify the rod arm length by adopting a rotary motion mode of the AUV;
(2.2) when the AUV has no rolling and pitching motion, the linear speed at the C point of the carrier coordinate system is as follows:and thenSo under the carrier coordinate systemAs shown in fig. 4, under the carrier system, the coordinates of the lever arm along the positive direction of the carrier system roll axis of the AUV are:linear velocity error under the carrier system at point aComprises the following steps:
(2.3) when the AUV does the rotary motion, the pitch motion and the roll motion exist, and then the rotary linear velocity of the AUV under the carrier coordinate system b is as follows:whereinArranged under an orientation follow-up horizontal coordinate system R DC The coordinates of (a) are:the rotational linear velocity of AUV under the carrier system isAnd alsoThe output value of the DVL, i.e., the a-point velocity, can thus be expressed as:and the carrier system is b below R CA The coordinates of (a) are:namely, it isTo obtainSuppose that:to obtain
Embodiment 4: this embodiment differs from embodiment 1 in that: the step (3) is specifically as follows:
(3.1) under the condition that the rolling and pitching are considered when the AUV is used for making the rotary motion, the Kalman filtering method is utilized to carry out optimal estimation on the length of the lever arm;
(3.2) analysis of the AUV motion in accordance with embodiment 2 reveals that the boom arm length is such that the roll and pitch are taken into account
(3.3) with [ R ] CA V by ] T Establishing Kalman filtering equation as state variable of systemThe equation is:w is white Gaussian noise satisfying a zero-mean normal distribution, and the observation equation isWhere v is white gaussian noise that satisfies a zero-mean normal distribution. The simulation test result is shown in fig. 6, the navigational speed of the AUV is set to 2 knots in a simulation mode, the turning radius is 10 meters, and the lever arm is 2 meters long; the attitude angle accuracy of the AHRS is 0.01 °, the course angle accuracy is 0.2 ° × sec (L), where L is the latitude coordinate of the AUV; the DVL constant error is 0.002m/s, and the dynamic error is +/-0.2%.
(3.4) obtaining the lever arm length R according to a Kalman filtering method CA As shown in fig. 6, the kalman filter state can accurately track the lever arm error, the length of the lever arm after averaging the kalman filter state is estimated to be 2.0214 meters, and the estimation error is 2.14%;
embodiment 5: this embodiment differs from embodiment 1 in that: the step (4) is specifically as follows:
(4.1) Lever arm Length R from embodiment 4 CA Can obtain the optimal estimation value of the speed error at the point A as
Claims (3)
1. A lever arm error calibration method of an AUV (autonomous Underwater vehicle) push navigation system is characterized by comprising the following steps:
step 1, determining the motion mode of the AUV as rotary motion;
step 1.1, DVL on AUV is positioned at the bow, and origin o of AUV carrying system b b Coincident with AUV centroid, x b The axis points to the bow direction of the boat b Axis perpendicular to x b Axis pointing in starboard direction, z b Axis perpendicular to x b -y b Plane, downward meeting right hand rule, R CA Is the distance from a DVL mounting point to a mass center under a carrier system, and the length vector of a lever arm isLever arm error exists;
step 1.2, when the AUV navigates underwater, angular motion can be generated,output value of DVL for point A in carrier coordinate system, V bx At the point speed of A lineAlong a carrier coordinate system x b Component of the axis, V by At the point speed of A lineAlong the carrier coordinate system y b Component of the axis, ω bx ,ω by ,ω bz Angular velocities at points A, respectivelyProjection components in a carrier coordinate system;
step 1.3, origin o of azimuth follow-up horizontal coordinate system b b′ Coincident with the origin of the vector system b, x b′ The axial direction is consistent with the AUV heading and y b′ Form a local horizontal coordinate system, z b′ The axis is vertical downwards, and the three meet the right-hand rule;
step 1.4, R is the radius of the rotation motion of the AUV in the azimuth follow-up coordinate system, the rotation motion direction of the AUV and z b′ The coordinate of the rotation radius under the azimuth follow-up horizontal coordinate system isAnd z b′ The axis is negative when rotating anticlockwise in the reverse direction, and the coordinate of the gyration radius under the azimuth follow-up horizontal coordinate system isGamma is a roll angle when the AUV moves, and theta is a pitch angle when the AUV moves;
step 2, analyzing the system of the AUV rotary motion according to the characteristics of the AUV rotary motion, and constructing a lever arm error model suitable for a Kalman filtering algorithm;
and 2.1, analyzing the rotary motion system, wherein when the AUV does not have rolling and pitching motions, the linear speed at the C point of the carrier coordinate system is as follows:whileSo under the carrier coordinate systemUnder the carrier system, the lever arm coordinate along the positive direction of the transverse rolling shaft of the carrier system of the AUV isLinear velocity error under the carrier system at point aIs composed of
Step 2.2, analyzing the rotary motion system, wherein pitching and rolling motions exist when the AUV does rotary motion, so that the rotary linear velocity of the AUV in the carrier coordinate system b isWhereinArranged under an orientation follow-up horizontal coordinate system R DC Has the coordinates ofThe rotational linear velocity of AUV under the carrier system isAnd alsoThe output value of the DVL, i.e., the a-point velocity, is thus expressed as:and the carrier system b is R CA Has the coordinates ofNamely, it isTo obtainSuppose thatTo obtain
Step 3, determining system state quantity and observation quantity, constructing a state equation and an observation equation, and performing optimal estimation on the lever arm length of the AUV according to Kalman filtering;
and 4, calibrating positioning errors of the positioning navigation system caused by the lever arm effect according to the optimal estimation of the length of the AUV lever arm.
2. The calibration method for the lever arm error of the AUV push navigation system according to claim 1, wherein the step 3 specifically comprises the following steps:
step 3.1 Lever arm LengthTo be provided withAnd establishing a Kalman filtering equation as a state variable of the system, wherein the state equation is as follows:w is white Gaussian noise satisfying a zero-mean normal distribution, and the observation equation isv is white gaussian noise satisfying a zero-mean normal distribution;
step 3.2, carrying out lever arm length R in the AUV positioning navigation system according to Kalman filtering CA And carrying out optimal estimation.
3. The calibration method for the lever arm error of the AUV push navigation system according to claim 2, wherein the step 4 specifically comprises the following steps:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910365817.1A CN110057383B (en) | 2019-05-05 | 2019-05-05 | Lever arm error calibration method of AUV (autonomous Underwater vehicle) push navigation system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910365817.1A CN110057383B (en) | 2019-05-05 | 2019-05-05 | Lever arm error calibration method of AUV (autonomous Underwater vehicle) push navigation system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110057383A CN110057383A (en) | 2019-07-26 |
CN110057383B true CN110057383B (en) | 2023-01-03 |
Family
ID=67322119
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910365817.1A Active CN110057383B (en) | 2019-05-05 | 2019-05-05 | Lever arm error calibration method of AUV (autonomous Underwater vehicle) push navigation system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110057383B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114323075A (en) * | 2021-12-30 | 2022-04-12 | 上海埃威航空电子有限公司 | Underwater navigation calibration method and system based on multiple orthogonal signals |
Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101393025A (en) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | AUV combined navigation system non-tracing switch method |
CN101963513A (en) * | 2010-09-03 | 2011-02-02 | 哈尔滨工程大学 | Alignment method for eliminating lever arm effect error of strapdown inertial navigation system (SINS) of underwater carrier |
WO2011020096A1 (en) * | 2009-08-14 | 2011-02-17 | IPOZ Systems, LLC | Device, program product and computer implemented method for touchless metrology using an inertial navigation system and laser |
WO2012012775A1 (en) * | 2010-07-22 | 2012-01-26 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
CN103616026A (en) * | 2013-12-17 | 2014-03-05 | 哈尔滨工程大学 | AUV (Autonomous Underwater Vehicle) manipulating model auxiliary strapdown inertial navigation combined navigation method based on H infinity filtering |
CN103697910A (en) * | 2013-12-14 | 2014-04-02 | 浙江大学 | Correcting method of installation errors of doppler log of autonomous underwater vehicle (AUV) |
CN103759742A (en) * | 2014-01-22 | 2014-04-30 | 东南大学 | Serial inertial navigation nonlinear alignment method based on fuzzy self-adaptation control technology |
CN104019828A (en) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | On-line calibration method for lever arm effect error of inertial navigation system in high dynamic environment |
WO2014165764A1 (en) * | 2013-04-05 | 2014-10-09 | Lockheed Martin Corporation | Underwater platform with lidar and related methods |
CN105509769A (en) * | 2015-12-11 | 2016-04-20 | 上海新跃仪表厂 | Carrier rocket strapdown inertial navigation system full-autonomous alignment method |
CN106885587A (en) * | 2017-04-07 | 2017-06-23 | 南京航空航天大学 | The lower outer lever arm effect errors compensation method of inertia/GPS integrated navigations of rotor disturbance |
CN107776859A (en) * | 2017-09-28 | 2018-03-09 | 哈尔滨工程大学 | AUV deep motion buoyancy compensation control methods latent greatly |
CN107990910A (en) * | 2017-11-06 | 2018-05-04 | 哈尔滨工业大学 | A kind of naval vessel Large azimuth angle Transfer Alignment based on volume Kalman filtering |
CN107990891A (en) * | 2016-10-26 | 2018-05-04 | 中国科学院沈阳自动化研究所 | Underwater robot Combinated navigation method based on Long baselines and beacon on-line proving |
CN108871378A (en) * | 2018-06-29 | 2018-11-23 | 北京航空航天大学 | Lever arm and the outer online dynamic calibrating method of lever arm error in two sets of Rotating Inertial Navigation Systems of one kind |
CN109029454A (en) * | 2018-07-13 | 2018-12-18 | 哈尔滨工程大学 | A kind of abscissa system Strapdown Inertial Navigation System damping algorithm based on Kalman filtering |
CN109425339A (en) * | 2017-08-21 | 2019-03-05 | 哈尔滨工程大学 | A kind of ship heave error compensating method based on the considerations of inertial technology lever arm effect |
CN109443379A (en) * | 2018-09-28 | 2019-03-08 | 东南大学 | A kind of underwater anti-shake dynamic alignment methods of the SINS/DVL of deep-sea submariner device |
CN109459040A (en) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | More AUV co-located methods based on RBF neural auxiliary volume Kalman filtering |
CN109613520A (en) * | 2018-12-14 | 2019-04-12 | 东南大学 | A kind of ultra-short baseline installation error online calibration method based on filtering |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9377309B2 (en) * | 2014-03-31 | 2016-06-28 | Honeywell International Inc. | Global positioning system (GPS) self-calibrating lever arm function |
-
2019
- 2019-05-05 CN CN201910365817.1A patent/CN110057383B/en active Active
Patent Citations (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101393025A (en) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | AUV combined navigation system non-tracing switch method |
WO2011020096A1 (en) * | 2009-08-14 | 2011-02-17 | IPOZ Systems, LLC | Device, program product and computer implemented method for touchless metrology using an inertial navigation system and laser |
WO2012012775A1 (en) * | 2010-07-22 | 2012-01-26 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
EP2596322A1 (en) * | 2010-07-22 | 2013-05-29 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
CN101963513A (en) * | 2010-09-03 | 2011-02-02 | 哈尔滨工程大学 | Alignment method for eliminating lever arm effect error of strapdown inertial navigation system (SINS) of underwater carrier |
WO2014165764A1 (en) * | 2013-04-05 | 2014-10-09 | Lockheed Martin Corporation | Underwater platform with lidar and related methods |
CN103697910A (en) * | 2013-12-14 | 2014-04-02 | 浙江大学 | Correcting method of installation errors of doppler log of autonomous underwater vehicle (AUV) |
CN103616026A (en) * | 2013-12-17 | 2014-03-05 | 哈尔滨工程大学 | AUV (Autonomous Underwater Vehicle) manipulating model auxiliary strapdown inertial navigation combined navigation method based on H infinity filtering |
CN103759742A (en) * | 2014-01-22 | 2014-04-30 | 东南大学 | Serial inertial navigation nonlinear alignment method based on fuzzy self-adaptation control technology |
CN104019828A (en) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | On-line calibration method for lever arm effect error of inertial navigation system in high dynamic environment |
CN105509769A (en) * | 2015-12-11 | 2016-04-20 | 上海新跃仪表厂 | Carrier rocket strapdown inertial navigation system full-autonomous alignment method |
CN107990891A (en) * | 2016-10-26 | 2018-05-04 | 中国科学院沈阳自动化研究所 | Underwater robot Combinated navigation method based on Long baselines and beacon on-line proving |
CN106885587A (en) * | 2017-04-07 | 2017-06-23 | 南京航空航天大学 | The lower outer lever arm effect errors compensation method of inertia/GPS integrated navigations of rotor disturbance |
CN109425339A (en) * | 2017-08-21 | 2019-03-05 | 哈尔滨工程大学 | A kind of ship heave error compensating method based on the considerations of inertial technology lever arm effect |
CN107776859A (en) * | 2017-09-28 | 2018-03-09 | 哈尔滨工程大学 | AUV deep motion buoyancy compensation control methods latent greatly |
CN107990910A (en) * | 2017-11-06 | 2018-05-04 | 哈尔滨工业大学 | A kind of naval vessel Large azimuth angle Transfer Alignment based on volume Kalman filtering |
CN108871378A (en) * | 2018-06-29 | 2018-11-23 | 北京航空航天大学 | Lever arm and the outer online dynamic calibrating method of lever arm error in two sets of Rotating Inertial Navigation Systems of one kind |
CN109029454A (en) * | 2018-07-13 | 2018-12-18 | 哈尔滨工程大学 | A kind of abscissa system Strapdown Inertial Navigation System damping algorithm based on Kalman filtering |
CN109443379A (en) * | 2018-09-28 | 2019-03-08 | 东南大学 | A kind of underwater anti-shake dynamic alignment methods of the SINS/DVL of deep-sea submariner device |
CN109613520A (en) * | 2018-12-14 | 2019-04-12 | 东南大学 | A kind of ultra-short baseline installation error online calibration method based on filtering |
CN109459040A (en) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | More AUV co-located methods based on RBF neural auxiliary volume Kalman filtering |
Non-Patent Citations (8)
Title |
---|
Yaqiang Hu.Adaptive fuzzy command filtered control with error compensation mechanism for AUVs via backstepping.《2018 Chinese Control And Decision Conference (CCDC)》.2018,1226-1230. * |
刘锡祥.杆臂效应补偿中H∞滤波器的应用与设计.《东南大学学报(自然科学版)》.2009,1142-1145. * |
孟佳帅.光纤陀螺捷联惯导系统杆臂效应补偿方法的设计与实现.《中国优秀硕士学位论文全文数据库 信息科技辑》.2019,I136-1845. * |
张强.外杆臂效应对于船用捷联惯导罗经对准影响分析.《哈尔滨工业大学学报 》.2017,174-181. * |
杨其.舱内动环境对捷联惯导外杆臂误差补偿影响机理分析.《系统工程与电子技术》.2017,630-634. * |
杨峻巍.水下航行器导航及数据融合技术研究.《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》.2013,C036-17. * |
王律化.载体行进间对准杆臂误差补偿算法.《现代防御技术》.2019,33-39. * |
郭宇.基于大型水下运载器惯导系统的传递对准及精度评估技术研究.《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》.2018,C036-325. * |
Also Published As
Publication number | Publication date |
---|---|
CN110057383A (en) | 2019-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108614258B (en) | Underwater positioning method based on single underwater sound beacon distance measurement | |
CN109059964B (en) | Inertial navigation and gravity measurement double-calibration method based on gravity peak | |
CN107990891B (en) | Underwater robot combined navigation method based on long baseline and beacon online calibration | |
CN111829512B (en) | AUV navigation positioning method and system based on multi-sensor data fusion | |
CN109738902B (en) | High-precision autonomous acoustic navigation method for underwater high-speed target based on synchronous beacon mode | |
CN110542438B (en) | SINS/DVL-based integrated navigation error calibration method | |
CN210719199U (en) | Multi-equipment combined navigation system of underwater robot | |
CN109443349A (en) | A kind of posture Course Measure System and its fusion method, storage medium | |
CN109613520A (en) | A kind of ultra-short baseline installation error online calibration method based on filtering | |
CN110806209A (en) | Underwater robot multi-device combined navigation system and method | |
CN110763872A (en) | Multi-parameter online calibration method for Doppler velocimeter | |
CN104776847B (en) | A kind of method that gyroscopic drift is estimated suitable for underwater navigation system single-point | |
CN108871379B (en) | DVL speed measurement error online calibration method | |
CN106767928A (en) | A kind of self adaptation fast transfer alignment method | |
CN114063622B (en) | Unmanned ship autonomous berthing positioning method and device and related components | |
CN110057383B (en) | Lever arm error calibration method of AUV (autonomous Underwater vehicle) push navigation system | |
Yu | In-situ calibration of transceiver alignment for a high-precision USBL system | |
CN112083425A (en) | SINS/LBL tight combination navigation method introducing radial velocity | |
CN115112103B (en) | LADCP and combined inertial navigation system combined observation system and method | |
Liu et al. | A correction method for DVL measurement error by pitch dynamics | |
CN114397480A (en) | Acoustic Doppler velocimeter error estimation method, device and system | |
JP3192448B2 (en) | Tide meter | |
CN108344426B (en) | Course angle deviation estimation method between water surface/underwater vehicle and positioning equipment | |
CN112649023B (en) | Method suitable for installation calibration of small and medium-sized ship strapdown inertial navigation system | |
CN114879199A (en) | Method and device for correcting ADCP direction |
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 |