Added double pendulum plotting and animation