Contact feedback not properly tested!
@rbudhira you introduce bugs in !95 (merged) :) When ref is not set, rMf is still computed which crashes. And you forget to have an optional gains=[0 0] to keep backcomp. I am fixing it, but please double check.