A FREQUENCY-DRIFT COMPENSATED CLOSED-FORM SOLUTION for STEREO RGB-D MAPPING

In this work, we present a frequency-drift compensated (Fd-C) closed-form solution for stereo RGB-D SLAM. The intrinsic parameters for each sensor are first obtained with a standard camera calibration process and the extrinsic orientation parameters achieved through a coarse-to-fine scheme that solves the initial exterior orientation parameters (EoPs) from control markers and further refines the initial value by an iterative closest point (ICP) variant minimizing the distance between the RGB-D point clouds and the referenced laser point clouds. With the assumption of fix transformation between the frames with the same timestamp, we define one sensor as reference sensor and the other sensor as slave sensor and the slave frames can be mapped to the timeline of the references sensor. Rather than endow the camera pose of the nearest frame to the slave frames, we derive the accurate camera pose for slave frames in a spatially variant way. Therefore, the pose relations between the slave frame and the adjacent reference frame can be derived, which provided opportunity to use the more accuracy observations from multiple frames for better tracking and global optimization. We present the mathematical analysis of the iterative optimizations for pose tracking in multi-RGB-D camera cases. Finally, the experiments in complex indoor scenarios demonstrate the efficiency of the proposed multiple RGB-D slam algorithm.