Rotary double inverted pendulum;sim mechanics model

A double inverted pendulum is a non linear control complexity. The aim of the system is to balance a pendulum hinged to another pendulum, which in turn is attached to an arm which is driven by a motor. Here I have made use of an LQR, full state feedback to stabilize the system. The animation of the system is also displayed. Using this approach even triple and higher stages of inverted pendulums can be developed. The system is animated also.