Self-localization and 3-D model construction of pipe by earthworm robot equipped with omni-directional rangefinder.