Search papers, labs, and topics across Lattice.
This paper introduces a quadratic-program-based optimal control framework that addresses the singularity issues inherent in dynamic feedback linearization (DFL) for unicycle-type robots during trajectory tracking. By reformulating DFL constraints into an equality-constrained QP with slack variables, the proposed method maintains feasibility even when the robot's velocity approaches zero, enabling effective stop-and-reverse maneuvers. Simulations on a TurtleBot3 Waffle robot validate the approach, demonstrating robust trajectory tracking across a wide range of reference signals.
A novel quadratic-programming approach ensures unicycle robots can track trajectories without falling into singularities, even at zero velocity.
Dynamic feedback linearization (DFL) is a classical technique for trajectory tracking of unicycle-type mobile robots, but the resulting DFL-based controller becomes singular when the linear velocity vanishes, rendering standard DFL-based controllers unsuitable for stop-and-reverse maneuvers. This paper proposes a quadratic-program (QP)-based optimal control framework that avoids this singularity, while establishing local Lipschitz continuity of the resulting feedback law. Our approach reformulates the DFL constraints as an equality-constrained QP with a slack variable, ensuring feasibility for all states and reference signals, including at points where the robot's velocity vanishes. By introducing slack variables and tunable parameters, we demonstrate that the singular configuration can be avoided for a large class of reference trajectories. The effectiveness of the proposed approach for trajectory tracking is demonstrated through ROS 2-Gazebo simulations on a TurtleBot3 Waffle robot. The code is available at https://gradslab.github.io/DFL_QP_Unicycle/