Position based dynamics implemented