KDF: Kinodynamic Motion Planning via Geometric Sampling-Based Algorithms and Funnel Control

• Published in: IEEE transactions on robotics Vol. 39; no. 2; pp. 1 - 20
• Main Authors: Verginis, Christos K., Dimarogonas, Dimos V., Kavraki, Lydia E.
• Format: Journal Article
• Language: English
• Published: New York IEEE 01.04.2023; The Institute of Electrical and Electronics Engineers, Inc. (IEEE)
• Subjects: Aerospace electronics; Algorithms; Computer hardware; Control systems; Control theory; Differential geometry; Dynamics; Feedback control; Funnel control; Funnel controls; Geometry; Heuristic algorithms; Heuristics algorithm; kinodynamic motion planning; Motion planning; Motion planning problems; Nonlinear dynamics; Planning; Planning techniques; Robot arms; Robot programming; Robots; Sampling; Sampling-based algorithms; Sampling-based planning; Trajectory; uncertain dynamics; Uncertainty
• ISSN: 1552-3098; 1941-0468; 1941-0468
• DOI: 10.1109/TRO.2022.3208502

We integrate sampling-based planning techniques with funnel-based feedback control to develop KDF, a new framework for solving the kinodynamic motion-planning problem via funnel control. The considered systems evolve subject to complex, nonlinear, and uncertain dynamics (also known as differential constraints). First, we use a geometric planner to obtain a high-level safe path in a user-defined extended free space. Second, we develop a low-level funnel control algorithm that guarantees safe tracking of the path by the system. Neither the planner nor the control algorithm uses information on the underlying dynamics of the system, which makes the proposed scheme easily distributable to a large variety of different systems and scenarios. Intuitively, the funnel control module is able to implicitly accommodate the dynamics of the system, allowing hence the deployment of purely geometrical motion planners. Extensive computer simulations and hardware experiments with a 6-DOF robotic arm validate the proposed approach.