Force discontinuities when adding contact about tsid HOT 3 CLOSED

I think there're two ways to achieve this.

Adjust the regularization weights

When you add a new contact you can specify the regularization weight. If you initially set this weight quite high (e.g., 1) with a zero reference, I expect the initial force is gonna be almost zero. Then you can smoothly change this weight to reach a small value (e.g., 1e-5), which will allow the contact force to increase.

Use a time-varying upper bound on normal force

This is already done when you remove contacts so it shouldn't be too hard to do the same when you add contacts, but it's still more work than the previous solution because it requires you to modify the code. The idea is to have a time-varying bound on the normal force, so that it's forced to change smoothly. For the case when you remove a force, what's currently implemented is an upper bound that goes from the current value to almost zero as a linear function of time. The user can decide how fast this transition is using the parameter transition_duration.

from tsid.

This is the result with your first solution:

It is working as expected, thanks. I had to add updateRigidContactWeights to the python API, I will make a PR.

from tsid.

Nice!

from tsid.