CN108444476B - Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay - Google Patents

Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay Download PDF

Info

Publication number
CN108444476B
CN108444476B CN201810109921.XA CN201810109921A CN108444476B CN 108444476 B CN108444476 B CN 108444476B CN 201810109921 A CN201810109921 A CN 201810109921A CN 108444476 B CN108444476 B CN 108444476B
Authority
CN
China
Prior art keywords
underwater
polar region
unmanned vehicle
vehicle
navigation
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
CN201810109921.XA
Other languages
Chinese (zh)
Other versions
CN108444476A (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.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201810109921.XA priority Critical patent/CN108444476B/en
Publication of CN108444476A publication Critical patent/CN108444476A/en
Application granted granted Critical
Publication of CN108444476B publication Critical patent/CN108444476B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/203Specially adapted for sailing ships

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

The invention provides a polar region collaborative navigation method of a multi-underwater unmanned vehicle, which considers underwater acoustic communication delay and comprises the following steps: the master unmanned underwater vehicle and the slave unmanned underwater vehicle perform accurate time synchronization; the method comprises the steps that a main underwater unmanned aircraft determines accurate navigation information of the main underwater unmanned aircraft in a polar region; determining rough navigation information of the underwater unmanned vehicle in a polar region; the main underwater unmanned vehicle utilizes the ultra-short baseline system to measure the azimuth and distance information between the main underwater unmanned vehicle and the slave underwater unmanned vehicle; the master unmanned underwater vehicle sends information to the slave unmanned underwater vehicle; obtaining accurate navigation information of the underwater unmanned vehicle; judging whether the current filtering times are more than or equal to the total filtering times: if not, skipping to the step three; and if the difference is satisfied, ending the process. The invention can effectively realize the polar region collaborative navigation of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay, and has better precision compared with the polar region collaborative navigation method of the underwater unmanned vehicle not considering the underwater acoustic communication delay.

Description

Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay
Technical Field
The invention relates to a polar region collaborative navigation method of a multi-underwater unmanned aircraft considering underwater acoustic communication delay, which is a collaborative navigation method suitable for the situation that the underwater unmanned aircraft has underwater acoustic communication delay in the polar region navigation process, and belongs to the field of collaborative navigation methods of the multi-underwater unmanned aircraft.
Background
Unmanned underwater vehicles have gained tremendous development in recent years as an important piece of equipment for ocean development. The underwater unmanned vehicle can complete important tasks such as ocean investigation, crash airplane searching and the like. The development of the underwater unmanned vehicle in the future must follow two important trends, namely sailing towards farther and deeper sea areas, and developing towards the goal of being more intelligent and completing more complex tasks. Navigation is crucial as a prerequisite for completing various tasks. The invention mainly focuses on opportunities and challenges brought to navigation of the underwater unmanned vehicle by the two development directions of the underwater unmanned vehicle. On one hand, the navigation problem of the underwater unmanned vehicle in a polar region is solved; on the other hand, a fleet of unmanned underwater vehicles are used to accomplish the task. The invention mainly solves the polar region collaborative navigation problem of the unmanned underwater vehicle under multiple water conditions under the condition of delay of underwater acoustic communication.
Team cooperation is an indispensable part in human work and study. The underwater unmanned vehicle can greatly improve the working efficiency of people, and is also suitable for the underwater unmanned vehicle. There is always a limit to the intelligent development of a single unmanned underwater vehicle, and the cooperation of multiple unmanned underwater vehicles breaks the limit. Especially, the multi-underwater unmanned vehicle has great advantages over a single underwater unmanned vehicle in terms of time and efficiency. The common collaborative navigation of the multi-underwater unmanned vehicle mainly has two forms including a parallel mode and a master-slave mode. A typical parallel underwater unmanned vehicle collaborative navigation system is a collaborative navigation system developed by the (Virginia Tech) research team. And transmitting the position information to surrounding neighbors in an underwater sound broadcasting mode. Unlike the parallel mode, the underwater unmanned vehicle in the master-slave mode collaborative navigation system can have different configurations. Typical master-slave type multi-underwater unmanned vehicle collaborative navigation systems are the mobile baseline System of the University of Porto, n.cruz research group, and the CADRE System of the ministry of martial arts (MIT) (Cooperative automation for Distributed Reconnaissance and Exploration System). Scholars have proposed many new methods for the problem of multi-agent collaborative navigation in non-polar regions, but these methods are not suitable for navigation of unmanned vehicles in the polar regions under the condition of multiple underwater environments. Documents (Xiao G D, Wang A T, Wang B, et al.2016A Cooperative Navigation method Inertial Technology and Navigation 586) and (Xiao G D, Wang B, Deng Z H, et al.2017Anoustic Communication Time Delays Compensation application for Master-Slave AUV Cooperative Navigation IEEE Navigation Journal 17(2) 504-. However, these methods are affected by the rapid convergence of the meridian when applied in polar regions. And thus only in the non-polar region. Meanwhile, the filtering algorithm is based on a standard Kalman filtering algorithm, and the standard Kalman filtering algorithm is only suitable for a dynamic linear system model. Compared with the fire heat development of the collaborative navigation of the multi-underwater unmanned aircraft in the non-polar region, the collaborative navigation of the multi-underwater unmanned aircraft in the polar region is in the starting stage, and no article related to the collaborative navigation of the multi-underwater unmanned aircraft exists at present. The method provided by the invention mainly solves the problem of polar region multi-underwater unmanned vehicle collaborative navigation with a nonlinear system model considering underwater acoustic communication delay.
Disclosure of Invention
The invention aims to provide a polar region collaborative navigation method of a multi-underwater unmanned vehicle, which considers underwater acoustic communication delay, and is a method which can be effectively used for polar region collaborative navigation of the multi-underwater unmanned vehicle and considers the underwater acoustic communication delay.
The purpose of the invention is realized as follows: the method comprises the following steps:
the method comprises the following steps: the master unmanned underwater vehicle and the slave unmanned underwater vehicle perform accurate time synchronization;
step two: inputting polar region collaborative navigation time T and a filtering period T of the underwater unmanned vehicle considering communication delay, calculating total filtering times N, and setting initial filtering times K to be 0;
step three: adding 1 to the filtering times K;
step four: the main underwater unmanned vehicle determines the accurate navigation information of the main underwater unmanned vehicle in the polar region by using the self-carried high-precision navigation equipment and the polar region navigation algorithm;
step five: determining rough navigation information of the underwater unmanned vehicle in a polar region by using self-carried low-precision navigation equipment and a polar region navigation algorithm;
step six: the main underwater unmanned vehicle utilizes the ultra-short baseline system to measure the azimuth and distance information between the main underwater unmanned vehicle and the slave underwater unmanned vehicle;
step seven: the master unmanned underwater vehicle sends information to the slave unmanned underwater vehicle;
step eight: the slave unmanned underwater vehicle determines communication delay time by combining the received information sent by the master unmanned underwater vehicle;
step nine: according to the communication delay time, an improved filtering algorithm considering the underwater acoustic communication delay is utilized to fuse and obtain accurate navigation information of the underwater unmanned vehicle;
step ten: judging whether the current filtering times K are more than or equal to the total filtering times N: when K is not larger than N, skipping to the third step for repeated execution; and when K is larger than or equal to N, finishing the polar region collaborative navigation method of the multi-underwater unmanned aircraft considering communication delay.
The invention also includes such structural features:
1. the fifth step specifically comprises: selecting a grid coordinate system G as a navigation coordinate system, and establishing the following state equation from the underwater unmanned vehicle by considering the navigation environment characteristics of a polar region:
Figure BDA0001568895210000031
wherein the content of the first and second substances,
Figure BDA0001568895210000032
is the angle of the misalignment and,
Figure BDA0001568895210000033
is the speed error, δ Re=[δx δy δz]TIs the position error, fGIs specific force;
Figure BDA0001568895210000034
is a direction cosine matrix from the carrier coordinate system b to the grid coordinate system G,
Figure BDA0001568895210000035
a direction cosine matrix from a grid coordinate system G to a terrestrial coordinate system e; epsilonbIs gyro drift which is constant drift of gyro
Figure BDA00015688952100000318
And gyro random drift which can be regarded as zero mean white Gaussian noise
Figure BDA0001568895210000036
Composition is carried out; vbIs zero offset of the accelerometer and is shifted by the accelerometer constant
Figure BDA0001568895210000037
And accelerometer random drift
Figure BDA0001568895210000038
Composition, the accelerometer random drift can be seen as gaussian white noise; delta KdAnd
Figure BDA0001568895210000039
respectively representing scale factor error and random velocity error, tau, of a Doppler velocimetervIs the correlation time, and wvIs white noise; beta is aaIs zero-mean white noise and represents an ultra-short baseline error.
2. The eighth step is specifically: the complete equation of the modified adaptive Kalman filtering algorithm considering the underwater acoustic communication delay and being applicable to the polar region collaborative navigation method of the multi-underwater unmanned aircraft is expressed as follows:
Figure BDA00015688952100000310
Figure BDA00015688952100000311
Figure BDA00015688952100000312
Figure BDA00015688952100000313
Figure BDA00015688952100000314
Figure BDA00015688952100000315
Figure BDA00015688952100000316
Figure BDA00015688952100000317
Figure BDA0001568895210000041
Figure BDA0001568895210000042
wherein phik,k-1,Γk,k-1And HkRespectively in discrete form of system matrix, control matrix and measuring matrix; p is the covariance matrix of the state; kkIs the adaptive kalman filter gain; the mean and variance of the system noise matrix W are respectively
Figure BDA0001568895210000043
And
Figure BDA0001568895210000044
Figure BDA0001568895210000045
and
Figure BDA0001568895210000046
is the mean and variance of the measured noise matrix V; dk=(1-b)/(1-bk) And 0 < b < 1 is a forgetting factor, and:
Figure BDA0001568895210000047
compared with the prior art, the invention has the beneficial effects that: the invention solves the problem that the traditional underwater unmanned vehicle collaborative navigation method cannot be applied in a polar region. Meanwhile, the influence of the underwater acoustic communication delay on a navigation result is considered, a filtering algorithm is improved, and an adaptive Kalman filtering algorithm considering the underwater acoustic communication delay is designed. The polar region collaborative navigation method of the multi-underwater unmanned aircraft considering the underwater acoustic communication delay can effectively solve the collaborative navigation problem of the multi-underwater unmanned aircraft in the polar region. The master unmanned underwater vehicle is provided with the high-precision inertial navigation system, the slave unmanned underwater vehicle only needs to be provided with the low-precision inertial navigation system, and the navigation precision of the slave unmanned underwater vehicle can be improved through the polar region collaborative navigation algorithm, so that the invention can improve the task execution efficiency of the unmanned underwater vehicle and also save the navigation cost.
Drawings
FIG. 1 is a flow chart of a polar region collaborative navigation method of a multi-underwater unmanned vehicle, which considers underwater acoustic communication delay and is provided by the invention;
FIG. 2 is a comparison of an attitude error curve corrected from an underwater unmanned vehicle in a polar region collaborative navigation method of the multi-underwater unmanned vehicle considering underwater acoustic communication delay, provided by the invention;
FIG. 3 is a comparison of corrected speed error curves from an underwater unmanned vehicle in a polar region collaborative navigation method of a multi-underwater unmanned vehicle considering underwater acoustic communication delay according to the present invention;
fig. 4 is a comparison of corrected position error curves from an underwater unmanned vehicle in the polar region collaborative navigation method of the multi-underwater unmanned vehicle considering underwater acoustic communication delay, which is proposed by the present invention.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings and specific embodiments.
Combination drawing
The invention mainly aims to solve the problem that the traditional underwater unmanned aircraft cannot be applied in a polar region, and designs a polar region collaborative navigation method of the underwater unmanned aircraft. Meanwhile, underwater acoustic communication delay is considered, an adaptive Kalman filtering algorithm is improved, and accurate navigation results of the underwater unmanned aircraft are obtained through filtering fusion.
In order to achieve the above purpose, the technical scheme of the invention mainly comprises the following steps:
the method comprises the following steps: and the master unmanned underwater vehicle and the slave unmanned underwater vehicle are precisely synchronized in time.
Step two: inputting the polar region collaborative navigation time T and the filtering period T of the underwater unmanned vehicle considering communication delay, calculating the total filtering times N, and setting the initial filtering times K to be 0.
Step three: the filtering times K plus 1.
Step four: the main underwater unmanned vehicle determines accurate navigation information (including attitude information, position information and speed information) of the main underwater unmanned vehicle in a polar region by using self-carried high-precision navigation equipment and a polar region navigation algorithm.
The main underwater unmanned vehicle carries high-precision inertial navigation equipment, so that the main underwater unmanned vehicle can accurately navigate in a polar region. Compared with the larger navigation error caused by carrying the low-precision inertial navigation equipment by the slave underwater unmanned vehicle, the navigation error of the master underwater unmanned vehicle can be ignored.
Step five: rough navigation information (comprising attitude information, position information and speed information) of the underwater unmanned vehicle in the polar region is determined by using self-carried low-precision navigation equipment and a polar region navigation algorithm.
And selecting a grid coordinate system G as a navigation coordinate system, and establishing a state equation and a measurement equation for navigating from the polar region of the underwater unmanned vehicle by considering the characteristics of the navigation environment of the polar region. The state equation of the underwater unmanned vehicle is established as follows:
Figure BDA0001568895210000051
wherein the content of the first and second substances,
Figure BDA0001568895210000052
is the angle of the misalignment and,
Figure BDA0001568895210000053
is the speed error, δ Re=[δx δy δz]TIs the position error, fGIs specific force;
Figure BDA0001568895210000054
is a direction cosine matrix from the carrier coordinate system b to the grid coordinate system G,
Figure BDA0001568895210000055
a direction cosine matrix from a grid coordinate system G to a terrestrial coordinate system e; epsilonbIs gyro drift which is constant drift of gyro
Figure BDA0001568895210000056
And gyro random drift which can be regarded as zero mean white Gaussian noise
Figure BDA0001568895210000057
Composition is carried out; vbIs the accelerometer zero offset which is shifted by the accelerometer constant
Figure BDA0001568895210000058
And accelerometer random drift
Figure BDA0001568895210000059
Composition, the accelerometer random drift can be seen as gaussian white noise; delta KdAnd
Figure BDA00015688952100000510
respectively representing scale factor error and random velocity error, tau, of a Doppler velocimetervIs the correlation time, and wvIs white noise; beta is aaIs zero-mean white noise and represents an ultra-short baseline error. And:
Figure BDA0001568895210000061
Figure BDA0001568895210000062
Figure BDA0001568895210000063
Figure BDA0001568895210000064
wherein, for the sake of description, s (-) and c (-) denote sin (-) and cos (-) respectively.
Step six: the main underwater unmanned vehicle utilizes the ultra-short baseline system to measure the azimuth and distance information between the main underwater unmanned vehicle and the slave underwater unmanned vehicle.
And selecting a speed error calculated from the speed measured by a Doppler velocimeter carried by the underwater unmanned vehicle as the observed quantity of the speed error. And simultaneously, selecting a position error obtained by solving the position between the master underwater unmanned vehicle and the slave underwater unmanned vehicle measured by the ultra-short baseline positioning system as an observed quantity of the position error. And establishing a polar region collaborative navigation observation model of the underwater unmanned vehicle.
The state quantity can be described as:
Figure BDA0001568895210000065
the observed quantity can be described as:
Z=[(δVG)T(δRe)T]T, (7)
the observation model can be described as:
Figure BDA0001568895210000066
where H and V are the observation matrix and the measurement noise matrix, respectively. V can be considered zero-mean gaussian white noise and can be expressed as:
Figure BDA0001568895210000071
step seven: the master unmanned underwater vehicle sends information (including time, position, attitude, speed, relative position, etc.) to the slave unmanned underwater vehicles.
Step eight: and the slave unmanned underwater vehicle combines the received information sent by the master unmanned underwater vehicle to determine the communication delay time.
Step nine: and according to the communication delay time, fusing to obtain accurate navigation information from the underwater unmanned vehicle by utilizing an improved filtering algorithm considering the underwater acoustic communication delay. The complete equation for the modified adaptive kalman filter algorithm, which takes into account the underwater acoustic communication delay and is suitable for the polar region collaborative navigation method of the multi-underwater unmanned vehicle, is expressed as follows (the whole process of the modified adaptive kalman filter algorithm taking into account the underwater acoustic communication delay is as follows):
Figure BDA0001568895210000072
Figure BDA0001568895210000073
Figure BDA0001568895210000074
Figure BDA0001568895210000075
Figure BDA0001568895210000076
Figure BDA0001568895210000077
Figure BDA0001568895210000078
Figure BDA0001568895210000079
Figure BDA00015688952100000710
Figure BDA00015688952100000711
wherein phik,k-1,Γk,k-1And HkRespectively in discrete form of system matrix, control matrix and measuring matrix; p is the covariance matrix of the state; kkIs the adaptive kalman filter gain; the mean and variance of the system noise matrix W are respectively
Figure BDA00015688952100000712
And
Figure BDA00015688952100000713
Figure BDA00015688952100000714
and
Figure BDA00015688952100000715
is the mean and variance of the measured noise matrix V; dk=(1-b)/(1-bk) And 0 < b < 1 is a forgetting factor. And:
Figure BDA00015688952100000716
step ten: judging whether the current filtering times K are more than or equal to the total filtering times N: when K is not larger than N, skipping to the third step for repeated execution; and when K is larger than or equal to N, finishing the polar region collaborative navigation method of the multi-underwater unmanned aircraft considering communication delay.
The specific implementation scheme is as follows:
the effectiveness of the multi-underwater unmanned aircraft polar region collaborative navigation method considering underwater acoustic communication delay provided by the invention is verified through Matlab simulation software. And establishing a navigation state model and an observation model of the slave underwater unmanned aircraft in the polar region navigation method of the multi-underwater unmanned aircraft considering the underwater acoustic communication delay by using a Matlab simulation language. Setting initial conditions and carrying out simulation experiments. The effectiveness of the invention is shown by comparing the polar region collaborative navigation method of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay with the polar region collaborative navigation method of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay.
Matlab simulation conditions were set as follows:
the system simulation time is 12h, and the filtering period is 0.1 s; the initial position of the slave unmanned underwater vehicles in the multi-unmanned underwater vehicles is 120 degrees of east longitude and 80 degrees of north latitude; the initial values of the rolling, pitching and yawing angles are all 0 degrees, the periods are respectively 3s, 5s and 7s, and the amplitudes are respectively 4 degrees, 5 degrees and 3 degrees; the gyro constant drift and the random drift are respectively 0.03 degree/h and (0.001 degree/h)2(ii) a The constant drift and the random drift of the accelerometer are respectively 1 multiplied by 10-4g0And (1X 10)-6g0)2
The simulation result of the invention is as follows:
according to the multi-underwater unmanned vehicle polar region collaborative navigation method considering underwater acoustic communication delay, and based on the set simulation conditions, simulation experiment results such as the simulation experiment results shown in the figures 2 to 4 can be obtained through simulation experiments on the method.
According to the comparison of the simulation experiment results of fig. 2 to 4, in the simulation experiment, method 1 represents the polar region collaborative navigation method of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay, and method 2 represents the polar region collaborative navigation method of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay. Through comparison results of simulation experiments of fig. 2 to 4, it can be found that the proposed polar region collaborative navigation method of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay is superior to the polar region collaborative navigation method of the multi-underwater unmanned vehicle not considering the underwater acoustic communication delay. In the polar region collaborative navigation method of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay, the estimation errors of the attitude, the speed and the position of the underwater unmanned vehicle are converged rapidly, and the errors are stabilized around the zero value. And in the polar region collaborative navigation method of the multi-underwater unmanned vehicle without considering the underwater acoustic communication delay, the attitude, the speed and the position errors of the underwater unmanned vehicle are larger.
In conclusion, the invention discloses a polar region collaborative navigation method of a multi-underwater unmanned vehicle, which considers underwater acoustic communication delay. The master unmanned underwater vehicle and the slave unmanned underwater vehicle perform accurate time synchronization; inputting polar region collaborative navigation time T and a filtering period T of the underwater unmanned vehicle considering communication delay, calculating total filtering times N, and setting initial filtering times K to be 0; adding 1 to the filtering times K; the main underwater unmanned vehicle determines accurate navigation information (including attitude information, position information and speed information) of the main underwater unmanned vehicle in a polar region by using self-carried high-precision navigation equipment and a polar region navigation algorithm; determining rough navigation information (comprising attitude information, position information and speed information) of the underwater unmanned vehicle in a polar region by using self-carried low-precision navigation equipment and a polar region navigation algorithm; the main underwater unmanned vehicle utilizes the ultra-short baseline system to measure the azimuth and distance information between the main underwater unmanned vehicle and the slave underwater unmanned vehicle; the master unmanned underwater vehicle sends information (comprising time, position, attitude, speed, relative position and the like) to the slave unmanned underwater vehicle; the slave unmanned underwater vehicle determines communication delay time by combining the received information sent by the master unmanned underwater vehicle; according to the communication delay time, an improved filtering algorithm considering the underwater acoustic communication delay is utilized to fuse and obtain accurate navigation information of the underwater unmanned vehicle; judging whether the current filtering times K are more than or equal to the total filtering times N: when K is not larger than N, skipping to the third step for repeated execution; and when K is larger than or equal to N, finishing the polar region collaborative navigation method of the multi-underwater unmanned aircraft considering communication delay. The invention can effectively realize the polar region collaborative navigation of the multi-underwater unmanned vehicle considering the underwater acoustic communication delay, and has better precision compared with the polar region collaborative navigation method of the underwater unmanned vehicle not considering the underwater acoustic communication delay.

Claims (2)

1. A polar region collaborative navigation method of a multi-underwater unmanned vehicle considering underwater acoustic communication delay is characterized by comprising the following steps: the method comprises the following steps:
the method comprises the following steps: the master unmanned underwater vehicle and the slave unmanned underwater vehicle perform accurate time synchronization;
step two: inputting polar region collaborative navigation time T and a filtering period T of the underwater unmanned vehicle considering communication delay, calculating total filtering times N, and setting initial filtering times K to be 0;
step three: adding 1 to the filtering times K;
step four: the main underwater unmanned vehicle determines accurate navigation information of the main underwater unmanned vehicle in a polar region by using self-carried high-precision navigation equipment and a polar region navigation algorithm, wherein the accurate navigation information comprises attitude information, position information and speed information;
step five: determining rough navigation information of the underwater unmanned vehicle in a polar region by using self-carried low-precision navigation equipment and a polar region navigation algorithm, wherein the rough navigation information comprises attitude information, position information and speed information;
the polar region navigation algorithm comprises the following steps: selecting a grid coordinate system G as a navigation coordinate system, and establishing the following state equation from the underwater unmanned vehicle by considering the navigation environment characteristics of a polar region:
Figure FDA0002934451290000011
wherein the content of the first and second substances,
Figure FDA0002934451290000012
is the angle of the misalignment and,
Figure FDA0002934451290000013
is the speed error, δ Re=[δx δy δz]TIs the position error, fGIs specific force;
Figure FDA0002934451290000014
is a direction cosine matrix from the carrier coordinate system b to the grid coordinate system G,
Figure FDA0002934451290000015
a direction cosine matrix from a grid coordinate system G to a terrestrial coordinate system e; epsilonbIs gyro drift which is constant drift of gyro
Figure FDA0002934451290000016
And gyro random drift viewed as zero mean white Gaussian noise
Figure FDA0002934451290000017
Composition is carried out;
Figure FDA0002934451290000018
is zero offset of the accelerometer and is shifted by the accelerometer constant
Figure FDA0002934451290000019
And accelerometer random drift
Figure FDA00029344512900000110
Composition, accelerometer is floated at randomThe shift is seen as white gaussian noise; delta KdAnd
Figure FDA00029344512900000111
respectively representing scale factor error and random velocity error, tau, of a Doppler velocimetervIs the correlation time, and wvIs white noise; beta is aaIs zero-mean white noise, representing an ultra-short baseline error;
step six: the main underwater unmanned vehicle utilizes the ultra-short baseline system to measure the azimuth and distance information between the main underwater unmanned vehicle and the slave underwater unmanned vehicle;
step seven: the method comprises the following steps that a master unmanned underwater vehicle sends information to a slave unmanned underwater vehicle, and comprises the following steps: time, position, attitude, velocity, relative position;
step eight: the slave unmanned underwater vehicle determines communication delay time by combining the received information sent by the master unmanned underwater vehicle;
step nine: according to the communication delay time, an improved filtering algorithm considering the underwater acoustic communication delay is utilized to fuse and obtain accurate navigation information of the underwater unmanned vehicle;
step ten: judging whether the current filtering times K are more than or equal to the total filtering times N: when K is not larger than N, skipping to the third step for repeated execution; and when K is larger than or equal to N, finishing the polar region collaborative navigation method of the multi-underwater unmanned aircraft considering communication delay.
2. The polar region collaborative navigation method of the multi-underwater unmanned vehicle considering underwater acoustic communication delay is characterized in that: the eighth step is specifically: the complete equation of the modified adaptive Kalman filtering algorithm considering the underwater acoustic communication delay and being applicable to the polar region collaborative navigation method of the multi-underwater unmanned aircraft is expressed as follows:
Figure FDA0002934451290000021
Figure FDA0002934451290000022
Figure FDA0002934451290000023
Figure FDA0002934451290000024
Figure FDA0002934451290000025
Figure FDA0002934451290000026
Figure FDA0002934451290000027
Figure FDA0002934451290000028
Figure FDA0002934451290000029
Figure FDA00029344512900000210
wherein phik,k-1,Γk,k-1And HkRespectively in discrete form of system matrix, control matrix and measuring matrix; p is the covariance matrix of the state; kkIs the adaptive kalman filter gain; the mean and variance of the system noise matrix W are respectively
Figure FDA00029344512900000211
And
Figure FDA00029344512900000212
Figure FDA00029344512900000213
and
Figure FDA00029344512900000214
is the mean and variance of the measured noise matrix V; dk=(1-b)/(1-bk) And 0 < b < 1 is a forgetting factor, and:
Figure FDA0002934451290000031
CN201810109921.XA 2018-02-05 2018-02-05 Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay Active CN108444476B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810109921.XA CN108444476B (en) 2018-02-05 2018-02-05 Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810109921.XA CN108444476B (en) 2018-02-05 2018-02-05 Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay

Publications (2)

Publication Number Publication Date
CN108444476A CN108444476A (en) 2018-08-24
CN108444476B true CN108444476B (en) 2021-04-23

Family

ID=63191515

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810109921.XA Active CN108444476B (en) 2018-02-05 2018-02-05 Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay

Country Status (1)

Country Link
CN (1) CN108444476B (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109739249B (en) * 2018-09-06 2022-04-19 中国船舶工业系统工程研究院 Multi-UUV formation coordination control method under speed state missing condition
CN109781100A (en) * 2019-03-08 2019-05-21 哈尔滨工程大学 A kind of polar region integrated navigation binary channels error calibration method based on Kalman Filter Estimation
CN110207698B (en) * 2019-05-27 2022-08-02 哈尔滨工程大学 Polar region grid inertial navigation/ultra-short baseline tight combination navigation method
CN110954107B (en) * 2019-12-04 2023-09-19 上海迈波科技有限公司 Unmanned aircraft cluster collaborative navigation method and device
CN114791588B (en) * 2022-05-12 2022-10-25 中国人民解放军海军潜艇学院 Underwater acoustic pulse positioning method and system
CN117553787B (en) * 2024-01-09 2024-03-26 湖南大学无锡智能控制研究院 Collaborative navigation method, device and system of underwater unmanned aircraft

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104180804A (en) * 2014-09-11 2014-12-03 东南大学 Single reference node underwater vehicle integrated navigation method based on underwater information network
CN104457754A (en) * 2014-12-19 2015-03-25 东南大学 SINS/LBL (strapdown inertial navigation systems/long base line) tight combination based AUV (autonomous underwater vehicle) underwater navigation positioning method
CN105066993A (en) * 2015-08-24 2015-11-18 江苏中海达海洋信息技术有限公司 LBL/MINS integrated navigation system and navigation information fusion method thereof
CN105783943A (en) * 2016-04-26 2016-07-20 哈尔滨工程大学 Method for performing transfer alignment on large azimuth misalignment angle of ship in polar region environment based on unscented Kalman filtering
CN106767793A (en) * 2017-01-19 2017-05-31 东南大学 A kind of AUV underwater navigation localization methods based on SINS/USBL tight integrations
CN107024226A (en) * 2016-02-01 2017-08-08 北京自动化控制设备研究所 Ins error method of estimation of the one kind based on inertial navigation/DVL/USBL combinations

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104180804A (en) * 2014-09-11 2014-12-03 东南大学 Single reference node underwater vehicle integrated navigation method based on underwater information network
CN104457754A (en) * 2014-12-19 2015-03-25 东南大学 SINS/LBL (strapdown inertial navigation systems/long base line) tight combination based AUV (autonomous underwater vehicle) underwater navigation positioning method
CN105066993A (en) * 2015-08-24 2015-11-18 江苏中海达海洋信息技术有限公司 LBL/MINS integrated navigation system and navigation information fusion method thereof
CN107024226A (en) * 2016-02-01 2017-08-08 北京自动化控制设备研究所 Ins error method of estimation of the one kind based on inertial navigation/DVL/USBL combinations
CN105783943A (en) * 2016-04-26 2016-07-20 哈尔滨工程大学 Method for performing transfer alignment on large azimuth misalignment angle of ship in polar region environment based on unscented Kalman filtering
CN106767793A (en) * 2017-01-19 2017-05-31 东南大学 A kind of AUV underwater navigation localization methods based on SINS/USBL tight integrations

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
A cooperative navigation method based on USBL Proceedings of 2016 China International Conference on Inertial Technology and Navigation;Xiao Guangdi等;《2016 China International Conference on Inertial Technology and Navigation》;20161231;586-590 *
An Acoustic Communication Time Delays Compensation Approach for Master–Slave AUV Cooperative Navigation;Gangdi Xiao等;《IEEE SENSORS JOURNAL》;20170102;第17卷(第2期);504-513 *
Polar grid navigation algorithm for unmanned underwater vehicles;Zheping Yan等;《MDPI》;20170709;第17卷(第1599期);1-24 *
基于平面导航系的极区传递对准算法研究;刘素珍等;《光学与广电技术》;20141031;第12卷(第5期);1229-1235 *
基于横坐标系的捷联惯性导航系统/多普勒速度仪极区组合导航算法;张福斌等;《兵工学报》;20160731;第37卷(第7期);64-67 *

Also Published As

Publication number Publication date
CN108444476A (en) 2018-08-24

Similar Documents

Publication Publication Date Title
CN108444476B (en) Polar region collaborative navigation method of multi-underwater unmanned vehicle considering underwater acoustic communication delay
WO2020062791A1 (en) Sins/dvl-based underwater anti-shaking alignment method for deep-sea underwater vehicle
Grenon et al. Enhancement of the inertial navigation system for the morpheus autonomous underwater vehicles
CN101788296B (en) SINS/CNS deep integrated navigation system and realization method thereof
CN101846734B (en) Agricultural machinery navigation and position method and system and agricultural machinery industrial personal computer
CN111380518B (en) SINS/USBL tight combination navigation positioning method introducing radial velocity
CN101246012B (en) Combinated navigation method based on robust dissipation filtering
CN111595348B (en) Master-slave mode cooperative positioning method of autonomous underwater vehicle combined navigation system
CN111829512B (en) AUV navigation positioning method and system based on multi-sensor data fusion
CN104316045A (en) AUV (autonomous underwater vehicle) interactive auxiliary positioning system and AUV interactive auxiliary positioning method based on SINS (strapdown inertial navigation system)/LBL (long base line)
CN108594271A (en) A kind of Combinated navigation method of the anti-deceptive interference based on composite layered filtering
CN111947651A (en) Underwater combined navigation information fusion method and system and autonomous underwater vehicle
CN112747748A (en) Pilot AUV navigation data post-processing method based on reverse solution
CN110207698B (en) Polar region grid inertial navigation/ultra-short baseline tight combination navigation method
CN104949687A (en) Whole parameter precision evaluation method for long-time navigation system
CN113155134B (en) Underwater acoustic channel tracking and predicting method based on inertia information assistance
CN112083425B (en) SINS/LBL (strapdown inertial navigation system/location based language) tightly-integrated navigation method introducing radial velocity
CN103616026A (en) AUV (Autonomous Underwater Vehicle) manipulating model auxiliary strapdown inertial navigation combined navigation method based on H infinity filtering
Liu et al. A covariance shaping filtering method for tightly-coupled MIMU/GNSS of UAV
CN114111840B (en) DVL error parameter online calibration method based on integrated navigation
CN114061574B (en) Position-invariant constraint and zero-speed correction-based coal mining machine pose-determining and orienting method
CN113916226B (en) Minimum variance-based interference rejection filtering method for integrated navigation system
Klein et al. Squeezing position updates for enhanced estimation of land vehicles aided INS
CN111380520B (en) SINS/USBL loose combination navigation positioning method introducing radial velocity
CN111721284B (en) SINS/USBL combined navigation positioning method in passive mode

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