Safe feature-based navigation for industrial AGVs