Changed contactConstraints so that phi = <relpos,normal>, instead of phi = sgn(<relpos,normal>) * ||relpos||