Add restitution and error reduction for contact