Kinodynamic Planning on Constraint Manifolds
Preprint
Abstract
This paper 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 in this paper validate the approach in significantly-complex systems.Keywords
All Related Versions
This publication has 26 references indexed in Scilit:
- The CUIK Suite: Analyzing the Motion Closed-Chain Multibody SystemsIEEE Robotics & Automation Magazine, 2014
- Minimum-Time Trajectory Planning and Control of a Pick-and-Place Five-Bar Parallel RobotIEEE/ASME Transactions on Mechatronics, 2014
- Eliminating constraint drift in the numerical simulation of constrained dynamical systemsComputer Methods in Applied Mechanics and Engineering, 2009
- Elimination of Constraint Violation and Accuracy Aspects in Numerical Simulation of Multibody SystemsMultibody System Dynamics, 2002
- Geometric Integration of Ordinary Differential Equations on ManifoldsBIT Numerical Mathematics, 2001
- Discrete mechanics and variational integratorsActa Numerica, 2001
- Probabilistic roadmaps for path planning in high-dimensional configuration spacesIEEE Transactions on Robotics and Automation, 1996
- Numerical solution of differential-algebraic equations in mechanical systems simulationPhysica D: Nonlinear Phenomena, 1992
- Implicit Numerical Integration for Euler-Lagrange Equations via Tangent Space Parametrization∗Mechanics of Structures and Machines, 1991
- Stabilization of constraints and integrals of motion in dynamical systemsComputer Methods in Applied Mechanics and Engineering, 1972