cut the initial pose to make it more efficient
sort the trajs