invertedPendulumLQR Useful links: http://underactuated.csail.mit.edu/underactuated.html?chapter=systems https://www.youtube.com/watch?v=Pi7l8mMjYVE