[go: up one dir, main page]
Next Article in Journal
A Uniformity Index for Precipitation Particle Axis Ratios Derived from Radar Polarimetric Parameters for the Identification and Analysis of Raindrop Areas
Next Article in Special Issue
A Bio-Inspired MEMS Wake Detector for AUV Tracking and Coordinated Formation
Previous Article in Journal
Air Quality Improvement Following COVID-19 Lockdown Measures and Projected Benefits for Environmental Health
Previous Article in Special Issue
A Multi-Robot Coverage Path Planning Method for Maritime Search and Rescue Using Multiple AUVs
 
 
Search for Articles:
Title / Keyword
Author / Affiliation / Email
Journal
Article Type
 
 
Advanced Search
 
Section
Special Issue
Volume
Issue
Number
Page
 
Journals
Remote Sensing
Volume 15
Issue 2
10.3390/rs15020533
remotesensing-logo
Submit to this Journal Review for this Journal Propose a Special Issue
► Article Menu

Article Menu

share Share announcement Help format_quote Cite question_answer Discuss in SciProfiles thumb_up
...
Endorse textsms
...
Comment
first_page
settings
Order Article Reprints
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Cooperative Navigation Algorithm of Extended Kalman Filter Based on Combined Observation for AUVs

by
Guangrun Sheng
1,2,
Xixiang Liu
1,2,*,
Yehua Sheng
3,4,
Xiangzhi Cheng
1,2 and
Hao Luo
1,2
1
School of Instrument Science and Engineering, Southeast University, Nanjing 210096, China
2
Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Nanjing 210096, China
3
Key Laboratory of Virtual Geographic Environment, Ministry of Education of PRC, Nanjing Normal University, Nanjing 210023, China
4
Jiangsu Center for Collaborative Innovation in Geographical Information Resource Development and Application, Nanjing Normal University, Nanjing 210023, China
*
Author to whom correspondence should be addressed.
Remote Sens. 2023, 15(2), 533; https://doi.org/10.3390/rs15020533
Submission received: 29 November 2022 / Revised: 28 December 2022 / Accepted: 12 January 2023 / Published: 16 January 2023
(This article belongs to the Special Issue Advances on Autonomous Underwater Vehicles (AUV))
Browse Figures
Graphical abstract
"> Figure 1
<p>The network structure of multiple AUVs.</p> "> Figure 2
<p>Mutual observation of multiple AUVs.</p> "> Figure 3
<p>The estimated trajectories of three AUVs.</p> "> Figure 4
<p>Velocity error comparison curve.</p> "> Figure 5
<p>Position error comparison curve.</p> "> Figure 6
<p>Relative horizontal distance error for multi-AUV cooperative navigation.</p> "> Figure 7
<p>Equipment and platforms in the boat.</p> "> Figure 8
<p>Schematic diagram of the trajectory.</p> "> Figure 9
<p>Velocity error comparison curve.</p> "> Figure 10
<p>Position error comparison curve.</p> "> Figure 11
<p>Relative horizontal distance error for multi-boat cooperative navigation.</p> ">
Versions Notes

Abstract

:
The navigation and positioning of multi-autonomous underwater vehicles (AUVs) in the complex and variable marine environment is a significant and much-needed area of attention, especially considering the fact that cooperative navigation technology is the essential method for multiple AUVs to solve positioning problems. When the extended Kalman filter (EKF) is applied for underwater cooperative localization, the outliers in the sensor observations cause unknown errors in the measurement system due to deep-sea environmental factors, which are difficult to calibrate and cause a significant reduction in the co-location accuracy of AUVs, and can even cause problems with a divergence of estimation error. In this paper, we proposed a cooperative navigation method of the EKF algorithm based on the combined observation of multiple AUVs. Firstly, the corresponding cooperative navigation model is established, and the corresponding measurement model is designed. Then, the EKF model based on combined observation is designed and constructed, and the unknown error is eliminated by introducing a previously measured value. Finally, simulation tests and lake experiments are designed to verify the effectiveness of the algorithm. The results indicate that the EKF algorithm based on combined observation can approximately eliminate errors and improve the accuracy of cooperative localization when the unknown measurement error cannot be calibrated by common EKF methods. The effect of state estimation is improved, and the accuracy of co-location can be effectively improved to avoid serious declines in—and divergence of—estimation accuracy.

Graphical Abstract">

Graphical Abstract

1. Introduction

Autonomous underwater vehicles (AUVs) are a class of important autonomous navigation carriers for human exploration of the marine environment. AUVs have a high degree of autonomy, flexibility, and remote navigation capabilities in marine resources exploration, underwater exploration, data acquisition, and other aspects of a wide range of applications [1,2,3,4]. With the rapid development of air- and land-based navigation technology, underwater navigation technology is also progressing rapidly [5,6,7,8,9,10]. However, due to the complexity of the underwater environment, there is still a gap between the navigation and positioning accuracy of underwater vehicles compared to those of air and land, and for the time being, underwater navigation has become an important issue in the field of AUV research [11,12,13,14].
Underwater high-precision navigation is key to AUVs’ mission, and the specific navigation methods applied by AUVs vary depending on the area in which they navigate underwater [15,16,17]. When an AUV sails in an offshore area (water depth <300 m), navigation technologies such as radio navigation (RADNAV) and global navigation satellite systems (GNSS) can be used from time to time; in the near-sea area (from the seabed <100 m), terrain matching navigation can be considered; and when sailing in deep-water environments, it is difficult to obtain the above-mentioned navigation information [18,19]. To sum up, even if there are more sensors, there are still many limitations and deficiencies in the independent operation of AUVs underwater. However, multiple AUVs can use their navigation sensors to obtain corresponding measurement information and then combine underwater acoustic communication technology with underwater acoustic detection technology to share this information and measure the relative positions of adjacent AUVs and obtain navigation parameters by fusing information. Cooperative navigation enables highly accurate underwater positioning and navigation, easily accomplishing complex tasks that would be difficult for a single AUV to perform, and the simplicity of the system and the flexibility of the range of use have led to a wide focus of researchers on cooperative underwater positioning of multiple AUVs [20,21,22].
The key object of research in multi-AUV cooperative navigation is the information fusion algorithm shared among the system’s AUVs, and most of the existing multi-AUV cooperative positioning methods comprise improved Kalman filter (KF) algorithms combined with measurement data from underwater navigation sensors. The model of a multi-AUV cooperative localization system is often nonlinear. Therefore, an extended Kalman filter (EKF) or unscented Kalman filter (UKF) is usually used for state estimation [23,24,25].
The problem of cooperative navigation and positioning is a state estimation problem, and the accurate acquisition of observation information is key to realizing the optimal state estimation of cooperative navigation [26]. At present, the use of hydroacoustic communication devices to obtain relative observations, such as relative distance, between individual AUVs is the most effective and reliable measurement method [27,28,29]. However, AUVs are used in complex marine environments where the cooperative navigation of multiple sensors can be affected by harsh conditions and instability of measurement sensors, causing unknown system noise and resulting in unknown measurement system errors. This inevitably leads to the destruction of effective observation information, and the extended KF filtering algorithm cannot accurately estimate and correct this unknown measurement system error, thus directly leading to a significant decrease in filtering accuracy and stability or even divergence. Ref. [30] describes how, in acoustic ranging-based cooperative navigation, sensors are subjected to temperature, salinity, depth, current, and other factors in the underwater environment, which makes the statistical characteristics of the measured sensor noise inaccurate and generates unknown measurement system errors. In the framework of Kalman filters, these methods require that the statistical characteristics of process noise and measurement noise are known and fixed during cooperative localization [31,32]. However, this unknown measurement system error is difficult to calibrate with the common EKF algorithm and, therefore, leads directly to a reduction in filter accuracy or even divergence [33]. Ref. [34] presented the use of attenuated adaptive filtering to achieve adjustment of the weights of new measurements, but the process of calculating the scalar asymptotic factor is too cumbersome. Adaptive filters based on great likelihood can correct the second-order moments of statistical properties of noise but rely on accurate estimates of the new interest covariance [35]. The above-mentioned works all emphasize the influence of measurement error information on the state estimation effect. To improve the robustness of state estimation regarding measurement errors, it is still necessary to further seek a more reliable and effective co-location algorithm. In Ref. [36], Sheng has proposed a novel transfer alignment method based on combined double-time observations with velocity and attitude to address the problem of static flexural deformation causing measurement system errors, successfully eliminating this unknown system error, effectively improving filter performance, and increasing the accuracy of transfer alignment. However, the linear KF cannot be applied to multi-AUV cooperative navigation [37].
To solve the above problems, we need to redesign the cooperative navigation algorithm, and realize the optimal state estimation of cooperative navigation by filtering and optimizing the measurement information with errors. In this paper, we proposed a cooperative navigation method of the EKF algorithm based on the combined observation of multiple AUVs. The improved EKF algorithm model was designed and constructed to eliminate errors in the measurement system by combining previously measured information with information from the current moment; current observations subtracted from the last observation are used as new measurements for the improved algorithm. The final results of the simulation and experiments verify the feasibility and effectiveness of the algorithm in the field of cooperative localization for AUVs.
The rest of this paper is organized as follows: In Section 2, the formulation of a discrete-time nonlinear model of the cooperative positioning system and the corresponding standard EKF algorithm are described. In Section 3, by analysis and comparison with the common algorithm, the improved EKF based on combined observation is proposed and derived and is specifically applied to cooperative navigation for AUVs. In Section 4, a simulation test and lake tests are designed, and the results verify the feasibility and effectiveness of the algorithm. Finally, conclusions are presented in Section 5.

