adding linear quadratic regulator solve