Next Article in Journal
Hybrid Explicit-Implicit FEM for Porous Media Multiphase Flow with Possible Solid-Phase Decomposition
Previous Article in Journal
An Improved ORB-KNN-Ratio Test Algorithm for Robust Underwater Image Stitching on Low-Cost Robotic Platforms
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Design of a High-Fidelity Motion Data Generator for Unmanned Underwater Vehicles

Naval University of Engineering, Wuhan 430033, China
*
Author to whom correspondence should be addressed.
J. Mar. Sci. Eng. 2026, 14(2), 219; https://doi.org/10.3390/jmse14020219
Submission received: 20 October 2025 / Revised: 18 January 2026 / Accepted: 19 January 2026 / Published: 21 January 2026
(This article belongs to the Section Ocean Engineering)

Abstract

To address the urgent need for high-fidelity motion data for validating navigation algorithms for Unmanned Underwater Vehicles (UUVs), this paper proposes a data generation method based on a parametric motion model. First, based on the principles of rigid body dynamics and fluid mechanics, a decoupled six-degrees-of-freedom (6-DOF) Linear and Angular Acceleration Vector (LAAV) model is constructed, establishing a dynamic mapping relationship between the rudder angle and speed setting commands and motion acceleration. Second, a segmentation–identification framework is proposed for three-dimensional trajectory segmentation, integrating Gaussian Process Regression and Ordering Points To Identify the Clustering Structure (GPR-OPTICS), along with a Dynamic Immune Genetic Algorithm (DIGA). This framework utilizes real vessel data to achieve motion segment clustering and parameter identification, completing the construction of the LAAV model. On this basis, by introducing sensor error models, highly credible Inertial Measurement Unit (IMU) data are generated, and a complete attitude, velocity, and position (AVP) motion sequence is obtained through an inertial navigation solution. Experiments demonstrate that the AVP data generated by our method achieve over 88% reliability compared with the real vessel dataset. Furthermore, the proposed method outperforms the PSINS toolbox in both the reliability and accuracy of all motion parameters. These results validate the effectiveness and superiority of our proposed method, which provides a high-fidelity data benchmark for research on underwater navigation algorithms.

1. Introduction

Unmanned Underwater Vehicles (UUVs) are essential tools for exploring oceanic mysteries and carrying out defense missions [1,2,3,4]. They have proven invaluable in various applications, including marine mapping and resource exploration [5,6,7]. The effectiveness and success of UUV missions rely heavily on the accuracy and reliability of their navigation systems [8,9]. Currently, the testing and validation of navigation algorithms primarily occur through sea trials, which are costly, time-consuming, and subject to the complexities of marine environments, such as currents and wind waves. These factors lead to uncontrollable test conditions, poor repeatability, and challenges in obtaining a reliable reference for comparison [10,11]. To overcome these challenges, research into motion data generators offers a viable alternative, providing a data source for algorithm testing within laboratory environments [12,13,14]. However, constructing a generator capable of producing data with high kinematic fidelity for navigation testing, without relying on vast amounts of real-world measurement data, remains a critical challenge. This study focuses precisely on addressing this challenge.
Researchers around the world have conducted extensive studies in this field. Existing approaches can be broadly categorized into two categories: The first is based on parametric excitation modeling [15,16], which is typically represented by the combination of idealized motion segments. This method treats a vehicle’s trajectory as a series of standard maneuvers, such as straight-line sailing and turning [17,18,19]. While this approach is computationally efficient, it is overly idealized and tends to feature abrupt state transitions. As a result, it fails to accurately simulate realistic, smooth dynamic processes [20]. The second type involves data-driven simulation methods [21,22,23], which utilize techniques such as interpolation or neural networks to learn motion patterns from historical data [24,25]. Although these methods can generate high-fidelity data, their effectiveness depends heavily on the availability of large volumes of high-quality measured data, which is often limited in practice [26]. This scarcity can significantly restrict their applicability. A direct solution approach is to combine both methods: utilizing a parametric model to ensure the physical structure while employing data-driven methods to optimize it. Therefore, the key challenge is accurately identifying multiple unknown parameters in the motion model using limited measured data.
This study addresses the above challenge by proposing a motion data generator for UUVs, based on parametric motion modeling and advanced identification algorithms. This generator aims to generate ideal motion data for navigation, enabling stable cruising and gentle maneuvering in calm waters and providing a benchmark reference for navigation algorithm research. The main contributions of this work are threefold: First, a decoupled 6-DOF parametric motion model is established, providing a theoretical foundation for realistic motion simulations. Second, a segmentation-identification framework is introduced that combines density-based clustering with dynamic identification algorithms, improving the accuracy of identifying unknown model parameters. Third, a comprehensive, high-fidelity data generation pipeline is developed for testing navigation algorithms, capable of synthesizing data sequences from IMU and AVP data. Experimental results show that the simulation data produced by our method exhibit over 88% reliability in approximating the motion characteristics of real-world datasets, effectively validating our proposed approach.
We have organized the paper in the following manner: Section 2 provides a detailed explanation of the construction of the LAAV motion model. Section 3 focuses on the parameter identification algorithm, which combines GPR-OPTICS and DIGA. Section 4 discusses the process of generating IMU and AVP data. Section 5 presents the experimental validation. Section 6 provides an analysis of the results. Finally, Section 7 concludes with a summary and discussion of application prospects. Additionally, Figure 1 presents a flowchart depicting the derivation, development, and validation of the underwater vehicle motion model.

2. Derivation of the Dynamics-Based LAAV Model