2. Theoretical Basis of Multi-AUV Cooperative Navigation

2.1. Principles of AUV Cooperative Navigation

It is assumed that multiple AUVs are currently working together in the middle-water environment, AUVs can communicate with each other, and AUVs have independent navigation. The navigation sensor used in the AUVs’ underwater navigation system is utilized to obtain attitude, speed, position, relative distance, and orientation information. The system includes the following: underwater acoustic communication equipment composed of SINS, Doppler velocity log (DVL), terrain-assisted navigation (TAN), magnetic compass pilot (MCP), and other related auxiliary equipment.
Each AUV uses its navigation sensors to obtain the required information, and then uses a nonlinear filter to continuously estimate and update its position, and uses communication equipment to communicate with neighboring AUVs to exchange information for information contribution and to fuse the relative position relationships of each AUV in the whole cooperative navigation system. In this paper, we choose a multi-AUV parallel cooperative navigation system solution to navigate and position each AUV with equal status and comparable navigation accuracy. A schematic representation of the cooperative navigation system in this paper is shown in Figure 1.
The system uses each AUV as the processing node, and each AUV can communicate with other AUVs and has independent navigation. Neighboring nodes can communicate with each other and they rely on sharing sensor measurements with neighboring AUVs to fuse the relative position relationships of each AUV in the overall cooperative navigation system, resulting in an equal improvement in the navigation positioning accuracy of all AUVs.

2.2. Multi-AUV Motion Model

As described in the previous subsection, there is a wide range of underwater navigation sensors available in the AUV underwater navigation system. This paper focuses on medium- to high-accuracy SINS, which provides high-update-frequency navigation information such as angular velocity, acceleration, attitude, velocity, and position. The navigation center, centered on the inertial device, is an indispensable device for the AUV and is an important guarantee to support the safe navigation of the AUV and the smooth execution of its work tasks [38,39,40].
In the SINS-based AUV underwater navigation system, we use the error values of the SINS output navigation parameters as the state variables; the SINS state has physical properties, and its system model is based on Newton’s laws of motion, with a high degree of coupling between the state quantities. In this paper, the attitude error ϕ n , velocity error v n , position error δ p n , gyroscope constant zero bias ε b , and accelerometer constant zero bias ∇ b are selected as the state variables of the EKF.
X = ϕ n T δ V n T δ p n T ε b T ∇ b T T
For navigation systems, the equation of state is the dynamic equation of the system, also known as the equation of motion, which describes the state of the system over time; the equation of observation describes the measurement of the state of the system by the sensors [41]. The equation of state for transfer alignment is obtained from the SINS error equation and state variables:
X ˙ = F X + G W
where F is the transfer matrix, X is the state vector, G is the disturbance matrix, and W is the random disturbance vector.
Suppose there are N AUVs in the multi-AUV collaborative system, and the state quantity X i ( k ) of the i-th AUV at time t k :
X i ( k ) = ϕ n i T ( k ) δ V n i T ( k ) δ p n i T ( k ) ε b i T ( k ) ∇ b i T ( k ) T
Then, in the multi-AUV collaborative navigation system, the state quantity X ( k ) of the system is:
X ( k ) = X 1 ( k ) … X N ( k ) T

2.3. Measurement Update Model

