Stable version of obstacle detection with normals.