In the study of UUV motion modeling, two coordinate systems are defined: O n X n Y n Z n denotes the navigation coordinate system (n frame), which in this paper is represented by the North-East-Down (NED) geographic frame; O b X b Y b Z b represents the body-fixed frame (b frame), a right-handed orthogonal coordinate system that is rigidly attached to the vehicle. The origin of the b frame is located at the designed center of gravity of the UUV. The X b -axis is aligned with the longitudinal axis pointing toward the bow, the Y b -axis coincides with the transverse axis pointing to starboard, and the Z b -axis is perpendicular to the X b Y b -plane pointing downward. A diagram illustrating the coordinate frames is displayed in Figure 2.
By treating the UUV as a rigid body that is symmetric about the X b Z b -plane, with the center of buoyancy being vertically aligned with the center of gravity, a force analysis is performed in the b frame. Based on the theorems of linear and angular momentum, the 6-DOF dynamic equations of the vehicle are derived as follows:
( M I + M A ) V ˙ + C ( V ) V = G P + G V + G R + G T
In Equation (1), V = [ u , v , w , ω x , ω y , ω z ] T denotes the generalized velocity vector, while u , v , w are the three linear velocity components. Meanwhile, ω x , ω y , ω z are the three angular velocities about the axes in the b frame. V ˙ = [ a x , a y , a z , ω ˙ x , ω ˙ y , ω ˙ z ] T and a x , a y , a z represent the three-axis accelerations of the vehicle in the b frame. M I is the generalized mass matrix, M A denotes the added mass matrix, C ( V ) represents the Coriolis and centripetal force matrix, G V accounts for the hydrodynamic damping (and moments), G P corresponds to the static force matrix, G R describes the force (and moment) induced by the rudder, and G T represents the force (and moment) generated by the propeller.
To derive the LAAV motion model, the following simplifying assumptions are applied to Equation (1): Assuming the UUV is in a state of cruising and performing gentle, moderate maneuvers, with gravity and buoyancy essentially balanced, the quadratic damping term and higher-order hydrodynamic effects are neglected, and the Coriolis force (and moment) is disregarded. The simplified six-degrees-of-freedom dynamic equations for the underwater vehicle are given as follows:
( m X u ˙ ) u ˙ + X u u + ( W B ) θ = X t h r u s t ( m Y v ˙ ) v ˙ Y r ˙ ω ˙ z + Y v v + Y r ω z ( W B ) ϕ = Y t h r u s t ( m Z w ˙ ) w ˙ + Z w w ( W B ) = Z t h r u s t ( I x K ω ˙ x ) ω ˙ x + K ω x ω x ( z g B ) ϕ = K t h r u s t ( I y M ω ˙ y ) ω ˙ y + M ω y ω y ( z g B ) θ = M t h r u s t ( I z N ω ˙ z ) ω ˙ z N v ˙ v ˙ + N ω z ω z + N v v = N t h r u s t
In Equation (2), W represents gravity, and B denotes buoyancy. X u ˙ , Y v ˙ , and Z w ˙ are the added mass coefficients along the three translational axes, while K ω ˙ x , M ω ˙ y , and N ω ˙ z represent the added mass moment of inertia coefficients about the three rotational axes. The terms X u , Y v , Z w , K ω x , M ω y , and N ω z correspond to the linear damping coefficients. Y ω ˙ z denotes the sway–yaw coupled added mass coefficient, and Y ω z is the sway–yaw coupled damping coefficient. N v ˙ represents the yaw–sway coupled added mass moment of inertia coefficient, while N v signifies the yaw–sway coupled damping coefficient. The subscript “thrust” on the right-hand side of the equation denotes the control forces and moments along the corresponding axes, including those generated by the thruster, rudder, and stern plane.
The proposed LAAV model draws inspiration from the derivation methodology of the MMG model [27]. It formulates decoupled 6-DOF equations for linear and angular acceleration based on fundamental principles of mechanics.
This study employs a “motion decoupling and state idealization” approach, breaking down the spatial motion of the LAAV into horizontal and vertical planes, which are simplified into ideal states: variable-speed straight-line motion, steady turning, and diving or climbing. These physical simplifications allow for the derivation of analytical solutions for linear and angular velocities.

2.1. Mathematical Model of Three-Axis Linear Acceleration

2.1.1. Surge Acceleration

During steady-state navigation, the surge acceleration of a UUV, a x , is zero. Under accelerated or decelerated motion, the corresponding control force is governed primarily by the propeller thrust. The propeller thrust equation takes the following form:
X t h r u s t = K T ( J ) ρ | n | n D 4 ( 1 t )
In Equation (3), K T represents the thrust coefficient, J denotes the advance ratio, and K T = c 0 + c 1 J , c 0 , and c 1 are unsigned constants. This linear model and the use of unsigned coefficients simplify the derivation by neglecting the minor differences in thrust between positive and negative propeller rotations, which is a reasonable simplification for the purpose of motion data generation. ρ is the water density, n is the propeller’s rotational speed, and D is the propeller’s diameter. The advance ratio, J , takes the following form:
J = ( 1 σ ) u | n | D
In Equation (4), σ is the wake fraction, ranging from 0 to 0.4. By combining Equations (3) and (4) with the first expression in Equation (2), the longitudinal motion equation can be derived as follows:
( m X u ˙ u ˙ ) u ˙ + [ X u c 1 ρ | n | D 3 ( 1 σ ) ] u = c 0 ρ | n | n D 4
For a fixed UUV type, all coefficients in Equation (5) except the rotational speed, n , are constant, which yields the following simplified form:
( m X u ˙ ) u ˙ + A ( n ) u = B ( n )
Based on the actual maneuvering profiles of the vehicle, which typically involve operation at different speed settings during navigation, the propeller’s rotational speed can be approximated as constant when maintaining a fixed setting. Consequently, we initially model the surge velocity response as a first-order system. To achieve a more accurate representation of the actual speed variation curve, a second-order overdamped time-domain function is ultimately adopted as the mathematical model for the surge acceleration, expressed as follows:
u ( t ) = u 0 + Δ V ( 1 + e t / S 1 S 2 / S 1 1 + e t / S 2 S 1 / S 2 1 )
In Equation (7), u 0 represents the surge velocity, while Δ V denotes the variation in surge velocity.
S 1 = 1 ω n 1 ( ξ 1 ξ 1 2 1 ) ,   S 2 = 1 ω n 1 ( ξ 1 + ξ 1 2 1 )
S 1 and S 2 as the characteristic time constants of the second-order overdamped system, are distinct and not identical. At the same time, ξ 1 and ω n 1 are the damping ratio and natural frequency of the second-order system, respectively.
The surge acceleration, derived as the derivative of the velocity with respect to time, is expressed as follows:
a x ( t ) = u ˙ ( t )

2.1.2. Sway Acceleration

When analyzing the horizontal plane motion during a steady-turn maneuver, the sway acceleration of a UUV serves as its centripetal acceleration. With the yaw rate ω z and the surge velocity u , the relationship is expressed as follows:
a y = ω z · u

2.1.3. Heave Acceleration

When analyzing the vertical plane motion during diving or climbing maneuvers, based on the measured data and velocity vector decomposition, a relationship exists between the heave velocity, surge velocity, and pitch angle, as expressed below:
w = u · tan ( θ )
By differentiating the mathematical expression of the heave velocity with respect to time, we can obtain the model for the heave acceleration’s form:
a z = w ˙

2.2. Mathematical Model of Three-Axis Angular Rates

In inertial navigation, the angular velocity ω b = [ ω x , ω y , ω z ] T in the b frame is related to the Euler angle Θ = [ ϕ , θ , ψ ] T derivatives through the attitude transformation matrix T ( Θ ) :
ω b = T ( Θ ) Θ ˙
The models in this paper are established based on a small-angle assumption. When the roll and pitch angles are small, T ( Θ ) Ι , leading to the approximate relations:
ω x ϕ ˙ ,   ω y θ ˙ ,   ω z ψ ˙

2.2.1. Yaw Rate

