interpolate trajectory_constraint