Acrobot Control using Energy Shaping and LQR

Here, I implemented a controller to swing up and balance an Acrobot, a two-link under-actuated system. The Acrobot has a torque input at the waist joint and can move in the vertical plane. The goal is to take the Acrobot from the initial hanging position to the upright position and keep it there.

You can find the code here.