When a UUV executes a turning motion by deflecting its rudder, it induces a change in its yaw rate. The simplified forms of the second and sixth equations in Equation (2) can be expressed as follows:
( m Y v ˙ ) v ˙ Y r ˙ ω ˙ z + Y v v + Y ω z ω z = Y δ δ ω z ( I z N ω ˙ z ) ω ˙ z N v ˙ v ˙ + N ω z ω z + N v v = N δ δ ω z
In the above equation, ω z represents the yaw rate, and δ ω z denotes the rudder angle.
Substituting Equation (9) into the two equations of Equation (15) and using the relation v ˙ = a y = ω z u , the variables v and v ˙ can be eliminated, yielding an expression for the relationship between the yaw rate and the rudder as follows:
[ Y v N v ( I z N ω ˙ z ) Y ω ˙ z ] ω ˙ z + [ ( m Y v ˙ ) u + Y v N v ( N v ˙ u N ω z ) + Y ω z ] ω z = ( Y δ Y v N v N δ ) δ ω z
When a UUV executes a turning maneuver via rudder deflection, the motion can be considered a steady-state turn, wherein the surge velocity remains constant. For a given type of vehicle, the coefficients in Equation (17) can be treated as constants. Consequently, Equation (17) can be simplified as follows:
T 1 ω ˙ z + T 2 ω z = K 1 δ ω z
By applying the Laplace transform to Equation (17), the transfer function relating the yaw rate to the rudder angle in the Nomoto model can be derived:
ω z ( s ) δ ω z ( s ) = K 1 T 1 s + T 2
Equation (18) indicates that the steering dynamics induced by rudder deflection can be simplified as a first-order system. To improve accuracy, the model is extended to a second-order system, which better captures high-frequency motion characteristics. The second-order model is expressed as follows:
ω z ( s ) δ ω z ( s ) = K 1 ( T 3 s + 1 ) T 1 T 2 s 2 + ( T 1 + T 2 ) s + 1
Equation (19) contains a zero at s = 1 / T 3 . Given that the value of T 3 is significantly smaller than those of T 1 and T 2 , the zero can be neglected, allowing Equation (19) to be simplified to the following:
ω z ( s ) δ ω z ( s ) = K 1 ( T 1 s + 1 ) ( T 2 s + 1 )
Therefore, the yaw rate of a UUV can be modeled as a second-order system. Based on full-scale trial data, small-scale UUVs, owing to their low mass and high maneuverability, typically exhibit an underdamped second-order response characteristic in their yaw rate when subjected to a step input of the rudder angle. This response is expressed as follows:
ω z ( t ) = K δ ω z δ ω z [ 1 e ξ 2 ω n 2 t ( ξ 2 1 ξ 2 2 sin ω d 1 t + cos ω d 1 t ) ]
In Equation (21), K δ ω z is an unsigned constant of proportionality, ξ 2 and ω n 2 represent the damping ratio and natural frequency, respectively, and ω d 1 denotes the actual damped natural frequency:
ω d 1 = ω n 2 1 ξ 2 2

2.2.2. Roll Rate

When a UUV executes a turning maneuver by deflecting its rudder, the dynamics of the roll angle are given by the fourth equation in (2), as follows:
( I x K ω x ) ϕ ¨ + K ω x ϕ ˙ ( z g B ) ϕ = K t h r u s t
As indicated by Equation (23), the variation in the roll angle constitutes a second-order system. In this study, and consistent with sea trial data, we define the mathematical model of the roll angle as a second-order underdamped time-domain function. Letting ϕ max represent the maximum roll angle attained during the turn, we express it as follows:
ϕ ( t ) = ϕ max [ 1 e ξ 3 ω n 3 t ( ξ 3 1 ξ 3 2 sin ω d 2 t + cos ω d 2 t ) ]
The parameters in Equation (24) are the damping ratio ξ 3 and natural frequency ω n 3 , with the actual frequency being defined as ω d 2 .
ω d 2 = ω n 3 1 ξ 3 2
The maximum roll angle ϕ max , from Reference [28], is given as:
ϕ max = arctan ω z u g
In Equation (26), g denotes the gravitational acceleration. This Equation represents the classical formulation for a steady-state horizontal turning condition.
Upon completion of the turning maneuver, the roll angle of the UUV gradually diminishes. Based on sea trial data, this decay process can be characterized by a cosine-exponential decay function, expressed mathematically as follows:
ϕ ( t ) = ϕ 0 e ς t cos ( ω n 4 t + β )
In Equation (27), ϕ 0 denotes the roll angle value at the end of the turning maneuver, ς represents the exponential coefficient, β = arccos ξ 4 is the initial phase, while ξ 4 and ω n 4 are the damping ratio and natural frequency, respectively.
Under the idealized condition of calm water and negligible sideslip, the mathematical model for the roll rate is the derivative of the roll angle’s expression with respect to time, given by the following equation:
ω x ( t ) ϕ ˙ ( t )

2.2.3. Pitch Rate

The relationship between the stern plane angle, δ s , and the pitch angle, θ , of the UUV can be derived from the fifth equation in (2), yielding the following:
( I y M ω ˙ y ) θ ¨ + M ω y θ ˙ + ( z g B ) θ = M δ δ s
By reformulating Equation (24) in the Laplace complex domain, the transfer function between the pitch angle and stern plane angle of the UUV is yielded as follows:
θ ( s ) δ s ( s ) = M δ ( I y M ω ˙ y ) s 2 + M ω y s + ( z g B )
We observe that the transfer function between these angles constitutes a second-order oscillatory system, expressed as follows:
θ ( s ) δ s ( s ) = K 2 τ 2 s 2 + 2 ς τ s + 1
Based on sea trial data, a second-order underdamped function is selected in this work as the mathematical model for the pitch angle. When the stern plane is deflected by an angle δ s , with an initial pitch angle of θ 0 , the pitch angle can be expressed as follows:
θ ( t ) = θ 0 + K δ s δ s [ 1 e ξ 5 ω n 5 t ( ξ 5 1 ξ 5 2 sin ω d 3 t + cos ω d 3 t ) ]
In Equation (32), K δ s is an unsigned proportional constant, ω d 3 is the actual oscillation frequency,
ω d 3 = ω n 5 1 ξ 5 2
ξ 5 , and ω n 5 are the damping ratio and natural frequency, respectively.
Under the idealized condition of calm water and a negligible angle of attack, we obtain the pitch rate by taking the derivative of the pitch angle with respect to time, as expressed below:
ω y ( t ) q ( t ) = θ ˙ ( t )
The LAAV model of the UUV contains 13 unknown parameters, denoted as ξ 1 , ω n 1 , K δ ω z , ξ 2 , ω n 2 , ξ 3 , ω n 3 , ς , ξ 4 , ω n 4 , K δ s , ξ 5 , and ω n 5 . For a specific type of UUV, these unknown parameters remain constant.

3. Parameter Identification Based on Trajectory Segmentation and Dynamic Identification

This study introduces a method for identifying model parameters by integrating three-dimensional (3D) trajectory segmentation using the GPR-OPTICS algorithm with a dynamic identification approach that utilizes the DIGA. The method employs measured data to determine the 13 unknown parameters in the LAAV model. The specific framework for parameter identification, which is based on trajectory segmentation and dynamic identification, is illustrated in Figure 3.

3.1. Three-Dimensional Trajectory Segmentation Based on the GPR-OPTICS Algorithm

3.1.1. Speed Segmentation Based on GPR

GPR is a nonparametric machine learning method based on Bayesian statistics. Its core idea is to treat a function as a random process and infer its posterior distribution from observed data. This approach not only provides predictive values but also quantifies the uncertainty associated with these predictions. A significant increase in predictive uncertainty often accompanies abrupt change points in trajectories, which makes GPR particularly suitable for detecting abrupt change points in trajectories in this study.
The procedure for detecting abrupt change points in trajectory speed using GPR is as follows:
  • Following preprocessing, the trajectory speed data undergoes normalization, and a fixed sliding window, along with a prediction window, is configured.
  • GPR modeling: We construct a Gaussian process regression model using the data in the sliding window, configured with a fixed noise parameter and a squared exponential kernel defined as
k ( x i , x j ) = σ f 2 exp ( ( x i x j ) 2 2 l 2 ) + σ n 2 δ i j
In Equation (35), σ f 2 is the signal variance, l is the length scale, σ n 2 is the noise variance, and δ i j is the Kronecker delta function (which equals 1 when i = j , and 0 otherwise).
  • Abrupt change point diagnosis: A point is identified as an abrupt change point if more than 50% of the actual values within the prediction window fall outside the 92% confidence interval.
  • Abrupt change point screening: To ensure that each segment has sufficient length, we remove the latter of any two adjacent abrupt change points that are too close.
