A new approach to the optimal control problem including trajectory sensitivity

We formulate optimal quadratic regulator problems with trajectory sensitivity terms as a optimization problem for a fixed controller structure. Using well-known techniques for parametric LQ problems, we give an algorithm to obtain suboptimal feedback gains by iterative solutions of two Lyapunov equations. A numerical example is given to illustrate the effectiveness of the proposed algorithm.