Dynamic Movement Primitives With Control Barrier Functions for Constrained Trajectory Planning
Federico Vesentini, Daniele Meli, Nicola Sansonetto, Luca Di Persio, Riccardo Muradore · IEEE Robotics and Automation Letters · 2025
Dynamic Movement Primitives (DMPs) form a robust framework for trajectory generation based on imitation learning, aiming to replicate the shape of reference trajectories from demonstrations closely. DMPs have been extensively employed fortrajectory planningin robotic systems. However, they cannot safely guarantee complexnonlinear constraints, which is essentialat the control level. On the other hand, Control Barrier Functions (CBFs) are used to modulate the input of control-affine dynamic systems subject to state-dependent constraints, guaranteeing that the system remains within predefined safe sets while converging towards target states. This paper proposes Constrained Movement Primitives (CMPs), a novel framework that integrates DMPs with CBFs to generate safe-by-construction trajectories subject to nonlinear constraints. We represent DMPs in control-affine form and combine them with the closed-form input provided by CBFs, overcoming the limitations of existing iterative optimisation methods for constrained DMPs. We demonstrate that CBFs preserve the goal convergence guarantees of DMPs. Moreover, we validate our approach in simulation and on a real mobile robot subject tononlinear kinodynamic constraints, concerning maximum Cartesian velocity, obstacle avoidance, and maximum centrifugal acceleration to avoid slippery over curved trajectories.