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

Figure 1

The tangent plane at a path point has a surface normal vector . The acceleration of the path is in the direction of principal normal to the path, not necessarily orthogonal to the tangent plane. In general, the acceleration has a normal component normal to the tangent plane and a tangential component in the tangent plane.