[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