Keyframe-based dense planar SLAM
Least-Squares Fitting of Two 3-D Point Sets