KAT-5: Robust systems for autonomous vehicle navigation in challenging and unknown terrain