The trajectory speed segmentation aims to distinguish segments of constant speed, acceleration, and deceleration in the speed data. Following the detection of an abrupt change point using GPR, this study calculates the average acceleration for each speed segment and classifies them by applying appropriate thresholds.
The acceleration discrimination threshold is adaptively determined based on the global statistical characteristics of acceleration. First, the procedure yields the instantaneous acceleration sequences of the complete trajectory speed between adjacent abrupt change points. Subsequently, the threshold σ t h is set based on their standard deviation σ A , as follows:
σ t h = κ σ A ( κ = 0.5 )
The purpose of configuring the κ coefficient in Equation (36) is to establish a buffer zone. This setup allows us to identify an acceleration (or deceleration) state only when the absolute value of acceleration significantly exceeds the range of natural fluctuations.
Figure 4 demonstrates the results of the trajectory speed segmentation. This method successfully segments the speed data, thereby paving the way for subsequent model identification by providing structured input.

3.1.2. Three-Dimensional Trajectory Segmentation Based on OPTICS Clustering

Ordered Point Identification for Cluster Structure (OPTICS) is a density-based clustering algorithm, and Bhattacharjee and Mitra [29] have provided a detailed discussion of this method. As an extension of DBSCAN [30], it overcomes DBSCAN’s sensitivity to the global parameter ε (neighborhood radius). Its core advantage lies in discovering clusters of arbitrary shapes and varying densities, making it particularly suitable for segmenting complex time-series data such as the motion states of underwater vehicles.
The procedure for implementing 3D trajectory segmentation using OPTICS is as follows:
  • Sub-trajectory segmentation:
Given that the LAAV model developed in this paper comprises six independent equations, the three-dimensional trajectory in NED coordinates is projected onto both horizontal and vertical planes for processing, enabling precise segmentation of the motion state. We implement a unified segmentation framework with distinct parameter configurations for each plane to accommodate the characteristic differences between turning maneuvers in the horizontal plane and diving/ascent motions in the vertical plane. To overcome the respective limitations of the fixed-window method (which struggles with precise boundary identification) and the Ramer–Douglas–Peucker (RDP) algorithm (which often results in uneven segment lengths), a novel dynamic sliding window strategy is proposed that integrates fixed windows with trajectory turning points.
  • Trajectory feature extraction:
The rational selection of feature values is crucial for achieving efficient trajectory segmentation. In response to the distinct motion characteristics of 3D trajectories across different planes, this paper adopts a differentiated feature selection strategy: for horizontal plane segmentation, the rate of change in the heading angle is utilized as the feature to identify turning patterns accurately; for vertical plane segmentation, the magnitude of the pitch angle is employed to distinguish effectively between diving and ascent motions. The selected features combine simplicity with high discriminative power, laying a solid foundation for subsequent high-precision clustering and segmentation.
  • OPTICS clustering of sub-trajectory segments:
The OPTICS algorithm performs density-based clustering on sub-trajectory segments using the distinct features selected for the horizontal and vertical planes, respectively. Through postprocessing of the clustering results, our approach can effectively identify trajectory segments representing specific motion patterns. The framework distinguishes between turning and straight-line segments in the horizontal plane and classifies diving/ascent segments versus straight-line segments in the vertical plane. Figure 5 shows the results of the 3D trajectory segmentation for the full-scale vehicle data.
The identified turning segments and diving/ascent segments are stored in dedicated data structures, providing a structured data foundation for subsequent dynamic identification tailored to different motion states.

3.2. Dynamic Identification Based on the DIGA

Building on the completed velocity and trajectory segmentation, parameter identification aims to estimate the LAAV model’s unknown parameters accurately. The Dynamic Immune Genetic Algorithm (DIGA), which integrates immune mechanisms into a genetic algorithm framework, is well-suited for identifying multiple parameters in highly nonlinear systems. In this study, DIGA is employed to identify 13 unknown parameters of the LAAV model using sea-trial data, overcoming common limitations of traditional methods such as convergence to local optima, slow convergence rates, and noise sensitivity.
The parameter identification problem is formulated as a nonlinear optimization model. Given the predefined parameter bounds, the objective function is defined as the root-mean-square error between the measured motion data and the model outputs. DIGA employs a two-layer cooperative optimization mechanism. The outer layer dynamically adjusts the crossover and mutation rates using a linear adaptive strategy. The inner layer then conducts parameter identification with these fixed hyperparameters, incorporating a vaccination mechanism to enhance population diversity. This improves the algorithm’s convergence speed and global search capability.
Figure 6 shows the dynamic identification process of the DIGA.
The key parameter settings for achieving DIGA recognition are shown in Table 1. Additionally, the initial value ranges for the 13 unknown parameters to be identified were set based on their specific physical significance as described in Section 2.
The identification work was conducted based on the actual sea trial data described in Section 5.2, utilizing a continuous 2000-s segment of this data. Table 2 lists the identification results for the 13 unknown parameters of the LAAV model under the UUV’s cruising conditions.
By substituting the specific parameters from Table 2 into the model, the model generated fitted data for the acceleration, turning, and submerged-surfaced motion segments. These were compared with the actual vessel measurement data, as shown in Figure 6.
As shown in Figure 7, the fitted curves for speed, yaw rate, roll angle, and pitch angle, representing the acceleration, turning, and diving/ascent segments, demonstrate a close agreement with the actual experimental data from the sea trial.

4. Inertial Navigation Data Generation

The LAAV model takes the rudder angle, stern plane angle, and speed variation as inputs and outputs the three-axis accelerations and three-axis angular rates of the underwater vehicle in a body-fixed frame. The core function of the inertial navigation data generation module is to simulate and generate IMU and AVP data algorithmically based on the above outputs [31]. In this study, the navigation frame is defined as the North-East-Down (NED) geographic frame.

4.1. IMU Data Generation with Noise

4.1.1. Accelerometer Output Processing

The accelerometer output is the specific force, which represents the difference between the absolute acceleration vector of the underwater vehicle and the gravitational acceleration vector. Equation (37) is the expression for the particular force.
f n = V ˙ n ( 2 ω i e n + ω e b n ) × V + g n
Here, ω i e n and ω e b n represent the Earth’s rotation rate and the position rate, respectively, with g = [ 0 , 0 , g ] T . The following derivation develops Equation (37) along the three axes of the NED geographic frame:
f N = a N + ( 2 ω i e sin φ + v E R N tan φ ) v E v N R M v D ) f E = a E ( 2 ω i e sin φ + v E R N tan φ ) v N ( 2 ω i e cos φ + v E R N ) v D ) f D = a D + ( 2 ω i e cos φ + v E R N ) v E + v N R M v N + g )
In Equation (38), ω i e represents the Earth’s rotation rate, and φ denotes the latitude.
The particular force output from the accelerometer can be calculated using Equation (39).
f b = C n b f n = C n b [ f N , f E , f D ] T
Here, C n b is defined as the coordinate transformation matrix from the n frame to the b fixed frame, the expanded form of which is presented in Equation (40).
C n b = cos θ cos ψ cos θ sin ψ sin θ sin ϕ sin θ cos ψ cos ϕ sin ψ sin ϕ sin θ sin ψ + cos ϕ cos ψ sin ϕ cos θ cos ϕ sin θ cos ψ + sin ϕ sin ψ cos ϕ sin θ sin ψ sin ϕ cos ψ cos ϕ cos θ
Here, C b n is the inverse matrix of C n b . Because the direction cosine matrix is an orthogonal matrix, its inverse matrix is equal to its transposed one. Therefore, C b n can be expressed as follows:
C b n = ( C n b ) 1 = ( C n b ) T

