Robust autonomous spacecraft navigation and environment characterization