Visual ranging-based simultaneous localization and map construction method

Abstract

The invention provides a visual ranging-based simultaneous localization and map construction method. The method includes the following steps that: a binocular image is acquired and corrected, so that a distortion-free binocular image can be obtained; feature extraction is performed on the distortion-free binocular image, so that feature point descriptors can be generated; feature point matching relations of the binocular image are established; the horizontal parallax of matching feature points is obtained according to the matching relations, and based on the parameters of a binocular image capture system, real space depth is calculated; the matching results of the feature points of a current frame and feature points in a world map are calculated; feature points which are wrongly matched with each other are removed, so that feature points which are successfully matched with each other can be obtained; a transform matrix of the coordinates of the feature points which are successfully matched with each other under a world coordinate system and the three-dimension coordinates of the feature points which are successfully matched with each other under a current reference coordinate system is calculated, and a pose change estimated value of the binocular image capture system relative to an initial position is obtained according to the transform matrix; and the world map is established and updated. The visual ranging-based simultaneous localization and map construction method of the invention has low computational complexity, centimeter-level positioning accuracy and unbiased characteristics of position estimation.

Description

technical field [0001] The invention relates to the technical fields of computer and electronic information, in particular to a simultaneous positioning and map construction method based on visual distance measurement. Background technique [0002] In recent years, mobile work platforms such as drones and mobile robots have become one of the hotspots of research. These devices have high flexibility and are widely used in disaster relief, geological survey and other scenarios. The main technologies of the robot autonomous navigation system include: building a three-dimensional map of the space environment, self-positioning, route planning, and obstacle avoidance. Among them, the construction of a three-dimensional map of the environmental space and its own positioning are the core of the problem, while route planning and obstacle avoidance rely on the UAV's cognition of the environment and the results of its positioning. [0003] At present, outdoor drones already have matu...

AI Technical Summary

Problems solved by technology

The simultaneous localization and map construction algorithm based on extended Kalman filtering has been proven to be the best convergent SLAM algorithm at present, but its obvious defect is that the computational complexity is very high, which is proportional to the square of the number of feature points contained in the world map

On the one hand, the computational complexity of the square term li...

Images