Abstract: To improve the data detection accuracy of low-cost sensors in the original navigation system and the control effect of ship trajectory tracking, the data fusion algorithm was introduced to propose a new trajectory tracking algorithm. The multiple coordinate transformations of ship hull were conducted, and two Kalman filters were used to fuse more accurate ship heading angle, coordinates and velocity. The control algorithm based on eliminating trajectory velocity deviation and heading angle deviation was proposed. The traditional PID controller was designed as cascade control system with PI controller and differential controller. The differential variables in the inner loop were precisely detected and transmitted by the existing accelerometers and gyroscopes to eliminate the adjusting differential parameters for achieving good control results of systems with low detection accuracy. The each required output of the two vessels on the ship was calculated to improve the effect of trajectory tracking. The multiple cruise tests of unmanned working ship were conducted on the experimental platform with real-time monitoring the ship status data and operating trajectory through upper computer,and the overall optimized trajectory tracking effect was analyzed. The results show that the heading angle, positioning and velocity fused by the Kalman filter have smaller data variance and are closer to ideal values. For the control algorithm, the overshoot of the system does not exceed 3%, and the response speed is fast enough with the steady-state error of about zero. After optimization,the success rate of the straight section for trajectory tracking is increased from 80% to 95%, and the success rate of the turning section is increased from 60% to 90%. The maximum average yaw distance of the straight section after optimization is decreased from 0.83 m to 0.12 m, and the maximum average yaw distance of the turning section is decreased from 1.25 m to 0.22 m. After turning, the average adjustment distance of 0.95 meters is required to enter the straight state, and the tracking effects of straight and turning sections are significantly improved.
ZEREIK E, BIBULI M, MIKOVIC' N, et al. Challenges and future trends in marine robotics[J]. Annual Reviews in Control, 2018,46:350-368.
[2]
LIU Y F, WANG J C, SHI Y C, et al. Unmanned airboat technology and applications in environment and agriculture[J]. Computers and Electronics in Agriculture, 2022,197:1-13.
[3]
WANG Y Y, CHAI S H, NGUYEN H D. Unscented Kalman filter trained neural network control design for ship autopilot with experimental and numerical approaches[J]. Applied Ocean Research, 2019,85:162-172.
[4]
ZTRK , AKDAGˇ M, AYABAKAN T. A review of path planning algorithms in maritime autonomous surface ships: navigation safety perspective[J]. Ocean Engineering, 2022,251:1-19.
[5]
GEHRT J J, LIU S, NITSCH M, et al. Robust and re-liable multi-sensor navigation filter for maritime application[J]. IFAC-PapersOnLine, 2020,53(2):14482-14487.
[6]
HAJIYEV C. Measurement differencing approach based Kalman filter applied to INS error compensation[J]. IFAC-Papers OnLine, 2016,49(17):343-348.
[7]
GAO C, GUO Y J, ZHONG M J, et al. Reliability analysis based on dynamic Bayesian networks: a case study of an unmanned surface vessel[J]. Ocean Engineering, 2021,240:1-14.
[8]
WU B, CHENG T T, YIP T L, et al. Fuzzy logic based dynamic decision-making system for intelligent navigation strategy within inland traffic separation schemes[J]. Ocean Engineering, 2020,197:1-14.
[9]
TAO W, ZHU M, WEN Y Q, et al. Preparation of papers for IFAC conferences & symposia: designing a characteristic model-based adaptive path following controller for unmanned surface vehicles[J]. IFAC-Papers OnLine, 2019,52(21):347-352.
[10]
WANG X Y, FENG K, WANG G, et al. Local path optimization method for unmanned ship based on particle swarm acceleration calculation and dynamic optimal control[J]. Applied Ocean Research, 2021,110:1-10.
[11]
PAN W, XIE X L, HE P, et al. An automatic route design algorithm for intelligent ships based on a novel environment modeling method[J]. Ocean Engineering, 2021,237(33):1-17.
XIONG X, HUANG G Y, WANG X D. Strong tracking SVDCKF integrated navigation algorithm based on multiple fading factors[J]. Journal of Chongqing University of Posts and Telecommunications(Natural Science Edition), 2021,33(2):330-336.(in Chinese)
GUAN K, ZHAO D A, HONG J Q. Research on path tracking algorithm for unmanned operation boats in crab farming[J]. Software Guide, 2019,18(10):78-81.(in Chinese)
ZHANG M D, LIU Y, CHU G Y. Accurate design of vehicle hardware in the loop system based on Kalman filter[J]. Automation and Instrumentation, 2021(10):80-83.(in Chinese)
ZHAO D A, LUO J, SUN Y P, et al. Design and test of navigation control system for crab breeding automatic ope-ration ship[J]. Journal of Agricultural Engineering, 2016,32(11):181-188.(in Chinese)
TANG H Y, JI Z, LI L. Research on robot assisted assembly technology based on force feedback and traction guidance[J]. Manufacturing Automation, 2021,43(3):9-13.(in Chinese)
MENG X Y, WANG Y Y. An improved adaptive exten-ded Kalman filter algorithm for SINS/GPS tight integra-ted navigation system[J]. Journal of Beijing University of Technology, 2018,38(6):625-630,636.(in Chinese)
LI C X, JIANG H B, WANG C Y, et al. Vehicle pose estimation method based on sensor information fusion[J]. Journal of Jiangsu University(Natural Science Edition), 2022,43(6):636-644.(in Chinese)
LI Y P, QI M H, WU L S, et al. Implementation of attitude estimation algorithm based on compensated Kalman filter[J]. Measurement and Control Technology, 2017,36(3):50-53,58.(in Chinese)
FU X, HE Z Q, HUANG B, et al. Slope recognition algorithm based on multi information data fusion filtering[J]. Journal of Jiangsu University(Natural Science Edition), 2021,42(2):173-179.(in Chinese)
YE Q, LI X, FENG Y, et al.Application of Kalman filter based on sliding mode PI control in space turntable [J]. Aerospace Control, 2021,39(6):34-41.(in Chinese)
WANG J, SUN X F, FANG J M, et al. Transcritical CO2 simulation study on dynamic performance of multi PID control of automobile air conditioner[J]. Journal of Xi′an Jiaotong University, 2020,54(8):168-176.(in Chinese)