Add (optional) resort support in p2nfft and fmm (i.e., keep sorted particle order and use it in the next time step)