An efficient algorithm for computing the state feedback optimal control law for discrete time hybrid systems

In this paper we propose an efficient algorithm for computing the solution to the finite time optimal control problem for discrete time linear hybrid systems with a quadratic performance criterion. The algorithm is based on a dynamic programming recursion and a multiparametric quadratic programming solver.