Combined navigation and positioning method of small underwater robot

Abstract

The invention provides a combined navigation and positioning method of a small underwater robot, which comprises the following steps: fusing measurement data of various navigation facilities by means of a strong tracking unscented Kalman filter; using position vectors and heading angles under a navigation system as well as speed vectors and acceleration vectors under a vector system as state vectors of the filter; using the strong tracking unscented Kalman filter to implement autonomous navigation and data filtering of the underwater robot; based on horizontal position information output by a GPS (global positioning system) receiver, using the strong tracking unscented Kalman filter to implement autonomous correction and data filtering of the underwater robot; and implementing the switching between two different measurement equations (i.e. overwater and underwater measurement equations) based on the significance bit of the output signal of the GPS receiver. The invention can fuse the position, depth and attitude information of the small underwater robot measured by various navigation facilities, and can implement the autonomous navigation and autonomous correction of the small underwater robot under the interference of sea current or sea wave.

Description

technical field [0001] The invention relates to a method for autonomous navigation and autonomous correction of a small underwater robot. Background technique [0002] When a small underwater robot performs underwater tasks, its control system and guidance system need to provide accurate and smooth position, depth, attitude, and speed and acceleration information under the carrier system, and can automatically float to the water surface for autonomous correction. The navigation and positioning system of small underwater robots often has the problem of system model mismatch caused by ocean current or wave interference, and the navigation and positioning system generally can only provide unfiltered acceleration, depth information and speed information under the navigation system. Filtering and coordinate transformation to the boat system can be used by the robot control system. However, the navigation method using multiple navigation signals is usually a backup of simple navi...

AI Technical Summary

Problems solved by technology

[0003] The purpose of the present invention is to provide a method that can effectively solve the problem of model mismatch in the navigation and positioning system of a small underwater robot caused by ocean current or wave interference, and can smooth the course, depth and in-ship conditions required by the control system of the small underwater robot. A small underwater robot navigation and positioning method that integrates autonomous underwater navigation and positioning and autonomous water surface position correction functions under the system of velocity and acceleration information

Images