mt_length_normalize function

Length normalize trajectories.