Autonomous Mobile Robot for Subsurface Mapping