Interaction Mesh is improperly built when optimizating joint values

[thomas-moulard]

The trajectory contains joint value but the code makes the assumption this is a marker trajectory.

We should use JointToMarker to fix this issue.