[Tests][Python] add test cases for ContactSequence helpers to concatenate the trajectories of each phases

[C++] CS: test consistency of COM and AM trajectory : add approximation treshold for derivatives values at 1e-6

[C++] contactPhase setTrajectories from point now use linear interp for each curve, in order to match mlp python behavior