ftr as cost function penalizing too much force in contacts, not converging