Fix zero distance evaluation
Enable removing constraints and forces, add tests