Robust Localization, Mapping, and Navigation for Quadruped Robots