sorting pushes after num removed samples and length of trajectory
gazebo model_state interface tutorial