Tested compute_Jacobian with repulsive contacts. Works.