MAINT: isolate the function that resamples tolerance states; it is now a separate function instead of part of the code that samples initial feasible trajectories