4.1.2. Gyroscope Output Processing

Equation (42) is the expression for the gyroscope output.
ω i b b = ω n b b + C n b ω i n n
Here, ω n b b is the projection of the angular velocity of the body frame with respect to the navigation frame. ω i n n is the projection of the angular velocity of the navigation frame with respect to the inertial frame and can be expressed as follows:
ω i n n = ω i e n + ω e n n ω i e cos φ + v E R N v N R M ( ω i e sin φ + v E R N tan φ )

4.1.3. Noise Injection

IMU noise typically originates from two primary sources of error: deterministic errors and random errors. Let the ideal accelerometer output be f b , the ideal gyroscope output be ω i b b , and the deterministic and random errors of the accelerometer and gyroscope be ε a , σ a , ε g , and σ g , respectively. The actual outputs of the accelerometer and gyroscope, denoted as f ˜ b and ω ˜ i b b , can be expressed using Equation (38):
f ˜ b = f b + ε a + σ a ω ˜ i b b = ω i b b + ε g + σ g

4.2. Synthetic AVP Ground Truth

The attitude, velocity, and position of the UUV at time step k are denoted as A ( k ) , V ( k ) , and P ( k ) , respectively, with the time step duration being denoted as t s .
The attitude of the underwater vehicle at time step k + 1 , denoted as A ( k + 1 ) , is expressed as follows:
A ( k + 1 ) = A ( k ) + J ( ϕ , θ , ψ ) ω · t s
In Equation (45), ω = [ ω x , ω y , ω z ] T . J ( ϕ , θ , ψ ) is the transformation matrix of the Euler angle rates. Equation (46) is the expression for the transformation matrix.
J ( ϕ , θ , ψ ) = 1 sin ϕ tan θ cos ϕ tan θ 0 cos ϕ sin ϕ 0 sin ϕ sec θ cos ϕ sec θ
In Equation (46), the symbols ϕ , θ , and ψ represent the roll angle, pitch angle, and yaw angle, respectively.
The velocity of the UUV at time step k + 1 , denoted as V n ( k + 1 ) , is expressed as
V n ( k + 1 ) = C b n ( V b ( k ) + a ( k ) · t s )
In Equation (47), a = [ a x , a y , a z ] T .
The position of the underwater vehicle at time step k + 1 , denoted as P ( k + 1 ) , is expressed as follows:
P ( k + 1 ) = P ( k ) + M V ¯ n · t s
In Equation (48), to reduce position errors, the average velocity over adjacent time steps, denoted as V ¯ n = ( V n ( k ) + V n ( k + 1 ) ) / 2 , is employed as the velocity for the position update. The expression for M is given by the following:
M = 1 R M 0 0 0 sec λ R N 0 0 0 1
In Equation (49), λ and h represent the longitude and depth, respectively, while R M and R N denote the radii of curvature of the meridian and prime vertical at the vessel’s location, respectively.

5. Simulation of Inertial Navigation Data and Validation with Experimental Data from the Sea Trial

5.1. Simulation of AVP and IMU Data

This section outlines the complete process for generating simulated inertial navigation data using the LAAV model. All IMU and AVP data presented here are simulated outputs from the model, created to showcase the functionality of the proposed data generator. The speed settings and control command sequences of the model are based on the motion characteristics derived from the sea-trial data to ensure kinematic plausibility. For example, two representative steady-state speed levels are defined: Speed Setting 1 at 2.5 m/s and Speed Setting 2 at 4.0 m/s.
Furthermore, this work aims to generate a set of “idealized” motion reference data with high kinematic fidelity for testing navigation algorithms. During data generation, only inertial device errors are considered, while auxiliary sensors and environmental disturbances are neglected. In other words, this generator outputs “idealized motion truth values containing only core IMU errors.”
In the algorithm, the gravitational acceleration is set to g = 9.8   m / s 2 . The initial geographic position is set to longitude λ = 120 ° 12 , latitude φ = 30 ° 38 , and a depth of 10 m. The initial velocity is 0 m/s, and the initial attitude is set to a heading angle ψ = 89 ° 15 , with roll and pitch angles being initialized to 0°. To comprehensively represent the UUV’s navigation states, the designed trajectory includes constant velocity, acceleration, deceleration, left and right turns, as well as ascending and descending maneuvers. The total mission duration is 1 h, and Table 3 summarizes the specific navigation plan.
The gyroscope has a deterministic error of 0.001 °/h and a random walk error of 0.001 °/√h, while the accelerometer has a deterministic error of 100 μg and a random walk error of 10 μg/√h.
Figure 8 displays the results of the simulation concerning the outputs of the inertial sensors.
Figure 9 and Figure 10 present the results of the AVP data generation.

5.2. Validation Utilizing Experimental Data from the Sea Trial

To evaluate the feasibility and practical performance of the proposed method, we conducted a comparative study on 6-DOF underwater motion trajectories. Utilizing real sea-trial data as ground truth, we compared the generated data from our proposed method with that from a parametric excitation modeling approach. This validation confirmed the correctness of our method and demonstrated its performance improvement over traditional approaches. The trajectory generator module of the widely recognized open-source PSINS toolbox [32] served as a representative parametric mechanism modeling method for comparison.
We utilized a segment of real-world operational data collected from a small UUV in calm coastal waters for experimental evaluation. This dataset covered approximately 10,000 s at a sampling rate of 1 Hz and included comprehensive navigation state information: geodetic coordinates (longitude, latitude, and depth), carrier coordinate system velocity components (u, v, w), attitude angles (roll, pitch, heading), and angular velocities (p, q, r). Environmental parameters recorded by the shipborne Conductivity-Temperature-Depth (CTD) sensor indicated calm sea conditions during the testing period, with weak ocean current disturbances estimated at about 0.01–0.03 m/s in the southwest direction. This situation satisfied the quasi-hydrostatic assumption, making it suitable for method validation.
To ensure objectivity in evaluation, the validation process followed the “segmented training-independent testing” principle:
  • Parameter Identification: The first 2000 s of continuous navigation data were extracted as the training segment. This segment was input into the “segmentation-identification” framework described in Section 3 to estimate the model parameters of the UUV (see Table 2).
  • Trajectory Simulation: Utilizing the identified parameters, motion simulations were conducted for the remaining time period. Both the proposed method and the PSINS toolbox trajectory generator were utilized for these simulations.
  • Performance Comparison: The simulation results from both methods were compared against the measured ground truth over the same remaining time period. This comparison included a quantitative evaluation of both kinematic trend consistency and point-to-point accuracy.
