PBD implementation of Matthias Müller paper http://matthias-mueller-fischer.ch/publications/posBasedDyn.pdf