When AUVj is observed by AUVi at a certain time, the relative observations between AUVij are measured by the hydroacoustic communication equipment carried by the AUVs; the relative observations include mutual distance, bearing, etc. The mutual observations of underwater vehicles are shown in Figure 2.
d i j is the relative horizontal distance between AUVi and AUVj, φ i and φ j are the heading angles of AUVi and AUVj, respectively, and ϕ i j is the relative azimuth of AUVj to AUVi. Time of arrival (TOA) is the most commonly used distance measurement method for cooperative positioning in the underwater environment. The three-dimensional slope distance between AUVi and AUVj can be calculated from the propagation time Δ t of the hydroacoustic pulse signal between AUVi and AUVj and the propagation speed c of the acoustic signal in seawater, and the three-dimensional slope information is converted into a two-dimensional relative horizontal distance measurement based on the precise depth information h k i and h k j of AUVi and AUVj:
d i j = ( c ⋅ Δ t ) 2 − ( h i − h j ) 2
The relationship between the measured relative distance information and the navigation state quantity can be expressed specifically as follows:
d i j = [ ( L i − L j ) ( R M i + h i ) ] 2 + [ ( λ k i − λ k j ) ( R N i + h i ) cos L i ] 2
Based on the time delay difference between the hydroacoustic pulse signals indirectly received by the different array elements of the sonar to determine the orientation of the measured target, the relationship between the measured relative orientation information and the navigation state quantity, considering the position relationship shown in Figure 2, can be specifically expressed as:
ϕ i j = arctan ( λ j − λ i ) cos L l j L j − L i − φ i
The observation equation is written in general form:
Z = h ( x i , x j ) + v
Due to the complexity and variability of the underwater environment, multiple AUVs can observe each other at certain time steps; this allows each underwater robot to acquire one or more relative observations until all relative observations of the other are acquired. According to the ideal position information x k j = ( L k j , λ k j , h k j ) of AUVj and x k i = ( L k i , λ k i , h k i ) of AUVi at the time t k , the relative distance information is obtained. As can be seen from the above figure, the observation equation of the relative distance is:
Z k d = h d ( x k i , x k j ) + v k d = [ ( L k i − L k j ) ( R M , k i + h k i ) ] 2 + [ ( λ k i − λ k j ) ( R N , k i + h k i ) cos L k i ] 2 + v k d v k d ∼ N ( 0 , σ d , k 2 )
where Z k d represents relative distance measurements, h d ( x k i , x k j ) is the relative distance measurement function, v k d represents the hydroacoustic distance and the hydroacoustic communication measurement noise, usually assumed to have a mean of zero and a variance of σ d , k 2 , and the relative distances observed are independent of each other and uncorrelated. Then, the Jacobian matrix h d ( x k i , x k j ) is:
H d i = ∂ h d ∂ x k i X k = X ^ k | k − 1 = 0 1 × 6 ∂ h d ∂ L k i ∂ h d ∂ λ k i 0 X k = X ^ k | k − 1
H d j = ∂ h 1 ∂ x k j X k = X ^ k | k − 1 = 0 1 × 6 ∂ h d ∂ L k j ∂ h d ∂ λ k j 0 X k = X ^ k | k − 1
Take AUVi for example:
∂ h d ∂ L k i = ( L k i − L k j ) ( R M , k i + h k i ) 2 − ( λ k i − λ k j ) ( R N , k i + h k i ) sin L k i cos L k i [ ( L k i − L k j ) ( R M , k i + h k i ) ] 2 + [ ( λ k i − λ k j ) ( R N , k i + h k i ) cos L k i ] 2
∂ h d ∂ λ k i = ( λ k i − λ k j ) ( R N , k i + h k i ) cos L k i 2 [ ( L k i − L k j ) ( R M , k i + h k i ) ] 2 + [ ( λ k i − λ k j ) ( R N , k i + h k i ) cos L k i ] 2
Similarly, it is known that, at the moment t l , AUVi observes AUVj and obtains the relative orientation information [42]. Based on the reference attitude information x l i = ( L l i , λ l i , φ l i ) received at moment t l for AUVi and the reference attitude information x l j = ( L l j , λ l j , φ l j ) for AUVj, the observation equation for the relative bearing is obtained as:
Z l β = h β ( x l i , x l j ) + v l β = arctan ( λ l j − λ l i ) cos L l j L l j − L l i − φ l i + v l β ,   v l β ∼ N ( 0 , σ β , l 2 )
where h β ( ⋅ ) is the relative bearing measurement function, v l β is the hydroacoustic bearing measurement noise, usually assumed to be a Gaussian white noise with zero mean and variance σ β , l 2 , and each relative bearing observation is independent of each other and uncorrelated. Then, the Jacobian matrix of h β ( ⋅ ) with respect to x l i and x l j is:
H β i = ∂ h β ∂ x l i X l = X ^ l | l − 1 = 0 0 1 0 1 × 3 ∂ h β ∂ L k i ∂ h β ∂ λ k i 0 X l = X ^ l | l − 1
H d j = ∂ h 1 ∂ x k j X k = X ^ k | k − 1 = 0 1 × 6 ∂ h d ∂ L k j ∂ h d ∂ λ k j 0 X k = X ^ k | k − 1
Take AUVi for example:
∂ h β ∂ L k i = cos L j × ( λ j − λ i ) ( L j − L i ) 2 / 1 + ( λ j − λ i ) cos L j L j − L i 2
∂ h β ∂ λ k i = cos L j L i − L j / 1 + ( λ j − λ i ) cos L j L j − L i 2
The research in this study is carried out based on obtaining these observations, even if these observations are subjected to preprocessing methods such as removing outliers, including the observation target and the matching of the observed target and the observed target. Due to the complexity of the underwater environment, or the sensor installation error angle and other reasons, often, unknown system errors are brought to the measurement system [43,44]. Thus, it is necessary to consider how the filter can be used to calibrate for this error.

3. Derivation of EKF Based on Combined Observation of Cooperative Navigation

3.1. Scheme of Common EKF

With a model of a multi-AUV cooperative navigation system in place, the algorithm used for information fusion is central to solving the cooperative navigation problem [45,46,47]. It is known from Section 1 that for the filter problem of nonlinear cooperative navigation systems under ideal communication conditions, most systems choose to use the EKF algorithm, and since EKF is an extension of the KF, the form of the KF algorithm needs to be introduced first.
For the common KF, one-step predictive state estimation is adopted:
X ^ k , k − 1 = ϕ k , k − 1 X ^ k − 1
The updated state estimate is:
X ^ k = X ^ k , k − 1 + K k Z k − H k X ^ k , k − 1
The Kalman gain is:
K k = P k , k − 1 H k T H k P k , k − 1 H k T + R k − 1
The one-step predicted estimate covariance is:
P k , k − 1 = ϕ k , k − 1 P k − 1 ϕ k , k − 1 T + Γ k , k − 1 Q k − 1 Γ k , k − 1 T
The updated state estimate covariance is:
P k = I − K k H k P k , k − 1
From the above KF calculation steps, we can learn that given the filter parameters X 0 and P 0 at the initial moment, the optimal state estimate X k + 1 of the linear Gaussian system at that moment can be obtained based on the observations at moment k . In the case of cooperative navigation systems, the state and observation models are nonlinear, as described in the previous subsection, and so require the use of nonlinear filter algorithms for cooperative navigation information fusion.
The general nonlinear discrete system can be described as:
X k = f k − 1 X k − 1 + Γ k − 1 W k − 1  
Z k = h k X k + V k
In the above equation, X k is the state vector; f k ( ⋅ ) is the nonlinear vector dispersion function; Γ k − 1 and W k − 1   are the system noise driver matrix and the system noise vector, respectively, Z k is the measurement vector; h k ( ⋅ ) is the nonlinear vector dispersion function, and V k is the noise vector. The EKF builds on the KF by expanding the system’s nonlinear equation of state around the state values X k into a Taylor series and omitting the second-order-and-higher terms, myopically transforming it into a linearized model and using the KF framework for state estimation; the transformed equation of state is:
X k = ϕ k / ( k − 1 ) X k − 1 + U k − 1 + Γ k − 1 W k − 1
where:
ϕ k / k − 1 = ∂ f k − 1 X k − 1 ∂ X k − 1 x k − 1 = x ^ k − 1
U k − 1 = f k − 1 X ^ k − 1 − ∂ f k − 1 X k − 1 ∂ X k − 1 X k − 1 = x ^ k − 1 × X ^ k − 1
In the above equation, X k is the state vector, and Γ k − 1 and W k − 1 are the noise driver matrix and the system noise vector, respectively.
The algorithm structure of the extended KF is essentially the same as that of the linear KF, in that the filter results are obtained by performing temporal and quantitative updates to the state estimates and covariances. In this paper, the EKF-based cooperative navigation algorithm for underwater AUVs requires high accuracy in the measurement equations, while the marine environmental noise, as a disturbing background field in the hydroacoustic channel, is characterized by complexity and variability. Wenz [48] made a summary of deep-sea environmental noise through a submarine deep-water hydrophone. He proposed that deep-sea environmental noise is relatively certain, resulting in unknown errors in the corresponding underwater acoustic ranging measurement system, which affects the accuracy of the measurement data. The traditional EKF algorithm cannot calibrate the error of the measurement system, resulting in a decrease in the filtering accuracy and a great impact on the accuracy of cooperative navigation. The EKF measurement equation including the unknown systematic error is as follows:
Z k = h k X k + V k + e k
The measurement system error e k is an unknown quantity. As can be seen from the above equation, it is difficult to eliminate the unknown measurement system error e k with a common EKF, so multi-AUV cooperative navigation based on EKF is susceptible to divergence caused by the measurement system error, which directly affects the results of the multi-AUV cooperative navigation in a bad way.