This workflow ensures that the training and testing data originate from the same source but remain mutually exclusive, thereby objectively validating the feasibility of the proposed method and demonstrating its performance improvement over traditional parametric modeling approaches applied to the same motion system. The validation results are presented in Figure 11.
To evaluate model performance comprehensively and validate the suitability of the kinematically consistent data for testing underwater navigation algorithms, we established acceptable error thresholds for key parameters—heading, roll, pitch, velocity, latitude/longitude, and depth. These thresholds are defined based on the requirement for kinematic fidelity and delimit the permissible error tolerance for deeming the simulated motion plausible.
Utilizing actual experimental data as the ground truth benchmark, we employed two quantitative metrics for evaluation:
Reliability: Quantified by hit rate. The hit rate is defined as the percentage of points in the generated data that fall within the predefined error band relative to the total number of points. A higher hit rate indicates that the generated data aligns more closely with the overall trend of the real data, signifying greater reliability.
Accuracy: Quantified by RMSE. RMSE reflects the average deviation between generated and actual data. A lower RMSE value indicates higher precision in point-by-point matching.
The credibility of generated data—its kinematic plausibility—is assessed comprehensively based on the above metrics. A high hit rate (high reliability) combined with a low RMSE (high precision) collectively form the quantitative foundation for high credibility.
The preset thresholds and their corresponding performance evaluation results are detailed in Table 4.
As shown in Table 4, our method achieves a hit rate exceeding 88% and an RMSE below the predefined threshold for all parameters evaluated. Additionally, it outperforms the PSINS toolbox in terms of both reliability and accuracy metrics. Detailed comparative results can be found in Table 5.
Table 3 results confirm that our method outperforms the baseline approach by a significant margin, with reliability improvements exceeding 9% across all parameters and positional accuracy enhancements surpassing 56%.

6. Discussion

This work focuses on navigation simulation. The following comparison primarily validates the method’s effectiveness in generating realistic motion data for testing navigation algorithms, rather than assessing the accuracy of physical dynamics.
The performance comparison between the proposed method and the PSINS toolbox reveals a distinct improvement in both reliability and accuracy across AVP parameters. Specifically, in terms of trajectory reliability, the improvement for attitude parameters is relatively modest (9.4–13.3%), indicating that the proposed method offers better modeling reliability. The improvement for velocity parameters is more pronounced (26.9%), while that for position parameters is the most substantial (56.7%). A similar trend is observed in trajectory accuracy: the reduction in RMSE is more minor for attitude errors (24.0–49.2%), increases significantly for velocity errors (73.1%), and is most notable for position errors (82.9–94.9%).
This observed pattern of progressively greater improvement—from attitude to velocity to position—is a direct manifestation of error propagation in inertial navigation estimation. From the perspective of AVP parameter generation principles, the estimation of attitude, velocity, and position parameters is essentially a cascading integration process based on angular velocity and linear acceleration outputs from the LAAV model. Therefore, initial modeling errors in attitude (angular motion) are amplified during the sequential integration steps: they introduce larger errors into velocity estimates, which then accumulate into the most significant errors in the final position. Our method’s more accurate modeling of the fundamental LAAV dynamics provides a superior starting point. This foundational advantage compounds through the navigation solution chain, resulting in the observed hierarchical gains where the most substantial accuracy improvements are logically realized in the final position estimates.
This discrepancy primarily stems from the design principles of its built-in trajectory generator. The trajectory generator within the PSINS toolbox typically employs parametric excitation modelling. While its trajectory construction method possesses versatility, the model fails to incorporate the specific hydrodynamic characteristics, maneuvering responses, and genuine motion transition processes of particular underwater vehicles. Consequently, the generated data exhibits fundamental disparities with real UUV navigation data in terms of kinematic continuity and dynamic realism.
In summary, the methodology presented herein has been thoroughly validated against the PSINS toolbox, demonstrating its effectiveness. The generated trajectory data exhibits significantly enhanced overall credibility and precision, thereby providing high-fidelity data support for the development and validation of complex underwater navigation algorithms.

7. Conclusions

This work presents a motion data generation framework designed to address the pressing demand for high-fidelity, idealized motion data in UUV navigation algorithm research. Its core objective is to produce kinematically consistent data to support the development and testing of inertial navigation algorithms. We introduce a modeling strategy that integrates GPR-OPTICS trajectory segmentation with DIGA-based parameter identification. Utilizing real-world sea trial data, we derived model parameters and implemented a high-fidelity motion data generator. Under typical cruising conditions, including low-dynamic maneuvering states, the generator synthesizes 6-DOF AVP data that closely approximates the actual motion characteristics of UUVs, thereby establishing a reliable, idealized benchmark for the development of underwater navigation algorithms.
The method proposed in this paper is primarily applicable to generating idealized motion references for UUVs during stable cruising in calm water conditions and for mitigating small-magnitude maneuver states. However, constrained by the current modeling framework, the generated data does not incorporate the effects of systematic errors from auxiliary navigation sensors or environmental disturbances. Consequently, the method’s kinematic fidelity may be limited when precisely simulating high-amplitude, high-dynamic maneuvers or when applied to complex real-world sea conditions with significant environmental disturbances. Future research will focus on expanding the applicability and environmental adaptability of this approach.

Author Contributions

L.L.: Conceptualization, Methodology, Software, Validation, Formal analysis, Investigation, Data curation, Writing—original draft, and Visualization. H.B.: Conceptualization, Resources, Writing—review and editing, Supervision, and Project administration. R.W.: Methodology, Validation, Writing—review and editing, Supervision, and Funding acquisition. W.Y.: Software, Investigation, and Data curation. H.L.: Software, Validation, and Supervision. All authors have read and agreed to the published version of the manuscript.

Funding

This research received no external funding.

Data Availability Statement

The data analyzed or generated during this study are not publicly available due to confidentiality agreements and institutional data security policies. Reasonable requests for data may be directed to the corresponding author, and we will endeavor to provide support within the constraints of these confidentiality requirements. This statement has been reviewed and approved by the Editorial Office in accordance with journal policy.

Acknowledgments

The authors would like to thank Harbin Engineering University for providing the experimental UUV trajectory data from the sea trial. During the preparation of this work, the authors used ChatGPT-5 and Grammarly in order to improve the language. After using these tools, the authors reviewed and edited the content as needed and take full responsibility for the content of the publication.

Conflicts of Interest

The authors declare no conflicts of interest.

Abbreviations

The following abbreviations are used in this manuscript:
UUVUnmanned Underwater Vehicle
6-DOFSix Degrees of Freedom
LAAVLinear and Angular Acceleration Vector
GPRGaussian Process Regression
DIGADynamic Immune Genetic Algorithm
OPTICSOrdering Points To Identify the Clustering Structure
RDPRamer–Douglas–Peucker
IMUInertial Measurement Unit
AVPAttitude, Velocity, and Position

