Robust Autonomous Spacecraft Navigation and Environment Characterization