https://gereshes.com/2019/01/21/balancing-an-inverted-pendulum/