References

  1. Alexandris, C.; Papageorgas, P.; Piromalis, D. Positioning systems for unmanned underwater vehicles: A comprehensive review. Appl. Sci. 2024, 14, 9671. [Google Scholar] [CrossRef]
  2. Cao, Q.; Feng, Y.; An, Y. Study of unmanned underwater vehicles in marine regulatory applications overview and application analysis of the two main types of AUVs and ROVs. Int. J. Ocean. Syst. Manag. 2025, 2, 67–106. [Google Scholar] [CrossRef]
  3. Liu, F.; Ma, Z.; Mu, B.; Duan, C.; Chen, R.; Qin, Y.; Pu, H.; Luo, J. Review on fault-tolerant control of unmanned underwater vehicles. Ocean Eng. 2023, 285, 115471. [Google Scholar] [CrossRef]
  4. Zhu, D.; Yan, T.; Yang, S.X. Motion planning and tracking control of unmanned underwater vehicles: Technologies, challenges and prospects. arXiv 2022, arXiv:2207.04360. [Google Scholar] [CrossRef]
  5. Aguzzi, J.; Thomsen, L.; Flögel, S.; Robinson, N.J.; Picardi, G.; Chatzievangelou, D.; Bahamon, N.; Stefanni, S.; Grinyó, J.; Fanelli, E.; et al. New technologies for monitoring and upscaling marine ecosystem restoration in deep-sea environments. Engineering 2024, 34, 195–211. [Google Scholar] [CrossRef]
  6. Wang, J.; Tang, Y.; Jin, S.; Bian, G.; Zhao, X.; Peng, C. A method for multi-beam bathymetric surveys in unfamiliar waters based on the AUV constant-depth mode. J. Mar. Sci. Eng. 2023, 11, 1466. [Google Scholar] [CrossRef]
  7. Pan, W.; Wang, Y.; Song, F.; Peng, L.; Zhang, X. UUV-assisted icebreaking application in polar environments using GA-SPSO. J. Mar. Sci. Eng. 2024, 12, 1845. [Google Scholar] [CrossRef]
  8. Du, X.; Hu, X.; Hu, J.; Sun, Z. An adaptive interactive multi-model navigation method based on UUV. Ocean Eng. 2023, 267, 113217. [Google Scholar] [CrossRef]
  9. Wang, Z.; Wang, H.; Yuan, J.; Yu, D.; Zhang, K.; Ren, J. Bio-inspired cooperative control scheme of obstacle avoidance for UUV swarm. J. Mar. Sci. Eng. 2024, 12, 489. [Google Scholar] [CrossRef]
  10. Hong, L.; Wang, X.; Zhang, D.-S. CFD-based hydrodynamic performance investigation of autonomous underwater vehicles: A survey. Ocean Eng. 2024, 305, 117911. [Google Scholar] [CrossRef]
  11. Zhang, J.; Zhang, T.; Liu, S.; Xia, M. A robust particle filter for ambiguous updates of underwater terrain-aided navigation. Mechatronics 2024, 98, 103133. [Google Scholar] [CrossRef]
  12. Li, C.; Chen, K.; Li, H.; Luo, H. Multisensor data fusion approach for sediment assessment of sewers in operation. Eng. Appl. Artif. Intell. 2024, 132, 107965. [Google Scholar] [CrossRef]
  13. Urvaev, I.N.; Bazykin, S.N. Computer simulation of hydrodynamics of an unmanned underwater vehicle. Meas. Monit. Manag. Control. 2024, 4, 58–67. [Google Scholar] [CrossRef]
  14. López-Barajas, S.; Sanz, P.J.; Marín-Prades, R.; Gómez-Espinosa, A.; González-García, J.; Echagüe, J. Inspection operations and hole detection in fish net cages through a hybrid underwater intervention system using deep learning techniques. J. Mar. Sci. Eng. 2023, 12, 80. [Google Scholar] [CrossRef]
  15. Yazdani, A.M.; Sammut, K.; Yakimenko, O.A.; Lammas, A.; Tang, Y.; Mahmoud Zadeh, S. IDVD-based trajectory generator for autonomous underwater docking operations. Robot. Auton. Syst. 2017, 92, 12–29. [Google Scholar] [CrossRef]
  16. Sun, J.; Ellerbroek, J.; Hoekstra, J.M. WRAP: An open-source kinematic aircraft performance model. Transp. Res. Part C Emerg. Technol. 2018, 98, 118–138. [Google Scholar] [CrossRef]
  17. Dolgov, D.; Thrun, S.; Montemerlo, M.; Diebel, J. Path planning for autonomous vehicles in unknown semi-structured environments. Int. J. Robot. Res. 2010, 29, 485–501. [Google Scholar] [CrossRef]
  18. Liu, X.; Hu, Y.; Mao, Z.; Tian, W. Numerical Simulation of the Hydrodynamic Performance and Self-Propulsion of a UUV near the Seabed. Appl. Sci. 2022, 12, 6975. [Google Scholar] [CrossRef]
  19. Chen, C.; Huang, W.; Wang, H.; Tian, L. A Novel High-Precision Trajectory Generator with Complex Motion Simulation for Enhanced Inertial Navigation Algorithm Testing. Actuators 2025, 14, 146. [Google Scholar] [CrossRef]
  20. Son, J.H.; Oh, S.H.; Hwang, D.H. Design of trajectory generator for performance evaluation of navigation systems. J. Position. Navig. Timing 2023, 12, 409–421. [Google Scholar] [CrossRef]
  21. Chen, K.; Shen, F.; Zhou, J.; Wu, X. Simulation platform for SINS/GPS integrated navigation system of hypersonic vehicles based on flight mechanics. Sensors 2020, 20, 5418. [Google Scholar] [CrossRef]
  22. Luis, C.E.; Vukosavljev, M.; Schoellig, A.P. Online trajectory generation with distributed model predictive control for multi-robot motion planning. IEEE Robot. Autom. Lett. 2020, 5, 604–611. [Google Scholar] [CrossRef]
  23. Potokar, E.; Lay, K.; Norman, K.; Benham, D.; Ashford, S.; Peirce, R.; Neilsen, T.B.; Kaess, M.; Mangelson, J.G. HoloOcean: A full-featured marine robotics simulator for perception and autonomy. IEEE J. Ocean. Eng. 2024, 49, 15. [Google Scholar] [CrossRef]
  24. Xue, Y.; Liu, Y.; Ji, C.; Xue, G. Hydrodynamic parameter identification for ship manoeuvring mathematical models using a Bayesian approach. Ocean Eng. 2020, 195, 106612. [Google Scholar] [CrossRef]
  25. Letizia, N.A.; Salamat, B.; Tonello, A.M. A novel recursive smooth trajectory generation method for unmanned vehicles. IEEE Trans. Robot. 2021, 37, 1792–1805. [Google Scholar] [CrossRef]
  26. Chen, K.; Wang, Z.; Fan, Z.; Yang, R.; Fang, Y. Trajectory Generator for Hypersonic Vehicle Based on Flight Dynamics. In Proceedings of the Advances in Guidance, Navigation and Control; Springer: Singapore, 2023; pp. 1151–1162. [Google Scholar]
  27. Yasukawa, H.; Yoshimura, Y. Introduction of MMG standard method for ship maneuvering predictions. J. Mar. Sci. Technol. 2015, 20, 37–52. [Google Scholar] [CrossRef]
  28. Molland, A.F.; Turnock, S.R. Marine rudders and control surfaces [electronic resource]: Principles, data, design and applications. Mar. Rudders Control. Surf. 2007, xi–xii, 71–232. [Google Scholar] [CrossRef]
  29. Bhattacharjee, P.; Mitra, P. A survey of density based clustering algorithms. Front. Comput. Sci. 2020, 15, 151308. [Google Scholar] [CrossRef]
  30. Luo, T.; Zheng, X.; Xu, G.; Fu, K.; Ren, W. An improved DBSCAN algorithm to detect stops in individual trajectories. ISPRS Int. J. Geo-Inf. 2017, 6, 63. [Google Scholar] [CrossRef]
  31. Veremeenko, K.K.; Savel’Ev, V.M. In-flight alignment of a strapdown inertial navigation system of an unmanned aerial vehicle. J. Comput. Syst. Sci. Int. 2013, 52, 106–116. [Google Scholar] [CrossRef]
  32. Fan, C.; Hu, X.; He, X.; Zhang, L.; Lian, J. Integrated polarized skylight sensor and MIMU with a metric map for urban ground navigation. IEEE Sens. J. 2017, 18, 1714–1722. [Google Scholar] [CrossRef]
