https://123dok.net/document/6qm9l18y-pendubot-combining-of-energy-and-intuitive-approach-to-swing-up-stabilization-in-erected-pose.html