Dense point cloud map construction based on stereo VINS for mobile vehicles

Abstract Mobile vehicles require accurate localization and dense mapping for motion planning. In this paper, we propose a dense map construction algorithm based on a light-and-fast stereo visual-inertial navigation system (VINS). A tightly coupled nonlinear optimization method is used to calculate the position of adjacent keyframes. An optical flow tracking method fused with IMU information and ring matching constraints is used to improve the matching accuracy and speed of the feature points. In addition, we obtain the pose and depth values using the semi-global block matching (SGBM) method, which are used as the initial values of the depth filter to update the depth image and improve the convergence speed. Then, we further use the Truncated Signed Distance Function (TSDF) method to construct the dense map. We compare our algorithm with state-of-the-art algorithms on the EuRoc dataset and then compare the estimated depth image using the proposed algorithm and the point cloud construction with the probabilistic monocular dense reconstruction (REMODE). The experiments show that the proposed algorithm can obtain more accurate localization than VINS and OKVIS, as well as a faster tracking speed, a better depth map, a lower convergence time for the estimated image and a lower number of updated frames than REMODE.