3.2. Scheme of Improved EKF Based on Combined Observation

As described in the previous section, deep-sea environmental noise makes the noise of the measurement sensors change and, thus, the sensor data produces outliers, resulting in an unknown measurement system error e k for the cooperative system, which is difficult to model and, therefore, difficult to compensate for with a common EKF, which may make the filter accuracy degrade or even diverge. In this paper, a new algorithm needs to be devised to solve this problem. In engineering practice, the variation of two adjacent measurements Z k and Z k − 1 is small, and if the period we choose is the SINS period, typically 1s or even 0.1s, we can well assume that the unknown errors of the adjacent measurement systems are approximately equal. Therefore, this paper is based on the common EKF, where the measurement information from the previous and subsequent moments is combined and the unknown system error e k is effectively eliminated by re-establishing the quantity measurement and using the difference between Z k and Z k − 1 .
The nonlinear measurement equation with system errors is shown in Equation (29). Through analysis, the measurement equation is re-established in this paper to eliminate the unknown error e k in the measurement system. It follows from the derivation that at moments before and after a sufficiently short update period e k ≈ e k − 1 , the following equation uses the implementation of the difference process to eliminate the system error e k within it and to transform the reconstructed measurement equation regarding the linearization process of the nonlinear equation of state:
Z k = H k X k − B k X k − 1 + Y k + N k
where:
H k = ∂ h k X k ∂ X k X k = X ^ k / ( k − 1 )
B k = ∂ h k − 1 X k − 1 ∂ X k − 1 X k − 1 = X ^ k − 1
Y k = h k X ^ k / ( k − 1 ) − h k − 1 X ^ k − 1 − H k X ^ k / k − 1 − B k X ^ k − 1
where Z k is the newly constructed measurement vector, which is the measurement difference at moment k and moment k − 1 , N k = V k − V k − 1 is the new measurement noise vector, and B k is white noise, which is the measurement matrix at moment k − 1 . From Equation (30), it is noted that the measurement equation of the EKF changes from the current moment of observation to a combined observation. The next step is to derive an improved EKF model based on combined observation from this.
Firstly, the equation of state is not improved by combining observations, so no changes have to be made compared to the common EKF. The set state vector X k satisfies Equation (26), the measurement vector satisfies Equation (30), and the system process noise W k and measurement noise V k satisfy:
E [ W k ] = 0 , E [ W k W j T ] = Q k δ k j E [ V k ] = 0 , E [ V k V j T ] = R k δ k j E [ W k V j T ] = 0
where the system noise variance Q k is non-negative and the measurement noise variance array R k is positive; δ k j is a function of K r o n e c   ker − δ . X k is uncorrelated with W k as well as V k . The time update process of the combined-observation EKF can be obtained as follows:
For the improved EKF based on combined observation, one-step predictive state estimation is adopted:
X ^ k , k − 1 = f k − 1 ( X ^ k − 1 )
The one-step predicted estimate covariance is:
P k , k − 1 = ϕ k , k − 1 P k − 1 ϕ k , k − 1 T + Γ k , k − 1 Q k − 1 Γ k , k − 1 T
Then, based on the similar derivation method ideas in Ref. [49], the measurement update process of the EKF based on combined observation is recursively derived, including updating the state estimate X ^ k , the Kalman gain matrix K k , and the covariance estimate P k :
X ^ k = X ^ k , k − 1 + K k Z k − Z ^ k / k − 1
K k = P k / k − 1 H k T − ϕ k / k − 1 P k − 1 B k T × H k P k / k − 1 H k T − H k ϕ k / k − 1 P k − 1 B k T − B k P k − 1 ϕ k / k − 1 T H k T + B k P k − 1 B k T + R k − 1
P k = P k / k − 1 − K k H k P k / k − 1 H k T − H k ϕ k / k − 1 P k − 1 C k T − B k P k − 1 ϕ k / k − 1 T H k T + B k P k − 1 B k T + R k K k T
To sum up, Equations (37)–(39) describe the derived measurement update process, and Equations (35) and (36) describe the time update process of the combined double-time observation algorithm.

3.3. The Combined-Observation EKF of Multi-AUV Cooperative Navigation

In the previous section, the common EKF model has been redesigned and the improved EKF algorithm based on combined observation has been obtained. In Ref. [36], Sheng proposed a KF algorithm based on combined double-time observation, but only for a linear model of transfer alignment and based on a single sensor. This study extends the application of the newly designed algorithm to nonlinear systems for cooperative navigation, and the extension from a single sensor can make full use of information from multiple AUV data sources to improve the reliability and performance of the filter.
In a multi-AUV cooperative navigation system, assuming that there are N sensors for measurement, the corresponding measurement equation can be expressed as:
Z k i = h k i X k + V k i + e k i , i = 1 , 2 , … , N
where Z k i denotes the measurement vector of the i-th AUV at moment k ; h k i X k denotes the nonlinear vector dispersion function of the i-th AUV at moment k − 1 ; V k i denotes the noise vector of the i-th AUV at moment k ; and e k i denotes the unknown measurement systematic error of the i-th AUV at moment k . V k i is assumed to follow a Gaussian distribution with mean 0 and variance R k i , and the measured noise at the same time for each AUV is uncorrelated, as is the measured noise at different times for each AUV.
Then, based on the derivation process in Section 3.2, the measurement equation of the combined-observation EKF for multiple AUVs is constructed as:
Z k i = H k i X k − B k i X k − 1 + Y k i + N k i , i = 1 , 2 , … , N
where Z k i is the newly constructed measurement vector; B k is the measurement matrix of the i-th AUV at the time k − 1 , and N k i = V k i − V k − 1 i follows a Gaussian distribution with variance 2 R k i . As can be seen from the above equation, in the process of multi-AUV cooperative positioning and navigation, the error of the measurement system cannot be calibrated by a common EKF but can be effectively eliminated by constructing the combined-observation EKF model.
In this study, the parallel filter algorithm is used for the combined-observation EKF model with multiple AUVs such that:
Z k = Z k 1 T , Z k 2 T , ⋯ , Z k N T T
H k = H k 1 T , H k 2 T , ⋯ , H k N T T
B k = B k 1 T , B k 2 T , ⋯ , B k N T T
N k = N k 1 T , N k 2 T , ⋯ , N k N T T
Y k = Y k 1 T , Y k 2 T , ⋯ , Y k N T T
Then, at the fusion center, the combined-observation measurement equation for all AUVs can be expressed as:
Z k = H k X k − B k X k − 1 + Y k + N k , i = 1 , 2 , … , N
Similarly, the equation of state is shown in Equation (26), and the model for a two-moment combined-observation EKF consisting of multiple AUVs is shown in Equations (36)–(39).

