Closed-Loop Motion Planning for Differentially Flat Systems: A Time-Varying Optimization Framework
Motion planning and control are two core components of the robotic autonomy stack. The standard way to combine them uses an offline/open-loop stage, planning, which designs a feasible and safe trajectory, and an online/closed-loop stage, tracking, which corrects for unmodeled dynamics and disturbances. This separation introduces conservatism in planning that becomes difficult to overcome as model complexity increases and real-time decisions must be made in a changing environment. This work addresses these challenges for differentially flat nonlinear systems by integrating planning and control into a single closed-loop task. We develop an optimization-based framework that steers a flat system to a trajectory implicitly defined via a constrained time-varying optimization problem. Generalizing feedback linearization, our controllers effectively transform the flat system into an algorithm that seeks the optimal solution of the time-varying problem. Under sufficient regularity assumptions, we prove global asymptotic convergence to the time-varying minimizer. We illustrate the method on multi-robot tracking and robot obstacle avoidance problems.