J Navig Port Res > Volume 47(2); 2023 > Article
Choi and Jun: Implementation of Ship Trajectory Following Algorithm

ABSTRACT

As interest in autonomous ships continues to grow, researchers around the world are dedicating themselves to the development of relevant technologies. However, these technologies are not yet perfect. Several technical problems remain unresolved. To address these problems, this study presents the implementation of a ship trajectory algorithm for group navigation, where followers can navigate by following the trajectory of a leader. The algorithm works by storing the leader's trajectory as a follow-point and by calculating the azimuth using the line-of-sight guidance law to reach it. A course-keeping controller based on PD control is implemented to follow the target course and a speed control algorithm is designed to prevent collisions. Sea experiments were conducted using 1 m class small RC model boats to verify the proposed algorithm. The follower successfully navigated by following the leader's trajectory and maintained the designated distance to the forward boat. This study is significant in that it implements an algorithm for the follower to follow the trajectory of the leader rather than directly following it as in conventional methods, and verifies it through sea experiments.

Introduction

Recently, autonomous ships are an important issue for the maritime industry. Shipping-advanced countries such as the European Union, Norway, the UK, Finland and Japan are leading the technology development in an effort to dominate the autonomous ship market (Park et al., 2018; Kim, 2022). However, in order to commercialize autonomous ships, several technical problems needed to be solved. In other words, technologies such as ship-to-shore communication, cybersecurity, equipment failure prediction and maintenance must be perfectly developed(Jung et al., 2019; Chae et al., 2020). These problems become even more fatal when they occur during ocean voyages.
The authors proposed a group navigation system as a method to address the problems facing autonomous ships (Choi and Jun, 2022). In this system, a leader and several followers are grouped together to navigate. The leader navigates along the designated route from the starting point to the destination, and the followers follow the leader’s route autonomously. In a previous study, a group navigation system consisting of one leader and two followers was established, and simulations were performed using a scale model of an actual ship.
The aim of this study is to implement a ship trajectory tracking algorithm, and to verify through sea experiments using 1 m class RC (Radio Control) model boats. The algorithm is designed for the follower to receive the leader’s position in real-time, store it as a follow-point, calculate the azimuth to the follow-point, and follow it. As the follower navigates along the leader’s trajectory, it can safely navigate without deviating from the predetermined route.
The structure of the paper is as follows. In Chapter 2, the ship trajectory following algorithm, course-keeping and speed control of the ship are described, along with the ship dynamic model required for controller design. In Chapter 3, the ship dynamic model is identified through turning experiments using 1 m class RC model boats, and the parameters of course-keeping controller are tuned. Then, experiments are conducted to verify the implemented ship trajectory following algorithm. Finally, Chapter 4 presents conclusions and future research objectives.

Trajectory following algorithm

2.1 Trajectory following method

Ship trajectory following is a method where a follower navigates along the trajectory of a leader. This approach ensures that the follower can safely navigate without deviating from the leader’s planned route. Moreover, since it requires only minimal speed control to prevent collisions between ships, this method is relatively simple to implement. Fig. 1 shows the structure of the ship trajectory following.
Here, (xF, yF) is the current position of the follower, (xL, yL) is the current position of the leader, (xk, yk) is the k-th follow-point (FPk). And dfp is the distance from follower to the first follow-point, ψfp is the azimuth from follower to the first follow-point and dfwd is the distance from follower to the forward ship, which are calculated using the line-of-sight guidance law as shown in Equations (1) to (3).
(1)
dfp=(x1-xF)2+(y1-yF)2
(2)
ψfp=arctan(y1-yFx1-xF)
(3)
dfwd=(xL-xF)2+(yL-yF)2
When the leader starts navigating from the starting point to the destination, the follower receives the leader’s position every second and stores it as a follow-point. Also, the follower calculates the azimuth (ψfp) and distance (dfp) from its current position (xF, yF) to the first follow-point (x1, y1) every second. If the dfp is less than a pre-set convergence radius, the next follow-point is automatically updated to the first follow-point. Then, the follower calculates the ψfp and dfp to the updated first follow-point and continues to follow it. The convergence radius is set to 7.5 m, considering the GPS position accuracy and the steering characteristics of the experimental boats.
The follower calculates the distance to the forward ship (dfwd) every second and controls its speed based on the forward safe distance (FSD), which is the distance between ships set to prevent collisions. The FSD was set at 12.2 times the length of the ship by introducing the concept of ship safety domain(Choi and Jun, 2022).

