The invention belongs to the field of
robot positioning, and particularly relates to a tight
coupling initialization method for
underwater vision inertial navigation pressure positioning. The method comprises the following steps of obtaining the under-scale
robot poses and map feature points through a traditional
monocular SLAM method, performing pre-integration on the IMU data between the adjacent images to establish a pre-integration residual error between the images; performing pre-integration on the IMU data between the adjacent images and the
pressure measurement to establish a pre-integration residual error between the images and the
pressure measurement, solving the initialization parameters of a
system through a nonlinear optimization method, updating a map by using the initialization parameters, performing
light beam adjustment optimization on the updated
system, completing an initialization process, and obtaining a more accurate result. Therefore, the operation of a
system is promoted. According to the method, the high-frequency IMU information is used for
coupling the image information and the pressure information under different time steps, the
coupling degree between the initialization parameters is enhanced, and the solving precision of an initialization
algorithm is improved.