A generalization of the Riccati recursion for equality-constrained linear quadratic optimal control

This paper introduces a generalization of the well-known Riccati recursion for solving the discrete-time equality-constrained linear quadratic optimal control problem. The recursion can be used to compute problem solutions as well as optimal feedback control policies. Unlike other tailored approaches for this problem class, the proposed method does not require restrictive regularity conditions on the problem. This allows its use in nonlinear optimal control problem solvers that use exact Lagrangian Hessian information. We demonstrate that our approach can be implemented in a highly efficient algorithm that scales linearly with the horizon length. Numerical tests show a significant speed-up of about one order of magnitude with respect to state-of-the-art general-purpose sparse linear solvers. Based on the proposed approach, faster nonlinear optimal control problem solvers can be developed that are suitable for more complex applications or for implementations on low-cost or low-power computational platforms. The implementation of the proposed algorithm is made available as open-source software. This paper introduces a generalization of the well-known Riccati recursion for solving the discrete-time equality-constrained linear quadratic optimal control problem. A salient feature of the recursion is that it does not assume restrictive regularity conditions. Numerical tests show a significant speed-up of about one order of magnitude with respect to state-of-the-art general-purpose sparse linear solvers.image