A kyno-dynamic metric to plan stable paths over uneven terrain

A generic methodology to plan increasingly stable paths for mobile platforms travelling over uneven terrain is proposed in this paper. This is accomplished by extending the Fast Marching level-set method of propagating interfaces in 3D lattices with an analytical kyno-dynamic metric which embodies robot stability in the given terrain. This is particularly relevant for reconfigurable platforms which significantly modify their mass distribution through posture adaptation, such as robots equipped with manipulator arms or varying traction arrangements. Results obtained from applying the proposed strategy in a mobile rescue robot operating on simulated and real terrain data illustrate the validity of the proposed strategy.