Smart Perception System for Subsurface Robot Mapping: From Simulation to Actual System Realization