Any contact type/number refactoring

Adapt the force torque preint related code so that any number of contact can be included and any type (3D point foot, 6D humanoid foot).

created merge request !5 (merged) to address this issue

mentioned in merge request !5 (merged)

closed via merge request !5 (merged)