Simultaneous Localization and Mapping in Unmodified Environments using Stereo Vision Chapter 2006 uri icon