Performance-based rough terrain navigation for nonhol