2.2 Controller design

(1) Course-keeping control
To follow the desired course, the researchers designed a course-keeping controller based on PD (Proportional-Derivative) control. The experimental boats used in this study are small model boats made of fiberglass with a length of about 1 m and are vulnerable to external forces such as wind and current, causing significant leeway. For this reason, COG (Course Over Ground) was used as the control variable instead of the ship’s yaw angle. Fig. 2 shows the block diagram of the course-keeping controller used in this study.
Here, KP is the proportional gain, KD is the derivative gain, ψd is the ship’s desired course, ψ is ship’s current course, e is course error, δc is the command rudder angle and δ is the ship’s actual rudder angle.
The COG (ψ) is obtained from the GPS sensor and is fed back to the controller. The command rudder angle (δc) is calculated using ψ and is input to the servo motor to control the rudder angle. The PD control formula for calculating the command rudder angle is shown in Equation (4).
(4)
δc(t)=KP×e(t)+KD×de(t)dt
To ensure proper operation of the designed course-keeping controller, the PD control parameters KP and KD must be tuned to obtain optimal values. In this study, tuning of the parameters was carried out using the Nomoto model as the ship dynamic model.
The Nomoto model represents the motion of a ship with the rudder angle (δ), rate of turn (r) and steering quality indices (K, T1, T2, T3), as shown in Equation (5) (Nomoto et al., 1957). This model has the advantage of providing an easy way to understand the dynamics of a ship, although it has many limitations in expressing the highly nonlinear motion of a ship.
(5)
T1T2r¨+(T1+T2)r˙+r=K(δ+T3δ˙)
Assuming that T = T1 +T2T3, Equation (5) can be expressed as a first-order equation.
(6)
Tr˙+r=Kδ
If Equation (6) is expressed as a transfer function that represents the relationship between the input and output, it can be represented as Equation (7).
(7)
rδ(s)=K1+Ts
Since the ship dynamic model is represented by the rudder (input) and rate of turn (output), it is necessary to estimate the unknown model parameters based on rudder angle and rate of turn data obtained from the system. To estimate the parameters, an ARX (AutoRegressive with eXternal input) model was used.
The ARX model is widely used for system identification in submarines, small sailboats, small model boats, and similar systems (Velasco et al., 2007, Kim, 2011, Dantas et al., 2013, Tranzatto, 2015, Choi and Jun, 2020). The ARX model can be expressed as Equations (8) to (10) (Ljung, 1987).
(8)
A(q)y(t)=B(q)u(t-nk)+e(t)
(9)
A(q)=1+a1q-1+a2q-2++anaq-na
(10)
B(q)=b1+b2q-1+b3q-2++bnbq-nb+1
Where, q is a delay operator, u(t) is the input at time t, y(t) is the output at time t, e(t) is the disturbance signals or noise. A(q) is a polynomial of output, B(q) is a polynomial of input, na is number of poles, nb is number of zeros, nk is pure time-delay in the system. The parameters a and b are estimated by the least squares method.
(2) Speed control
To avoid ship collisions, an algorithm was developed to control the speed of the follower. The algorithm calculates the distance to the forward ship (dfwd) every second and compares it to the pre-set FSD. Based on the results of the comparison, an appropriate pulse width signal is sent to the ESC (Electronic Speed Controller) to adjust the propeller rotation. The speed control algorithm for the follower is described as follows.
If dfwd is between FSD and 1.2 times FSD (FSD≤ dfwd ≤ 1.2 × FSD), the pulse width is set to 1,570 μs to maintain the distance to the forward ship. If dfwd is greater than or equal to 0.5 times FSD and less than FSD (0.5 × FSD≤ dfwd < FSD), the pulse width is decreased to 1,560 μs to increase the distance to the forward ship. If dfwd is greater than 1.2 times FSD (1.2 × FSD < dfwd), the pulse width is increased to 1,580 μs to prevent excessive increase in the distance between ships. If dfwd is less than 0.5 times FSD (dfwd < 0.5 × FSD), the pulse width is set to 1,500 μs to stop the propeller rotation.

Experiments and results

3.1 Experimental boat

