Beacon Aided Robotics for Martian Cave Mapping