mt_align function

Align trajectories.