The three boats used in the experiments are 1 m class model RC boats, Leader, Follower 1, Follower 2, as shown in Fig. 3. The specifications of the experimental boats are listed in Table 1. The length of the experimental boats is about 1.3 m and 0.9 m, with a maximum draft of around 10 cm and 7 cm. Therefore, the boats are highly influenced by sea conditions such as wind or waves.
The Leader and Followers have the same hardware configuration, but differ in their specifications. Each boat is equipped with a propeller, BLDC (Brushless Direct Current) motor, ESC, rudder and servo motor. Pulse width modulation controls the BLDC motor and servo motor with a pulse frequency of 50 Hz (20 ms). The BLDC motor stops at a pulse width of 1,500∼1,550 μs, and rotates clockwise when the pulse width exceeds 1,550 μs, with the rotation speed increasing up to a maximum pulse width of 2,000 μs. The servo motor is at 0° (midship) when the pulse width is 1,500 μs, and rotates 1° to starboard for every 10 μs increase in pulse width, and 1° to port for every 10 μs decrease. Two LiPo (Lithium-Polymer) batteries power the boats, and the ESC supplies electricity to the BLDC motor and servo motor.
To measure the heading angle, an IMU (Inertial Measurement Unit) is installed on each boat with 0.5° accuracy. A GPS sensor is also installed with 2.5 m position accuracy, 0.05 m/s velocity accuracy, 0.3° course accuracy.
The control board is a LattePanda, which is an SBC (Single Board Computer) based on the Windows 10. It includes a single board microcontroller, Arduino Leonardo, to collect data from the IMU, GPS and control the BLDC motor and servo motor. It is powered by a LiPo battery and operates the IMU and GPS sensors.
To facilitate communication between the boats, a Wi-Fi mobile router and an RF receiver are installed on each boat. TCP/IP socket programming is used for Wi-Fi communication, and the three boats exchange information including position, speed, course, and heading. RF communication is used as a backup method to retrieve the boat in case of system failure.

3.2 Identification experiment

Turning Experiments were conducted twice to identify and verify ship dynamic model parameters, and tune PD control parameters. The motor rpm was kept constant, and various rudder angles were used to obtain rate of turn data. The data sampling interval is 1 second. The first experimental data was used to identify ship dynamic model parameters, and the second experimental data was used to verify the identified model. The experimental area is open to the north, as shown in Fig. 4. During the experiments, the wave height was maintained at 0.3 m or less and the wind speed was maintained at 1.8 m/s or less.
Fig. 5 shows the rudder angle and rate of turn of each boat in the first turning experiment. The black dashed line represents the rudder angle, and the red, green and blue solid lines represent the rate of turn of each boat. Leader had twice the rate of turn compared to Followers at the same rudder angle. The maximum rates of turn at the maximum rudder angle were 63.9°/s for Leader, 30.4°/s for Follower 1 and 32.1°/s for Follower 2. And even if the rudder angle was kept constant, the turn rate oscillated. This is considered to be because the experimental boats react sensitively to marine environmental factors.
The ARX model parameters were identified using the data of rudder angle and rate of turn by the MATLAB System Identification Toolbox. Transfer functions for the dynamic models of Leader (GL (z)), Follower 1 (GF1(z)), and Follower 2 (GF2(z)), which show the relationship between the rate of turn and the input rudder angle, are given in Equations (11) to (13).
(11)
GL(z)=rLδL(z)=0.2352+1.258z-11-0.1179z1
(12)
GF1(z)=rF1δF1(z)=0.09121+0.3122z-11-0.2406z1
(13)
GF2(z)=rF2δF2(z)=0.1658+0.2766z-11-0.2692z1
Fig. 6 shows the rudder angle and rate of turn obtained by second turning experiment and ARX model. The yellow solid lines represent the rate of turn calculated by ARX model of each boat. The root mean square error (RMSE) which represents the difference between the values by the ARX model and the experiments were 7.4°/s for Leader, 5.0°/s for Follower 1 and 4.9°/s for Follower 2. Considering that the rate of turn data from the turning experiment oscillates due to external environmental factors, the identified ARX models are suitable for representing the ship dynamic model of each experimental boat.
Using the dynamic models of the experimental boats, the PD control parameters were tuned to minimize overshoot and prevent excessive use of the rudder. Parameter tuning was performed using MATLAB Simulink and the control parameters were KP = 0.2 and KD = 0.4 for Leader, and KP = 0.4 and KD = 0.8 for Followers.