Figure 1. Flowchart of the derivation, development, and validation of a motion model for underwater vehicles.
Figure 1. Flowchart of the derivation, development, and validation of a motion model for underwater vehicles.
Jmse 14 00219 g001
Figure 2. Schematic of the coordinate frames.
Figure 2. Schematic of the coordinate frames.
Jmse 14 00219 g002
Figure 3. Block diagram of the parameter identification based on trajectory segmentation and dynamic identification.
Figure 3. Block diagram of the parameter identification based on trajectory segmentation and dynamic identification.
Jmse 14 00219 g003
Figure 4. Results of trajectory speed segmentation.
Figure 4. Results of trajectory speed segmentation.
Jmse 14 00219 g004
Figure 5. Results of trajectory segmentation: (a) projected trajectory segmentation on horizontal plane; (b) projected trajectory segmentation on vertical plane.
Figure 5. Results of trajectory segmentation: (a) projected trajectory segmentation on horizontal plane; (b) projected trajectory segmentation on vertical plane.
Jmse 14 00219 g005
Figure 6. Flowchart of the DIGA’s dynamic identification process.
Figure 6. Flowchart of the DIGA’s dynamic identification process.
Jmse 14 00219 g006
Figure 7. Comparison of DIGA-based parameter identification fitting results with actual experimental data. (a) Trajectory speed fitting results; (b) yaw rate fitting results; (c) roll angle fitting results; (d) pitch angle fitting results.
Figure 7. Comparison of DIGA-based parameter identification fitting results with actual experimental data. (a) Trajectory speed fitting results; (b) yaw rate fitting results; (c) roll angle fitting results; (d) pitch angle fitting results.
Jmse 14 00219 g007
Figure 8. Simulated outputs of inertial sensors: (a) accelerometer outputs; (b) gyroscope outputs.
Figure 8. Simulated outputs of inertial sensors: (a) accelerometer outputs; (b) gyroscope outputs.
Jmse 14 00219 g008
Figure 9. AVP data simulation results: (a) attitude; (b) velocity.
Figure 9. AVP data simulation results: (a) attitude; (b) velocity.
Jmse 14 00219 g009
Figure 10. AVP data simulation results: (a) position; (b) 3D trajectory.
Figure 10. AVP data simulation results: (a) position; (b) 3D trajectory.
Jmse 14 00219 g010
Figure 11. Comparison of simulated AVP parameters with experimental data from sea trial: (a) attitude comparison; (b) velocity comparison; (c) position comparison; (d) 3D trajectory comparison.
Figure 11. Comparison of simulated AVP parameters with experimental data from sea trial: (a) attitude comparison; (b) velocity comparison; (c) position comparison; (d) 3D trajectory comparison.
Jmse 14 00219 g011
Table 1. Key parameters settings.
Table 1. Key parameters settings.
ParameterValueNote
Population Size50Real number encoding
Maximum Iterations200Real number encoding
Base Crossover Rate0.85Dynamically Adjusted
Base Mutation Rate0.08Dynamically Adjusted
Vaccine Extraction Ratio30%Proportion of Elite Individuals
Table 2. Identification results for unknown parameters.
Table 2. Identification results for unknown parameters.
ParameterPhysical SignificanceValue
ξ 1 Surge damping ratio1.1098
ω n 1 Surge natural frequency0.1017
K δ ω z Rudder yaw gain1.2197
ξ 2 Yaw damping ratio0.4231
ω n 2 Yaw natural frequency1.2350
ξ 3 Roll damping ratio0.6183
ω n 3 Roll natural frequency0.0299
K δ s Stern plane pitch gain1.2839
ξ 5 Heave damping ratio0.6926
ω n 5 Heave natural frequency0.0656
Table 3. UUV navigation plan.
Table 3. UUV navigation plan.
Speed ProfileRudderStern PlaneDuration
Accelerating from 0 to 2.5 m/s100 s
Accelerating from 2.5 to 4.0 m/s200 s
Maintaining 4.0 m/s10°400 s
Maintaining 4.0 m/s200 s
Maintaining 4.0 m/s−30°400 s
Decelerating from 4.0 to 2.5 m/s200 s
Maintaining 2.5 m/s−10°400 s
Maintaining 2.5 m/s10°200 s
Maintaining 2.5 m/s400 s
Accelerating from 2.5 to 4.0 m/s200 s
Maintaining 4.0 m/s20°500 s
Maintaining 4.0 m/s −3°200 s
Decelerating from 4.0 to 2.5 m/s200 s
Table 4. Threshold settings and performance evaluation results.
Table 4. Threshold settings and performance evaluation results.
ParameterThresholdPSINSProposed Method
Hit RateRMSEHit RateRMSE
heading (°)5 *85.5%3.37996.5%2.561
roll (°)0.2 *86.0%0.13099.3%0.066
pitch (°)1 *86.2%0.35095.6%0.266
velocity (m/s)0.2 *69.0%0.29095.9%0.078
longitude/
latitude (m)
250 *32.2%413688.9%210.5
depth (m)3 *30.1%9.84995.0%1.680
* Threshold Basis: The threshold is a quantitative kinematic benchmark used to distinguish between usable navigation test data and kinematic distortion data. This value is set between the characteristic maneuver’s amplitude and the acceptable error limit evaluated by the algorithm.
Table 5. Comparison of performances.
Table 5. Comparison of performances.
Parameter CategoryParameterReliability
Improvement
Accuracy
Improvement
attitudeheading11.0%24.2%
roll13.3%49.2%
pitch9.4%24.0%
velocityvelocity26.9%73.1%
positionlatitude/longitude56.7%94.9%
depth64.9%82.9%
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

Lin, L.; Bian, H.; Wang, R.; Yang, W.; Li, H. Design of a High-Fidelity Motion Data Generator for Unmanned Underwater Vehicles. J. Mar. Sci. Eng. 2026, 14, 219. https://doi.org/10.3390/jmse14020219

AMA Style

Lin L, Bian H, Wang R, Yang W, Li H. Design of a High-Fidelity Motion Data Generator for Unmanned Underwater Vehicles. Journal of Marine Science and Engineering. 2026; 14(2):219. https://doi.org/10.3390/jmse14020219

Chicago/Turabian Style

Lin, Li, Hongwei Bian, Rongying Wang, Wenxuan Yang, and Hui Li. 2026. "Design of a High-Fidelity Motion Data Generator for Unmanned Underwater Vehicles" Journal of Marine Science and Engineering 14, no. 2: 219. https://doi.org/10.3390/jmse14020219

APA Style

Lin, L., Bian, H., Wang, R., Yang, W., & Li, H. (2026). Design of a High-Fidelity Motion Data Generator for Unmanned Underwater Vehicles. Journal of Marine Science and Engineering, 14(2), 219. https://doi.org/10.3390/jmse14020219

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