https://youkoutaku.github.io/posts/LQR-for-Discrete-time-Systems/