The foundation of the investigation into USV motion modeling and control issues is the kinematic model. If the kinematic model is too exact, its equations of motion will invariably be nonlinear, the parameters will be tough to obtain, and it will be challenging to realize; if it is too basic, it will not accurately reflect the actual motion process of an USV, and the model will become meaningless. The kinematic analysis is divided into two aspects: from kinematic analysis, the catamaran USV is regarded as a mass point, and the relationship between its motion speed, heading angle and other variables and position is analyzed; from kinetic analysis, that is, the thrust of thrusters, fluid forces and interaction forces acting on the USV are studied. MMG model is suitable for self-research USV motion modeling analysis by virtue of its advantages of comprehensive force analysis and high flexibility.
2.1. MMG Motion Model
As shown in
Figure 1, the USV in the water environment is generally described based on two coordinate systems [
22]: the inertial coordinate system, i.e., the center point of the earth as the coordinate origin; and the attached coordinate system, i.e., the USV itself as the coordinate origin. The motion of the USV is divided into six states of motion with six degrees of freedom: displacement of the ship in the x, y and z axes, and rotation about the x, y and z axes. The USV motion state is represented in two different coordinate systems [
22], and its transformation relationship is in (
1):
where
u and
p represent the x-axis velocity and rotational angular velocity,
v and
q represent the y-axis velocity and rotational angular velocity, and
w and
r represent the z-axis velocity and rotational angular velocity.
and
represent transformation matrices, expressed in (
2) and (
3):
and
More detailed variable symbols are shown in
Table 1.
Neglecting the longitudinal rotational angular velocity, transverse rotational angular velocity and the velocity of the USV along the z-axis in the water environment makes
,
,
,
,
. The six-degree-of-freedom motion is simplified to a three-degree-of-freedom model, and the kinematic model is derived as (
4) by combining (
1), (
2) and (
3):
USVs are subjected to thrust of thrusters and drag of water, etc. when sailing in still waters. Each force and moment in the x-axis, y-axis and z-axes are shown in (
5):
where
denotes the hydrodynamic forces and moments acting on the hull and
P denotes the hydrodynamic forces and moments of the thruster (thrust of the thruster). The forces and moments acting on the hull can be decomposed into inertial hydrodynamic forces, viscous hydrodynamic forces [
23], as shown in (
6):
where
I denotes inertial fluid and
H denotes viscous fluid.
When the origin of the attached coordinate system is at the center of mass of the USV, the equation of motion of the USV is as follows:
where
m denotes the fully loaded mass of the USV,
denotes the moment of inertia at the z axis, and
N denotes the moment of momentum.
Assuming that the catamaran USV moves mainly on the stationary water surface, the three-degree-of-freedom equations of motion of the USV are obtained by combining (
5), (
6), and (
7):
where
P denotes dual propellers. Usually the viscous class fluid dynamics is much smaller than the other forces and can be neglected [
24], so only the inertial class fluid dynamics and dual thruster dynamics are analyzed and calculated in this study.
The force generated by the surrounding fluid medium on the USV due to the perturbation caused by the USV during its navigation is called inertial class hydrodynamics. According to the velocity potential flow theory of the flow field, when the USV makes a variable speed motion in an ideal water environment, it generates a 6×6 attached mass inertia matrix m as (
9):
Since the motion of the USV drives the motion of the surrounding fluid, the mass and moment of inertia of this fluid can be represented by the m-matrix, which is calculated as (
10):
where
represents the surface area of the waterline of the USV,
represents the velocity potential in the direction of degree of freedom
i, and
n represents the normal vector.
For a fixed USV profile, the attachment inertia matrix
is a constant independent of the motion variables. Since the object of study is based on symmetry in the x-o-z and x-o-y planes, for the 36 elements of the matrix, there are and only 8 independent non-zero elements, denoted as follows: (
11):
where
,
, and
are the attachment masses along the x, y, and z axes, respectively;
,
, and
are the attachment moments of inertia in the x, y, and z axes, and
and
denote the attachment mass static moments, which are not zero because the y-o-z plane is not symmetric. The kinetic energy of the surrounding fluid flow caused by the motion of an unmanned vessel in a water environment can be expressed as (
12):
where
,
,
,
,
,
, Substituting (
11) into (
12), we get
The momentum of the fluid perturbation motion is
, and the fluid momentum and momentum moments projected on each coordinate axis can be expressed as (
14)
where
H denotes the fluid momentum and
L denotes the fluid momentum moment.
Since the hydrodynamic force
and the hydrodynamic moment
, the expressions for the inertia-like hydrodynamic force and dynamic moment of the USV are obtained in (
15):
According to the the motion of the USV with three degrees of freedom, namely longitudinal displacement, lateral displacement and bow rocking, is simplified and analyzed. Let
,
and
, the expressions of inertia-like hydrodynamic forces and dynamic moments under the three-degree-of-freedom motion of the USV are obtained in (
16):
There are two methods to calculate the attachment mass and the moment of inertia of the USV: the regression equation of Zhou et al. and the regression equation of Clarke et al. [
25]. Zhou et al. performed a multiple regression analysis of the famous Motora’s atlas [
26] as:
where
B is the hull width,
L is the unmanned vessel length,
is the square factor, and
d is the sea draught.
When the thruster rotates in a uniform water environment, its thrust and torque are related to the paddle diameter
, forward velocity
, water density
, rotational speed
n, water motion viscosity coefficient
v, gravitational acceleration
g, etc. According to the applied gauge analysis, the hydrodynamic force (thrust) of the thruster can be expressed as
Let
, then we have:
Where,
is the thrust coefficient. Similarly, the torque absorbed by the thruster, i.e., the reverse torque caused by the rotation of the water on the thruster, is found as
Let
, then we have:
where
is the torque coefficient. The thrust coefficient
and torque coefficient
are both correlation functions of the incoming speed coefficient
. For the purpose of computer simulation, they can be expressed in the study of USV motion as
Where,
,
,
and
,
,
are the regression coefficients of the propeller open water characteristic curve [
27]. The unmanned vessel is usually accompanied by slight rotational transport and lateral motion during the forward motion, and the effect of the latter two motions is usually summarized as the effect on the propulsion derating, i.e., the effect of the maneuvering motion on
. The Norrbin model can be used [
28]:
where
B denotes the hull width,
denotes the diameter of the propeller,
denotes the longitudinal coordinates of the floating center,
= -0.9L and using the Hankescher formula [
29], for a double propeller boat,
= 0.54,
= 0.5
-0.18,
is the vessel’s rhombic coefficient,
, and
denotes the vessel immersion area.
The thrust from the thruster rotation is not all applied to the USV, part of it is the effective thrust, defined as
, and the other part is used to overcome the drag increment caused by the thruster installed at the stern of the USV, defined as the thrust derating
. In the practical engineering application of the USV, the dimensionless ratio of the thrust derating
to the thruster thrust
T is defined as the thrust derating factor
, expressed as follows:
The USV traveling at low speed is approximately in uniform motion, so the effective thrust
of a single thruster is equal to the drag
R in (
24), with
The combined thrust force of a catamaran unmanned vessel is expressed in the longitudinal direction as
where
denotes the effective thrust of the left thruster and
denotes the effective thrust of the right thruster. The twin thrusters produce torques
where
denotes the distance from the two thrusters to the ship’s central axis.
The simplified dynamics model [
30], analyzed by MMG modeling of the USV, is
where
, is the velocity vector of the USV in three degrees of freedom;
M is the inertial mass matrix of the USV;
C is the centripetal and Koch force coefficient matrix;
D denotes the drag coefficient matrix, and
denotes the forces along the longitudinal and lateral directions of the thruster and the torque along the z axis direction,
. According to [
30], the coefficient matrix (
28) is defined for each coefficient matrix as follows:
Based on the above analysis, a mathematical model of the three-degree-of-freedom motion of a twin-propulsion catamaran USV is established as shown below:
2.2. Parameter Identification
The mathematical model of three-degree-of-freedom motion of the catamaran is obtained according to the principle of MMG model, as shown in (
30). The unknown parameters include inertial mass coefficient matrix
M, centripetal force and Koch force coefficient matrix
C, and drag coefficient matrix
D. Among them,
M and
C can be calculated by physics equations according to the hull structure and weight;
D needs to be identified by USV condition test data for parameter identification.
Table 2 shows the basic USV parameters.
According to the basic parameters in
Table 2,
. Bringing
into equation (
17), it is calculated according to [
30] that
,
,
.
In (
29),
,
,
. The relationship between the thrust of the USV thruster and the speed of the USV is difficult to be found by the theoretical formula, and the parameters of the matrix
D are identified by experimental data in this study.
In the control system designed in this paper, the output power of the thruster is controlled by setting the control code
n (0→120), which corresponds to the input control voltage of the thruster (0V→5V). For a single thruster, the linear relationship between
and the voltage interval
is
The change in thruster control voltage in turn affects the thrust applied to the USV. According to the thruster data sheet, the relationship between individual thruster thrust and the controlled voltage is as follows:
The forward direction of the USV is subject to the combined thrust force of the dual thrusters as
and the torque
. Therefore, when the left and right thrusters have the same speed, the relationship between the control code
n and the combined thrust force can be obtained by substituting (
31) into (
32) as follows:
The experimental data were fitted to the relationship between the combined thrust force and the velocity using Matlab, and the linear relationship was obtained as shown in
Figure 2.
The linear relationship between the velocity and the combined thrust force is obtained by fitting:
. Therefore,
. When the left and right thrusters rotate at different speeds, the dual thrusters do slewing motion with torque
, and similarly,
, as shown in
Figure 3. Therefore, the mathematical model of the motion of the dual-propulsion catamaran is obtained as shown in (
34).
In order to verify the accuracy of the model constructed in this paper, the motion model is designed for slewing motion simulation using Matlab tools, and compared with the USV in the real water environment for slewing motion test to verify. The left and right thruster control codes are set to 20 and 15 respectively, the initial speed is 0 m/s, and the initial heading angle is 0
. After stabilization, the speed is 0.209 m/s, and the simulation result of slewing motion is shown in
Figure 3, and the calculated slewing diameter is about 7.38 m.
The test environment had a light wind, the control codes of the left and right thrusters of the USV were given as 20 and 15 respectively, the speed was about 0.246 m/s, three sets of slewing motion were completed, the software platform of the USV collected the longitude and latitude information to generate data tables, and Matlab was used to plot the slewing motion trajectory in the water environment as shown in
Figure 4, and the calculated slewing diameter was about 8 m.
Comprehensive analysis of
Figure 3 and
Figure 4 shows that the simulation results of the gyratory motion of the USV are consistent with its gyratory motion in the real water environment, which indicates that the motion model of the twin-thruster USV in this paper is more compatible with the real catamaran USV.