Unity Double Pendulum Equations