3.3 Verification experiment

Sea experiments were conducted to verify the proposed algorithm. The FSD was set to 12.2 m, and the target speed was set to 1.5 m/s. Table 2 lists the predetermined waypoint, course and distance. The courses were set to change about 50° to starboard at each waypoint, and the distance between waypoints was about 50 m. The experiment was conducted five times, and almost similar results were obtained each time. During the experiments, the wave height was maintained at 0.3 m or less and the wind speed was maintained at 1.7 m/s or less.
Fig. 7 shows the entire trajectories of the three boats, and waypoints are indicated by star markers. Fig. 8 shows the XTD (Cross Track Distance) of each boat, and vertical lines represent when each boat passed through waypoints from 1 to 6. Here, XTD refers to the distance of deviation for Leader from the planned route or for Follower from the trajectory of Leader. As shown in Fig. 7 and 8, Leader navigated on the planned route and Followers also followed the trajectory of Leader well. From WP 5 to WP 6 and until the end point, Leader deviated from the planned route by about 6.8 m due to external influences. And Followers followed only the deviated trajectory of Leader. Fig. 9 shows the sea experiment scene and it can be seen that Followers followed Leader well.
Fig. 10 shows the speed, and distance to the forward boat. The black dashed line represents the distance to the forward boat, and the red, green and blue solid lines represent the speed of each boat. The speed of Leader was oscillated continuously, despite maintaining a constant motor speed. This is considered to be due to the fact that the boat is small and light, making it vulnerable to external influences. Its average speed was 1.59 m/s, a maximum speed of 1.98 m/s and a minimum speed of 1.19 m/s. Follower 1 maintained a distance of 12.3∼16.1 m from Leader. Its average speed was 1.53 m/s, a maximum speed of 2.23 m/s and a minimum speed of 0.99 m/s. Follower 2 maintained a distance of 10.6∼16.6 m from the Follower 1. Its average speed was 1.52 m/s, a maximum speed of 2.11 m/s and a minimum speed of 0.99 m/s.

Conclusions

This study presents the implementation of the ship trajectory following algorithm that enables followers follow the trajectory of the leader. The algorithm was verified through sea experiments using 1 m class RC model boats. The results are as follows.
Firstly, Followers closely followed the trajectory of Leader. The maximum XTD of Followers were about 3 m. Even if Leader deviated from the planned route, Followers still followed only the trajectory of Leader.
Secondly, the experimental boats maintained a distance each other to prevent collision. Follower 1 maintained a distance from the Leader within the range of 101∼132% of the forward safe distance of 12.2 m. Follower 2 maintained a distance from the Follower 1 within the range of 87∼ 136% of the forward safe distance of 12.2 m.
The study focused on verifying ship trajectory algorithms using 1 m class small model boats. While this algorithm designed for three boats navigating in a straight line, the group shape needs to be adjusted based on the number of ships and navigational circumstances. When the number of ships increases, the group shape should be two or more columns. As its basic shape is a triangular, authors plan to develop algorithms and conduct sea experiments to form a triangular shape in future research.