4. Experimental Validation and Discussion

4.1. Simulation Test

4.1.1. Test Setting

According to the previous analysis, this section uses the MATLAB platform to simulate the new EKF method and verifies the performance and effectiveness of the improved cooperative navigation algorithm [50].
First, a multi-AUV cooperative navigation system is established, which consists of three AUVs, starting from three different positions and attitudes, and moving uniformly in a certain area. The starting attitude of the three AUVs is the same, but the starting position is different, and the three AUVs operate at a depth of −100 m underwater. The true linear velocity of the three AUVs is 10 m/s. The true angular velocities are 2 °/s.
In practice, the multi-AUV cooperative navigation system does not need to be equipped with different precision navigation equipment. Therefore, in the parallel cooperative navigation system in this section, all AUVs have the same configuration, and each AUV has the same or equal-precision navigation system and underwater acoustic communication equipment. The cooperative navigation system is a network system composed of multiple AUVs, as shown in Figure 1. While each AUV relies on SINS for autonomous navigation in the deep-sea environment, it cannot obtain other external auxiliary information such as GNSS. However, each AUV can continuously integrate the navigation information of adjacent AUVs, set the system update frequency of mutual observation f = 10   Hz , and observe and transmit the mutual distance and relative azimuth angle to each other. We adopt different information fusion algorithms to achieve cooperative navigation for comparison.
When there are unknown errors e k in the measurement system, the improved EKF based on combined observation and the common EKF are compared, and the error of e k in the relative distance measurement equation is set to a value of 20 m. The common EKF and the combined-observation EKF are used to fuse information for cooperative navigation, respectively. A total of 100 statistically independent realizations are composed using Monte Carlo simulation and only one of these simulations is given in this paper. The simulation time is 1000 s.
The estimated trajectories of the three AUVs against the reference used by the common EKF and the combined-observation EKF (COEKF) methods are shown in Figure 3. In this figure, the three blue solid lines indicate the model trajectories of the three AUVs; the three red lines show the trajectory estimated by the common EFK method when there is a measurement error e k ; and the three green lines show the trajectory estimated by the COEKF when there is a measurement error e k .

4.1.2. Results of the Test

The velocity and position errors of the three AUVs are shown in Figure 4 and Figure 5, respectively. In Figure 4 and Figure 5, the blue, red, and green dotted lines indicate the cooperative positioning error curves of AUV1, AUV2, and AUV3 based on the common EKF, respectively. The red, green, and blue solid lines indicate the cooperative positioning error curves of AUV1, AUV2, and AUV3 based on the combined-observation EKF, respectively.
The relative horizontal distance error curves for cooperative multi-AUV navigation based on the combined-observation EKF are shown in Figure 6; the red, green, and blue dashed lines show the relative horizontal distance error curves between AUV1 and AUV2, between AUV1 and AUV3, and between AUV2 and AUV3, respectively, when autonomous navigation is based on pure SINS. The red, green, and yellow solid lines show the relative horizontal distance error curves between the individual AUVs based on the combined-observation EKF for cooperative navigation. The horizontal distance error statistics for multi-AUV cooperative navigation based on the combined-observation EKF are shown in Table 1.
From Figure 4 and Figure 5, it can be seen that the velocity and position errors of the common EKF for cooperative navigation have a rapid tendency to disperse over time when there are unknown errors in the measurement system and the cooperative navigation relies only on relative observation information. As mentioned in the introduction, cooperative navigation is closely related to state estimation, and unknown errors in measurement equations lead to a decrease in estimation accuracy or even divergence [36]. Therefore, the combined-observation EKF can successfully eliminate the unknown error e k of the measurement system, effectively using the relative observation information between AUVs to delay the dispersion of cooperative navigation errors, and eliminating the influence of the measurement system errors on the dispersion of cooperative navigation errors. In addition to this, the horizontal positioning distance between the AUVs based on the combined-observation EKF algorithm can maintain high accuracy, as can be seen in Figure 6 and Table 1.
In summary, the simulation test results show that when there are unknown errors in the measurement system, the multi-AUV cooperative navigation and positioning algorithm based on the combined-observation EKF can effectively eliminate the influence of unknown errors, effectively use the relative observation information to delay the dispersion of navigation errors, improve the cooperative navigation and positioning accuracy to a certain extent, and has a high degree of flexibility and reliability.

4.2. Lake Experiments

4.2.1. Experiment Setting

The simulation test results above have proved that the combined-observation EKF algorithm proposed in this paper can effectively eliminate the measurement system error and, thus, can delay the dispersion of navigation errors. To continue to test the performance of the algorithm in practical engineering applications, we carried out lake experiments at Yuandang Lake in Suzhou city, using navigation data from three 9-ton surface boats for algorithm validation.
In this cooperative experiment, the reference value of each boat’s navigation position is provided by real-time kinematic (RTK) differential positioning data. The boats are equipped with a certain type of strapdown inertial navigation system, a RTK-GNSS receiver, and a navigation computer. The equipment diagram is shown in Figure 7. The equipment parameters of the SINS are shown in Table 2; the RTK-GNSS receiver includes a base station and multiple mobile terminals. The differential GNSS plane positioning accuracy is better than 0.5 m, the RTK plane positioning accuracy is 1 cm + 1 ppm, and the signal coverage area after access to the network is represented as a 10 km circle.
Before the cooperative navigation of the boats, the SINS of each boat independently completes the initial alignment. In the initial alignment process, the boats use GNSS to complete the analytical rough alignment and then use the GNSS position and velocity measurement to achieve fine alignment [51]. After the initial alignment of the SINS is completed, the SINS is used as the onboard equipment to obtain measurement information stably. Due to the lack of available ranging data between boats, the inter-ship ranging reference value is obtained by the difference in the position reference values at the corresponding time, adding 0.2% of the Gaussian white noise of the ranging value to simulate cooperative information. To obtain comparison results of different cooperative navigation algorithms for the unknown error of the measurement system, following Ref. [22], an error e k = 50 is added to the measurement system. To simulate multiple AUVs that cannot acquire GNSS signals underwater, each boat broadcasts to the other boats during the algorithm validation process, relying only on the relative measurement information shared between each boat for cooperative navigation, and each boat’s information broadcast frequency is set to 1 Hz. We used GNSS for clock synchronization before sailing, and sailing data comprising three segments of 500 s of circular motion after 2 h of sailing away from the pier were selected for algorithm verification, and the trajectory schematic is shown in Figure 8.

