Traversability analysis with vision and terrain probing for safe legged robot navigation