An efficient algorithm for solving linear equality-constrained LQR problems