4.2.2. Results of the Lake Experiment

The velocity and position errors of the three boats’ cooperative navigation are shown in Figure 9 and Figure 10, respectively. In Figure 9 and Figure 10, the blue, red, and green dotted lines indicate the cooperative positioning error curves of Boat 1, Boat 2, and Boat 3 based on the conventional EKF, respectively. The red, green, and blue solid lines indicate the cooperative positioning error curves of each boat based on the combined-observation EKF.
The relative horizontal distance error curves for cooperative multi-boat navigation based on the combined-observation EKF are shown in Figure 11; the red, green, and blue dashed lines show the relative horizontal distance error curves between Boat 1 and Boat 2, between Boat 1 and Boat 3, and between Boat 2 and Boat 3, respectively, when autonomous navigation is based on pure SINS. The red, green, and blue solid lines show the relative horizontal distance error curves between the individual boats based on the combined-observation EKF for cooperative navigation.
From the results of the lake experiment in Figure 9 and Figure 10, we can find that when there is a measurement error in the actual measurement test of cooperative navigation, the position error based on the common EKF algorithm has a certain amount of error offset, and each shows a divergent trend; this shows that the common EKF cannot eliminate the influence of errors of the measurement system.
However, in these figures, it can be seen that the error value of the combined-observation EKF is smaller, and the respective error values are closer, which is more effective for the error processing of the measurement system. The horizontal distance error statistics for multi-AUV cooperative navigation based on the combined-observation EKF are shown in Table 3. It can be seen that, compared with Table 1, the error index is higher. Because the actual test is different from the ideal environment of the simulation, there are environmental factors and related sensor influences, such as GPS interference, that directly affect the measurement of the ideal position, but the performance of different algorithms under the same conditions can still show the superiority of the improved algorithm.
To sum up, this section verifies the feasibility and effectiveness of the multi-AUV cooperative navigation algorithm based on the combined-observation EKF proposed in this paper through simulation tests and lake experiments.

5. Conclusions

In this study, a cooperative navigation method based on a combined-observation algorithm is presented to solve the problem that unknown errors of measurement system are difficult to calibrate by common EKF methods, which affects the accuracy of multi-AUV cooperative navigation. The concept of combined observation is introduced into the underwater multi-AUV cooperative nonlinear system and re-establishes the EKF model. In the observation process of the algorithm, the measurement sampling values of the current moment and the previous moment are included. The combined observation can approximately eliminate the measurement system error at the algorithm level, avoid the impact of the measurement system errors on the performance of the filter, and improve the accuracy of cooperative navigation. Therefore, each AUV has the capability of bounded navigation and positioning errors, which can effectively reduce the impact of measurement system errors on the system’s navigation and positioning accuracy. Finally, the effectiveness and reliability of the improved algorithm are proven by simulation tests and lake experiments, respectively.

Author Contributions

G.S. and X.L. provided the core idea for this study. G.S. and Y.S. implemented the method and carried out the experimental evaluation. G.S. wrote the main manuscript. X.L., Y.S., G.S., X.C. and H.L. provided comments and suggestions for this paper. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported in part by the National Natural Science Foundation of China (Grant No. 51979041, 61973079, 41631175) and the Joint Fund Project of Equipment Preliminary Research and the Ministry of Education (6141A02011906).

Acknowledgments

We thank all the scientists and principal researchers who prepared and provided the research data. We would also like to thank our colleagues from the School of Instrument Science and Engineering who provided profound insights and expertise to our research.

Conflicts of Interest

The authors declare no conflict of interest.

Abbreviations

The following abbreviations are used in this manuscript:
AUVautonomous underwater vehicle
RADNAV radio navigation
GNSS global navigation satellite system
SINS strapdown inertial navigation system
KF Kalman filter
EKF extended Kalman filter
UKF unscented Kalman filter
COEKF combined-observation EKF
RTK real-time kinematic
DVL Doppler velocity log
TANterrain-assisted navigation
MCPmagnetic compass pilot
2D two-dimensional
3D three-dimensional

