Terrain Classification Using W-K Filter and 3D Navigation with Static Collision Avoidance