[5] LI Y, JIANG Y Q, CAO J et al. AUV docking experiments based on vision positioning using two cameras[J]. Ocean Engineering, 110, 163-173(2015).

[7] [7] PARK J Y, JUN B H, LEE P M, et al. Development of testbed AUV ''ISIMI'' underwater experiments on free running vision guided docking[M]INZARTSEV A. Underwater Vehicles. Vienna: IntechOpen, 2009: 371−398.

[8] [8] XIA G Q, WANG G Q, CHEN X H, et al. Lowcost MEMSINSGNSS integration using quaternionbased nonlinear filtering methods f USV[C]OCEANS 2016. Shanghai: IEEE, 2016: 1−7.

[10] KALAITZAKIS M, CAIN B, CARROLL S et al. Fiducial markers for pose estimation[J]. Journal of Intelligent & Robotic Systems, 101, 71(2021).

[11] [11] YU G, LIU Y F, HAN X K, et al. Objects grasping of robotic arm with compliant grasper based on vision[C]Proceedings of the 2019 4th International Conference on Automation, Control Robotics Engineering. Shenzhen: ACM, 2019: 62.

[12] BENLIGIRAY B, TOPAL C, AKINLAR C. STag: a stable fiducial marker system[J]. Image and Vision Computing, 89, 158-169(2019).

[13] WU Y H, HU Z Y. PnP problem revisited[J]. Journal of Mathematical Imaging and Vision, 24, 131-141(2006).

[14] LEPETIT V, MORENO-NOGUER F, FUA P. EPnP: an accurate O(n) solution to the PnP problem[J]. International Journal of Computer Vision, 81, 155-166(2009).

[15] GAO X S, HOU X R, TANG J L et al. Complete solution classification for the perspective-three-point problem[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 25, 930-943(2003).

[18] LI T H S, SU Y T, LIU S H et al. Dynamic balance control for biped robot walking using sensor fusion, Kalman filter, and fuzzy logic[J]. IEEE Transactions on Industrial Electronics, 59, 4394-4408(2012).

[19] FOSSEN T I, BREIVIK M, SKJETNE R. Line-of-sight path following of underactuated marine craft[J]. IFAC Proceedings Volumes, 36, 211-216(2003).

[20] [20] BREIVIK M, FOSSEN T I. Principles of guidancebased path following in 2D 3D[C]Proceedings of 44th IEEE Conference on Decision Control. Seville, Spain: IEEE, 2005: 627634.