Fast Visual Odometry Using Intensity-Assisted Iterative Closest Point
Least-Squares Fitting of Two 3-D Point Sets