I tried to write a physicaly accurate double pendulum. And I found a method called XPBD.
https://matthias-research.github.io/pages/publications/XPBD.pdf
you can read it from here.