Adjusted pendulum cart swing up ltv lqr example so it works with 3 links.