Path Planning and Replanning for Mobile Robot Navigation on 3D Terrain: An Approach Based on Geodesic

Figure 4

Directional scanning on the tangent plane to search a critical point. The projection of onto along a surface normal vector to as the critical point .