Fig. 1.
Trajectory following method
kinpr-2023-47-2-49f1.jpg
Fig. 2.
Block diagram of course-keeping control
kinpr-2023-47-2-49f2.jpg
Fig. 3.
The overall appearance of experimental boats
kinpr-2023-47-2-49f3.jpg
Fig. 4.
Experimental area
kinpr-2023-47-2-49f4.jpg
Fig. 5.
Rudder angle and rate of turn during the first turning experiment
kinpr-2023-47-2-49f5.jpg
Fig. 6.
Comparison of rate of turn between experiment and ARX model
kinpr-2023-47-2-49f6.jpg
Fig. 7.
Entire trajectories in the verification experiment
kinpr-2023-47-2-49f7.jpg
Fig. 8.
Cross track distance during the verification experiment
kinpr-2023-47-2-49f8.jpg
Fig. 9.
Sea experiment scene
kinpr-2023-47-2-49f9.jpg
Fig. 10.
Speed and forward distance during the verification experiment
kinpr-2023-47-2-49f10.jpg
Table 1.
Specifications of experimental boats
Particular Leader boat Follower boat
Hull type Catamaran Monohull
Dimensions (L✕B✕H) 1,245 mm ✕ 440 mm ✕ 285 mm 914 mm ✕ 279 mm ✕ 240 mm
Mass 9.1 kg 4.5 kg
BLDC motor Pole 6 4
rpm 1,000 rpm/V 1,900 rpm/V
ESC output current 160 A 120 A
Propeller Diameter 35.56 mm 40.64 mm
Pitch 50.8 mm 43.94 mm
Servo motor Torque 490 oz/in 161 oz/in
Speed 0.216 s/60° 0.24 s/60°
Power source 2 * 11.1 V, 7.6 Ah LiPo battery 3.7 V, 20 Ah LiPo battery
GPS accuracy Position 2.5m
Velocity 0.05m/s
Course 0.3°
IMU heading accuracy 0.5°
SBC CPU Intel Celeron N4100
RAM 4 GB
OS Windows 10
Table 2.
List of waypoint, course and distance
Waypoint Course(°) Distance(m)
Latitude(°) Longitude(°)
Start 35.074782 129.085458
WP 1 35.074639 129.085111 243 35.3
WP 2 35.074580 129.084690 259 38.9
WP 3 35.074920 129.084320 317 50.6
WP 4 35.075255 129.084377 007 37.5
WP 5 35.075407 129.084763 063 39.0
WP 6 35.075290 129.085148 109 37.4
End 35.074852 129.085405 153 53.8

References

[1] Chae, C. J., Kim, M. G. and Kim, H. J.(2020), “A Study on Identification of Development Status of MASS Technologies and Directions of Improvement”, Applied sciences, Vol. 10, No. 13, pp. 4564.
crossref
[2] Choi, W. J. and Jun, S. H.(2020), “A Basic Study on Connected Ship Navigation System”, Journal of Navigation and Port Research, Vol. 44, No. 2, pp. 136-143.
[3] Choi, W. J. and Jun, S. H.(2022), “Development of Sailing Algorithm for Ship Group Navigation System”, The Journal of Navigation, Vol. 46, No. 6, pp. 554-561.
[4] Dantas, J. L., Caetano, W. S., Vale, R. T. and de Barros, E. A.(2013), “Analysis of identificatio methods applied to free model tests of the Pirajuba AUV”, IFAC Proceedings Volumes, Vol. 46, No. 33, pp. 185-190.
crossref
[5] Jung, H. R., Chang, H. J. and Song, Y. E.(2019), “Trend of Autonomous Navigation Technology for Unmanned Ship”, Journal of Institutde of Control, Robotics and Systems, Vol. 25, No. 1, pp. 76-87.
crossref
[6] Kim, H. I.2011. A Study on Control of an Unmanned Surface Vehicle based on the Wireless Internet, Korea Maritime and Ocean University; Master’s dissertation.
[7] Kim, H. J.(2022), Recent Technological Trends and Regulatory Issues of Autonomous Ships. Korea Legislation Research Institute (KLRI); p. 14-19.
[8] Ljung, L.(1987), System Identification: Theory for the User. Prentice Hall PTR; p. 69-73.
[9] Nomoto, K., Taguchi, T., Honda, K. and Hirano, S.(1957), “On the steering qualities of ships”, International Shipbuilding Progress, Vol. 4, No. 35, pp. 354-370.
crossref
[10] Park, H. R., Park, H. S. and Kim, B. R.(2018), “A Study on the Policy Directions related to the Introduction of Maritime Autonomous Surface Ship (MASS)”. Korea Maritime Institute (KMI); p. 35-41.
[11] TranzattoM.2015. Navigation and Control for an Autonomous Sailing Model Boat, University of Pisa; PhD dissertation.
[12] Velasco, F. J., Revestido, E., Moyano, E. and Lopez, E.(2007), “Manoeuvring model parametric identification of an autonomous in-scale fast-ferry model”, Proceedings of IEEE OCEANS, (2007), pp. 1-6.
crossref


ABOUT
BROWSE ARTICLES
FOR CONTRIBUTORS
Editorial Office
C1-327 Korea Maritime and Ocean University
727 Taejong-ro, Youngdo-gu, Busan 49112, Korea
Tel: +82-51-410-4127    Fax: +82-51-404-5993    E-mail: jkinpr@kmou.ac.kr                

Copyright © 2024 by Korean Institute of Navigation and Port Research.

Developed in M2PI

Close layer
prev next