Kinodynamic planning on constraint manifolds

Technical Report (2017)

IRI code



Download the digital copy of the doc pdf document


This report presents a motion planner for systems subject to kinematic and dynamic constraints. The former appear when kinematic loops are present in the system, such as in parallel manipulators, in robots that cooperate to achieve a given task, or in situations involving contacts with the environment. The latter are necessary to obtain realistic trajectories, taking into account the forces acting on the system. The kinematic constraints make the state space become an implicitly-defined manifold, which complicates the application of common motion planning techniques. To address this issue, the planner constructs an atlas of the state space manifold incrementally, and uses this atlas both to generate random states and to dynamically simulate the steering of the system towards such states. The resulting tools are then exploited to construct a rapidly-exploring random tree (RRT) over the state space. To the best of our knowledge, this is the first randomized kinodynamic planner for implicitly-defined state spaces. The test cases presented validate the approach in significantly-complex systems.


robot dynamics, robot kinematics, robot programming.

Author keywords

Kinodynamic motion planning, constrained system, dynamic simulation, rapidly-exploring randomized tree

Scientific reference

R. Bordalba, J.M. Porta and L. Ros. Kinodynamic planning on constraint manifolds. Technical Report IRI-TR-17-01, Institut de Robòtica i Informàtica Industrial, CSIC-UPC, 2017.