https://gonzafernan.github.io/posts/optimal-lqg-controller-design-for-self-balancing-vehicle/