References

  1. Ma, X.; Liu, X.; Li, C.; Liu, J.; Wu, X. A novel Rauch–Tung–Streibel smoothing scheme based on the factor graph for auto omous underwater vehicles. Rev. Sci. Instrum. 2020, 91, 075109. [Google Scholar] [CrossRef] [PubMed]
  2. Villa, J.; Aaltonen, J.; Virta, S.; Koskinen, K.T. A Co-Operative Autonomous Offshore System for Target Detection Using Multi-Sensor Technology. Remote Sens. 2020, 12, 4106. [Google Scholar] [CrossRef]
  3. Ross, J.; Lindsay, J.; Gregson, E.; Moore, A.; Patel, J.; Seto, M. Collaboration of multi-domain marine robots towards above and below-water characterization of floating targets. In Proceedings of the 2019 IEEE International Symposium on Robotic and Sensors Environments (ROSE), Ottawa, ON, Canada, 17–18 June 2019; pp. 1–7. [Google Scholar]
  4. Klinger, W.B.; Bertaska, I.R.; von Ellenrieder, K.D.; Dhanak, M.R. Control of an unmanned surface vehicle with uncertain displacement and drag. IEEE J. Ocean. Eng. 2016, 42, 458–476. [Google Scholar] [CrossRef] [Green Version]
  5. Manderson, T.; Higuera, J.C.G.; Wapnick, S. Vision-based goal-conditioned policies for underwater navigation in the presence of obstacles. arXiv 2020, arXiv:2006.16235. [Google Scholar]
  6. Huang, H.; Tang, J.; Zhang, B.; Chen, J.C.; Zhang, J.J.; Song, X. A novel nonlinear algorithm for non-Gaussian noises and measurement information loss in underwater navigation. IEEE Access 2020, 8, 118472–118484. [Google Scholar] [CrossRef]
  7. Liu, P.; Wang, B.; Deng, Z.; Meng, Y.F. INS/DVL/PS tightly coupled underwater navigation method with limited DVL measurements. IEEE Sens. J. 2018, 18, 2994–3002. [Google Scholar] [CrossRef]
  8. Chang, L.; Di, J.; Qin, F. Inertial based integration with transformed INS mechanization in Earth frame. IEEE/ASME Trans. Mechatron. 2022, 27, 1738–1749. [Google Scholar] [CrossRef]
  9. Bobkov, V.A.; Kudryashov, A.P.; Mel’Man, S.V.; Shcherbatyuk, A.F. Autonomous underwater navigation with 3D environment modeling using stereo images. Gyroscopy Navig. 2018, 9, 67–75. [Google Scholar] [CrossRef]
  10. González-García, J.; Gómez-Espinosa, A.; Cuan-Urquizo, E.; García-Valdovinos, L.G.; Salgado-Jiménez, T.; Escobedo Cabello, J.A. Autonomous underwater vehicles: Localization, navigation, and communication for collaborative missions. Appl. Sci. 2020, 10, 1256. [Google Scholar] [CrossRef] [Green Version]
  11. Qu, J.; Sun, G.; Zhang, J. Optimality analysis for formation of Multi-AUV cooperative positioning based on genetic algorithm. In Proceedings of the 2021 IEEE International Conference on Real-Time Computing and Robotics (RCAR), Datong, China, 17–22 July 2021; pp. 578–583. [Google Scholar]
  12. Ling, H.; Zhu, T.; He, W.; Zhang, Z.; Luo, H. Cooperative search method for multiple AUVs based on target clustering and path optimization. Nat. Comput. 2021, 20, 3–10. [Google Scholar] [CrossRef]
  13. Lu, J.; Chen, X.; Luo, M.; Zhou, Y. Cooperative localization for multiple AUVs based on the rough estimation of the measurements. Appl. Soft Comput. 2020, 91, 106197. [Google Scholar] [CrossRef]
  14. Chang, L.; Qin, F.; Xu, J. Strapdown inertial navigation system initial alignment based on group of double direct spatial isometries. IEEE Sens. J. 2022, 22, 803–818. [Google Scholar] [CrossRef]
  15. Liu, X.; Liu, X.; Shen, H.; Li, P.; Zhang, T. Self-aided SINS for spiral-diving human-occupied vehicle in midwater. Assem. Autom. 2021, 41, 106–115. [Google Scholar] [CrossRef]
  16. Xanthidis, M.; Karapetyan, N.; Damron, H.; Rahman, S.; Johnson, J.; O’Connell, A.; O’Kane, J.M.; Rekleitis, I. Navigation in the presence of obstacles for an agile autonomous underwater vehicle. In Proceedings of the 2020 IEEE International Conference on Robotics and Automation (ICRA), Paris, France, 31 May–31 August 2020; pp. 892–899. [Google Scholar]
  17. Barker, L.D.; Jakuba, M.V.; Bowen, A.D.; German, C.R.; Maksym, T.; Mayer, L.; Boetius, A.; Dutrieux, P.; Whitcomb, L.L. Scientific challenges and present capabilities in underwater robotic vehicle design and navigation for oceanographic exploration under-ice. Remote Sens. 2020, 12, 2588. [Google Scholar] [CrossRef]
  18. Liu, X.; Liu, X.; Wang, L. SINS/DVL Integrated System with Current and Misalignment Estimation for Midwater Navigation. IEEE Access 2021, 9, 51332–51342. [Google Scholar] [CrossRef]
  19. Salavasidis, G.; Munafò, A.; Fenucci, D. Terrain-aided navigation for long-range AUVs in dynamic under-mapped environments. J. Field Robot. 2021, 38, 402–428. [Google Scholar] [CrossRef]
  20. Ge, H.; Chen, G.; Xu, G. Multi-AUV cooperative target hunting based on improved potential field in a surface-water environment. Appl. Sci. 2018, 8, 973. [Google Scholar] [CrossRef] [Green Version]
  21. Cao, X.; Sun, H.; Jan, G.E. Multi-AUV cooperative target search and tracking in unknown underwater environment. Ocean Eng. 2018, 150, 1–11. [Google Scholar] [CrossRef]
  22. Wang, X.; Yang, L.; Meng, D. Multi-UAV cooperative localization for marine targets based on weighted subspace fitting in SAGIN environment. IEEE Internet Things J. 2021, 9, 5708–5718. [Google Scholar] [CrossRef]
  23. Herlambang, T.; Nurhadi, H. Estimation of UNUSAITS AUV position of motion using extended Kalman filter (EKF). In Proceedings of the 2019 International Conference on Advanced Mechatronics, Intelligent Manufacture and Industrial Automation (ICAMIMIA), Batu, Indonesia, 9–10 October 2019; pp. 334–339. [Google Scholar]
  24. Zhang, F.; Wu, X.; Ma, P. Consistent Extended Kalman Filter-Based Cooperative Localization of Multiple Autonomous Underwater Vehicles. Sensors 2022, 22, 4563. [Google Scholar] [CrossRef]
  25. Xu, C.; Xu, C.; Wu, C.; Qu, D.; Liu, J.; Wang, Y.; Shao, G. A novel self-adapting filter based navigation algorithm for autonomous underwater vehicles. Ocean Eng. 2019, 187, 106146. [Google Scholar] [CrossRef]
  26. Wang, C.N.; Yang, F.C.; Vo, N.T.; Nguyen, V.T.T. Wireless Communications for Data Security: Efficiency Assessment of Cybersecurity Industry—A Promising Application for UAVs. Drones 2022, 6, 363. [Google Scholar] [CrossRef]
  27. Li, J.; Wang, J.; Yuan, R. AUV Path Following Formation Control Based on Extended Kalman Filter. In Proceedings of the 2021 IEEE International Conference on Mechatronics and Automation (ICMA), Takamatsu, Japan, 8–11 August 2021; pp. 12–16. [Google Scholar]
  28. Causa, F.; Opromolla, R.; Fasano, G. Cooperative navigation and visual tracking with passive ranging for UAV flight in GNSS-challenging environments. In Proceedings of the 2021 International Conference on Unmanned Aircraft Systems (ICUAS), Athens, Greece, 15–18 June 2021; pp. 1538–1547. [Google Scholar]
  29. Rego, F.; Pascoa, A. Cooperative single-beacon multiple AUV navigation under stringent communication bandwidth constraints. IFAC-PapersOnLine 2021, 54, 216–223. [Google Scholar] [CrossRef]
  30. Munafo, A.; Ferri, G. An acoustic network navigation system. J. Field Robot. 2017, 34, 1332–1351. [Google Scholar] [CrossRef]
  31. Farahi, F.; Yazdi, H.S. Probabilistic Kalman filter for moving object tracking. Signal Process. Image Commun. 2020, 82, 115751. [Google Scholar] [CrossRef]
  32. Ullah, I.; Shen, Y.; Su, X.; Esposito, C.; Choi, C. A localization based on unscented Kalman filter and particle filter localization algorithms. IEEE Access 2019, 8, 2233–2246. [Google Scholar] [CrossRef]
  33. Bai, M.; Huang, Y.; Chen, B.; Yang, L.; Zhang, Y. A novel mixture distributions-based robust Kalman filter for cooperative localization. IEEE Sens. J. 2020, 20, 14994–15006. [Google Scholar] [CrossRef]
  34. Hajiyev, C.; Vural, S.Y.; Hajiyeva, U. Adaptive Fading Kalman Filter with Q-adaptation for estimation of AUV dynamics. In Proceedings of the 20th Mediterranean Conference on Control & Automation (MED), Barcelona, Spain, 3–6 July 2012; pp. 697–702. [Google Scholar]
  35. Liu, X.; Qu, H.; Zhao, J. Maximum Correntropy Unscented Kalman Filter for Spacecraft Relative State Estimation. Sensors 2016, 16, 1530. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  36. Sheng, G.; Liu, X.; Wang, Z.; Pu, W.; Wu, X.; Ma, X. A transfer alignment algorithm based on combined double-time observation of velocity and attitude. Assem. Autom. 2022, 42, 542–551. [Google Scholar] [CrossRef]
  37. Ansari, K. Cooperative position prediction: Beyond vehicle-to-vehicle relative positioning. IEEE Trans. Intell. Transp. Syst. 2019, 21, 1121–1130. [Google Scholar] [CrossRef]
  38. EI-Sheimy, N.; Youssef, A. Inertial sensors technologies for navigation applications: State of the art and future trends. Satell. Navig. 2020, 1, 1–21. [Google Scholar]
  39. Chang, L.; Qin, F.; Jiang, S. Strapdown inertial navigation system initial alignment based on modified process model. IEEE Sens. J. 2019, 19, 6381–6391. [Google Scholar] [CrossRef]
  40. Zhang, F.; Gao, X.; Song, W. A Vision Aided Initial Alignment Method of Strapdown Inertial Navigation Systems in Polar Regions. Sensors 2022, 22, 4691. [Google Scholar] [CrossRef]
  41. Sun, C.; Zhang, Y.; Wang, G.; Gao, W. A New Variational Bayesian Adaptive Extended Kalman Filter for Cooperative Navigation. Sensors 2018, 18, 2538. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  42. Ma, X.; Liu, X.; Li, C.; Wu, X.; Zhang, Y. Multiple Autonomous Underwater Vehicles Cooperative Localization Based on Asynchronous Relative Observation. In Proceedings of the 2021 International Mobile, Intelligent, and Ubiquitous Computing Conference (MIUCC), Cairo, Egypt, 26–27 May 2021; pp. 3–8. [Google Scholar]
  43. Liu, L.; Wu, B.; Yang, P. Orbit Precision Determination & Self-Calibration Technique of Spacecraft; National Defense Industry Press: Beijing, China, 2005. [Google Scholar]
  44. Jian, M.; Qi, Q.; Yu, H.; Dong, J.; Cui, C.; Nie, X.; Zhang, H.; Yin, Y.; Lam, K.M. The extended marine underwater environment database and baseline evaluations. Appl. Soft Comput. 2019, 80, 425–437. [Google Scholar] [CrossRef]
  45. Xu, B.; Li, S.; Razzaqi, A.A. Cooperative localization in Harsh underwater environment based on the MC-ANFIS. IEEE Access 2019, 7, 55407–55421. [Google Scholar] [CrossRef]
  46. Kim, J. Cooperative localization and unknown currents estimation using multiple autonomous underwater vehicles. IEEE Robot. Autom. Lett. 2020, 5, 2365–2371. [Google Scholar] [CrossRef]
  47. Ma, Y.; Tian, C.; Jiang, Y. A multitag cooperative localization algorithm based on weighted multidimensional scaling for passive UHF RFID. IEEE Internet Things J. 2019, 6, 6548–6555. [Google Scholar] [CrossRef]
  48. Bouffaut, L. Detection and Classification in Passive Acoustic Contexts: Application to Blue Whale Low-Frequency Signals. Ph.D. Thesis, Institut de Recherche de l’Ecole Navale, Brest, France, 2019. [Google Scholar]
  49. Ben, Y.; Zang, X.; Li, Q.; He, J. A dual-state filter for a relative velocity aiding Strapdown Inertial Navigation System. IEEE Trans. Instrum. Meas. 2020, 70, 1000215. [Google Scholar] [CrossRef]
  50. Kim, T.; Park, T.H. Extended Kalman filter (EKF) design for vehicle position tracking using reliability function of radar and lidar. Sensors 2020, 20, 4126. [Google Scholar] [CrossRef]
  51. Huang, Y.; Zhang, Z.; Du, S.; Li, Y.; Zhang, Y. A high-accuracy GPS-aided coarse alignment method for MEMS-based SINS. IEEE Trans. Instrum. Meas. 2020, 69, 7914–7932. [Google Scholar] [CrossRef]
