https://9dok.net/document/yd78g5x6-the-linear-quadratic-regulator-lqr.html