Pruning after adding new anchors improves performance
A few different tests. Minor bugfixes to conserve momentum across more cases
Update contact normal more frequently reduces the number of contacts