Efficient And Robust Admm Methods For Dynamics And Geometry Optimization