Ok, I gave up on LQR and just used a state controller on the angle, rate, torque and it works pretty well. It's relatively intuitive to tune although I didn't go too crazy.

Loading more stuff…

Hmm…it looks like things are taking a while to load. Try again?

Loading videos…