Stereo visual odometry for pipe mapping
EPnP: An Accurate O(n) Solution to the PnP Problem