https://123dok.com/document/4yrr06vy-real-inverted-pendulum-control-using-lqr-controller.html