Remotesensing 15 00533 g001 550
Figure 1. The network structure of multiple AUVs.
Figure 1. The network structure of multiple AUVs.
Remotesensing 15 00533 g001
Remotesensing 15 00533 g002 550
Figure 2. Mutual observation of multiple AUVs.
Figure 2. Mutual observation of multiple AUVs.
Remotesensing 15 00533 g002
Remotesensing 15 00533 g003 550
Figure 3. The estimated trajectories of three AUVs.
Figure 3. The estimated trajectories of three AUVs.
Remotesensing 15 00533 g003
Remotesensing 15 00533 g004 550
Figure 4. Velocity error comparison curve.
Figure 4. Velocity error comparison curve.
Remotesensing 15 00533 g004
Remotesensing 15 00533 g005 550
Figure 5. Position error comparison curve.
Figure 5. Position error comparison curve.
Remotesensing 15 00533 g005
Remotesensing 15 00533 g006 550
Figure 6. Relative horizontal distance error for multi-AUV cooperative navigation.
Figure 6. Relative horizontal distance error for multi-AUV cooperative navigation.
Remotesensing 15 00533 g006
Remotesensing 15 00533 g007 550
Figure 7. Equipment and platforms in the boat.
Figure 7. Equipment and platforms in the boat.
Remotesensing 15 00533 g007
Remotesensing 15 00533 g008 550
Figure 8. Schematic diagram of the trajectory.
Figure 8. Schematic diagram of the trajectory.
Remotesensing 15 00533 g008
Remotesensing 15 00533 g009 550
Figure 9. Velocity error comparison curve.
Figure 9. Velocity error comparison curve.
Remotesensing 15 00533 g009
Remotesensing 15 00533 g010 550
Figure 10. Position error comparison curve.
Figure 10. Position error comparison curve.
Remotesensing 15 00533 g010
Remotesensing 15 00533 g011 550
Figure 11. Relative horizontal distance error for multi-boat cooperative navigation.
Figure 11. Relative horizontal distance error for multi-boat cooperative navigation.
Remotesensing 15 00533 g011
Table
Table 1. Relative distance error statistics.
Table 1. Relative distance error statistics.
ContentAUV12AUV13AUV23
RMSE/m2.14491.90122.6130
AME/m1.45241.43722.2626
Table
Table 2. Sensor errors.
Table 2. Sensor errors.
GyroAccelerometer
ConstantRandomConstantRandom
<0.02 ° / h <0.01 ° / h <500 μ g <500 μ g
Table
Table 3. Relative distance error statistics.
Table 3. Relative distance error statistics.
ContentAUV12AUV13AUV23
RMSE/m15.621915.721320.9426
AME/m13.219113.611316.1552
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Sheng, G.; Liu, X.; Sheng, Y.; Cheng, X.; Luo, H. Cooperative Navigation Algorithm of Extended Kalman Filter Based on Combined Observation for AUVs. Remote Sens. 2023, 15, 533. https://doi.org/10.3390/rs15020533

AMA Style

Sheng G, Liu X, Sheng Y, Cheng X, Luo H. Cooperative Navigation Algorithm of Extended Kalman Filter Based on Combined Observation for AUVs. Remote Sensing. 2023; 15(2):533. https://doi.org/10.3390/rs15020533

Chicago/Turabian Style

Sheng, Guangrun, Xixiang Liu, Yehua Sheng, Xiangzhi Cheng, and Hao Luo. 2023. "Cooperative Navigation Algorithm of Extended Kalman Filter Based on Combined Observation for AUVs" Remote Sensing 15, no. 2: 533. https://doi.org/10.3390/rs15020533

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop