public override void CleanUp()
{
//Deactivate any remaining constraints.
for (int i = penetrationConstraints.Count - 1; i >= 0; i--)
{
var penetrationConstraint = penetrationConstraints.Elements[i];
penetrationConstraint.CleanUp();
penetrationConstraints.RemoveAt(i);
penetrationConstraintPool.Push(penetrationConstraint);
}
for (int i = frictionConstraints.Count - 1; i >= 0; i--)
{
var frictionConstraint = frictionConstraints.Elements[i];
frictionConstraint.CleanUp();
frictionConstraints.RemoveAt(i);
frictionConstraintPool.Push(frictionConstraint);
}
}