Underwater vision SLAM (Simultaneous Localization and Mapping) method based on camera motion constraint and distortion correction

Abstract

The invention discloses an underwater vision SLAM (Simultaneous Localization and Mapping) method based on constrained camera motion and distortion correction, which comprises the following steps of: creating an underwater speed optimization equation by utilizing a method of shooting adjacent frame number images and an integral camera motion path in a constrained manner, and carrying out local and integral optimization on the motion rate of an underwater camera; according to the method, the problem of bubbles caused by overlarge deviation of the movement rate of the underwater camera is solved, the quality of a shot image is ensured, and mapping of SLAM is facilitated; when the word bag is created, underwater distortion correction is performed on the shot image and the feature points thereof through a method of fusing radial distortion, tangential distortion and scattering coefficients, so that the problem of mismatching of the feature points during loopback detection can be effectively solved, underwater accumulated errors are effectively eliminated, and the real loopback rate of loopback detection is improved.

Description

technical field [0001] The invention relates to the field of synchronous positioning and map construction, in particular to an underwater vision SLAM method based on constrained camera motion and distortion correction. Background technique [0002] In recent years, as robotics has attracted more attention, the key technologies of SLAM have developed rapidly, and there are still some unsolved problems. [0003] At present, the existing visual SLAM methods can be divided into two categories: direct methods and feature point methods. Among them, the direct method is represented by the visual odometry (Direct Sparse Odometry, abbreviated "DSO") of the sparse direct method, and the feature point method is a monocular SLAM system based on sparse feature points (Oriented FAST and Rotated BRIEF-SLAM, abbreviated "ORB" -SLAM") as the representative. Although DSO and ORB-SLAM's public datasets on land have achieved good results, they are not ideal for testing in underwater environme...

AI Technical Summary

Problems solved by technology

[0005] (1) The visual real-time scene construction system is used in the underwater process. If the camera does not perform other motion constraints, it will cause certain environmental factors such as bubbles to be generated underwater, which will lead to a decrease in the quality of camera shooting, thereby affecting SLAM construction. image quality;

[0006] (2) In order to improve the shooting quality in the underwater environment, the existing method is to improve by air pre-calibration and underwater calibration, but this method cannot directly process the feature points, which will lead to mis-matching of feature points and affect The true accuracy of loopback detection affects the overall mapping

[0007] In view of the above existing problems, in 2017, Yang Pingle and others from the Industrial Technology Research Institute of Jiangsu University of Science and Technology proposed an image processing method in the underwater visual SLAM system (authorized announcement number: CN104574387B), by establishing an underwater imaging model and processing water Under the influence of environmental factors on camera imaging, it solves the problems of mismatching and matching efficiency in data association, and can better deal with the problem of feature matching caused by light refraction, scattering and absorption, but does not consider image distortion and restrictions o

Images