ndarray-slice 0.6.0

//! Derivative work of [`core::slice::sort`] licensed under `MIT OR Apache-2.0`.
//!
//! [`core::slice::sort`]: https://doc.rust-lang.org/src/core/slice/sort.rs.html

#![cfg(feature = "alloc")]

use crate::insertion_sort::insertion_sort_shift_left;
use crate::partition::reverse;
use core::{cmp, mem, ptr};
use ndarray::{ArrayView1, ArrayViewMut1, IndexLonger, s};

/// Merges non-decreasing runs `v[..mid]` and `v[mid..]` using `buf` as temporary storage, and
/// stores the result into `v[..]`.
///
/// # Safety
///
/// The two slices must be non-empty and `mid` must be in bounds. Buffer `buf` must be long enough
/// to hold a copy of the shorter slice. Also, `T` must not be a zero-sized type.
#[warn(unsafe_op_in_unsafe_fn)]
unsafe fn merge<T, F>(v: ArrayViewMut1<'_, T>, mid: usize, buf: *mut T, is_less: &mut F)
where
	F: FnMut(&T, &T) -> bool,
{
	let len = v.len();
	//let v = 0;//v.as_mut_ptr();

	// SAFETY: mid and len must be in-bounds of v.
	//let (v_mid, v_end) = (mid, len);//unsafe { (v.add(mid), v.add(len)) };

	// The merge process first copies the shorter run into `buf`. Then it traces the newly copied
	// run and the longer run forwards (or backwards), comparing their next unconsumed elements and
	// copying the lesser (or greater) one into `v`.
	//
	// As soon as the shorter run is fully consumed, the process is done. If the longer run gets
	// consumed first, then we must copy whatever is left of the shorter run into the remaining
	// hole in `v`.
	//
	// Intermediate state of the process is always tracked by `hole`, which serves two purposes:
	// 1. Protects integrity of `v` from panics in `is_less`.
	// 2. Fills the remaining hole in `v` if the longer run gets consumed first.
	//
	// Panic safety:
	//
	// If `is_less` panics at any point during the process, `hole` will get dropped and fill the
	// hole in `v` with the unconsumed range in `buf`, thus ensuring that `v` still holds every
	// object it initially held exactly once.
	let mut hole;

	if mid <= len - mid {
		// The left run is shorter.

		//let src = v.view_mut().index(0);
		// SAFETY: buf must have enough capacity for `v[..mid]`.
		unsafe {
			for i in 0..mid {
				ptr::copy_nonoverlapping(&v[i], buf.add(i), 1);
			}
			hole = MergeHole {
				buf,
				start: 0,
				end: mid,
				dest: 0,
				v,
			};
		}

		// Initially, these pointers point to the beginnings of their arrays.
		let left = &mut hole.start;
		let mut right = mid; //v_mid
		let out = &mut hole.dest;

		while *left < hole.end && right < len {
			// Consume the lesser side.
			// If equal, prefer the left run to maintain stability.

			// SAFETY: left and right must be valid and part of v same for out.
			unsafe {
				let w = hole.v.view();
				let is_l = is_less(w.uget(right), &*hole.buf.add(*left));
				let to_copy = if is_l {
					w.uget(right)
				} else {
					&*hole.buf.add(*left)
				};
				ptr::copy_nonoverlapping(to_copy, hole.v.view_mut().index(*out), 1);
				*out += 1;
				if is_l {
					right += 1;
				} else {
					*left += 1;
				}
			}
		}
	} else {
		// The right run is shorter.

		// SAFETY: buf must have enough capacity for `v[mid..]`.
		unsafe {
			for i in 0..len - mid {
				ptr::copy_nonoverlapping(&v[mid + i], buf.add(i), 1);
			}
			hole = MergeHole {
				buf,
				start: 0,
				end: len - mid,
				dest: mid,
				v,
			};
		}

		// Initially, these pointers point past the ends of their arrays.
		let left = &mut hole.dest;
		let right = &mut hole.end;
		let mut out = len; //v_end;

		while 0 < *left && 0 < *right {
			// Consume the greater side.
			// If equal, prefer the right run to maintain stability.

			// SAFETY: left and right must be valid and part of v same for out.
			unsafe {
				let w = hole.v.view();
				let is_l = is_less(&*hole.buf.add(*right - 1), w.uget(*left - 1));
				if is_l {
					*left -= 1;
				} else {
					*right -= 1;
				}
				let to_copy = if is_l {
					w.uget(*left)
				} else {
					&*hole.buf.add(*right)
				};
				out -= 1;
				ptr::copy_nonoverlapping(to_copy, hole.v.view_mut().index(out), 1);
			}
		}
	}
	// Finally, `hole` gets dropped. If the shorter run was not fully consumed, whatever remains of
	// it will now be copied into the hole in `v`.

	// When dropped, copies the range `start..end` into `dest..`.
	struct MergeHole<'a, T> {
		buf: *mut T,
		start: usize,
		end: usize,

		v: ArrayViewMut1<'a, T>,
		dest: usize,
	}
	//impl<'a, T> MergeHole<'a, T> {
	//    unsafe fn buf_get_and_increment(&mut self, idx: &mut usize) -> *mut T {
	//        let old = self.buf.add(*idx);

	//        // SAFETY: ptr.add(1) must still be a valid pointer and part of `v`.
	//        *idx = *idx + 1;//unsafe { ptr.add(1) };
	//        old
	//    }

	//    unsafe fn buf_decrement_and_get(&mut self, idx: &mut usize) -> *mut T {
	//        // SAFETY: ptr.sub(1) must still be a valid pointer and part of `v`.
	//        *idx = *idx - 1;//unsafe { ptr.sub(1) };
	//        self.buf.add(*idx)
	//    }

	//    unsafe fn out_get_and_increment(&mut self, idx: &mut usize) -> *mut T {
	//        let old = self.v.view_mut().index(*idx);

	//        // SAFETY: ptr.add(1) must still be a valid pointer and part of `v`.
	//        *idx = *idx + 1;//unsafe { ptr.add(1) };
	//        old
	//    }

	//    unsafe fn out_decrement_and_get(&mut self, idx: &mut usize) -> *mut T {
	//        // SAFETY: ptr.sub(1) must still be a valid pointer and part of `v`.
	//        *idx = *idx - 1;//unsafe { ptr.sub(1) };
	//        self.v.view_mut().index(*idx)
	//    }
	//}

	impl<T> Drop for MergeHole<'_, T> {
		fn drop(&mut self) {
			// SAFETY: `T` is not a zero-sized type, and these are pointers into a slice's elements.
			unsafe {
				let len = self.end - self.start; //self.end.sub_ptr(self.start);
				for i in 0..len {
					let src = self.buf.add(self.start + i);
					let dst = self.v.view_mut().index(self.dest + i);
					ptr::copy_nonoverlapping(src, dst, 1);
				}
			}
		}
	}
}

/// This merge sort borrows some (but not all) ideas from TimSort, which used to be described in
/// detail [here](https://github.com/python/cpython/blob/main/Objects/listsort.txt). However Python
/// has switched to a Powersort based implementation.
///
/// The algorithm identifies strictly descending and non-descending subsequences, which are called
/// natural runs. There is a stack of pending runs yet to be merged. Each newly found run is pushed
/// onto the stack, and then some pairs of adjacent runs are merged until these two invariants are
/// satisfied:
///
/// 1. for every `i` in `1..runs.len()`: `runs[i - 1].len > runs[i].len`
/// 2. for every `i` in `2..runs.len()`: `runs[i - 2].len > runs[i - 1].len + runs[i].len`
///
/// The invariants ensure that the total running time is *O*(*n* \* log(*n*)) worst-case.
pub fn merge_sort<T, CmpF, ElemAllocF, ElemDeallocF, RunAllocF, RunDeallocF>(
	mut v: ArrayViewMut1<'_, T>,
	is_less: &mut CmpF,
	elem_alloc_fn: ElemAllocF,
	elem_dealloc_fn: ElemDeallocF,
	run_alloc_fn: RunAllocF,
	run_dealloc_fn: RunDeallocF,
) where
	CmpF: FnMut(&T, &T) -> bool,
	ElemAllocF: Fn(usize) -> *mut T,
	ElemDeallocF: Fn(*mut T, usize),
	RunAllocF: Fn(usize) -> *mut TimSortRun,
	RunDeallocF: Fn(*mut TimSortRun, usize),
{
	// Slices of up to this length get sorted using insertion sort.
	const MAX_INSERTION: usize = 20;

	// The caller should have already checked that.
	debug_assert!(mem::size_of::<T>() > 0);

	let len = v.len();

	// Short arrays get sorted in-place via insertion sort to avoid allocations.
	if len <= MAX_INSERTION {
		if len >= 2 {
			insertion_sort_shift_left(v, 1, is_less);
		}
		return;
	}

	// Allocate a buffer to use as scratch memory. We keep the length 0 so we can keep in it
	// shallow copies of the contents of `v` without risking the dtors running on copies if
	// `is_less` panics. When merging two sorted runs, this buffer holds a copy of the shorter run,
	// which will always have length at most `len / 2`.
	let buf = BufGuard::new(len / 2, elem_alloc_fn, elem_dealloc_fn);
	let buf_ptr = buf.buf_ptr.as_ptr();

	let mut runs = RunVec::new(run_alloc_fn, run_dealloc_fn);

	let mut end = 0;
	let mut start = 0;

	// Scan forward. Memory pre-fetching prefers forward scanning vs backwards scanning, and the
	// code-gen is usually better. For the most sensitive types such as integers, these are merged
	// bidirectionally at once. So there is no benefit in scanning backwards.
	while end < len {
		let (streak_end, was_reversed) = find_streak(v.slice(s![start..]), is_less);
		end += streak_end;
		if was_reversed {
			reverse(v.slice_mut(s![start..end]));
		}

		// Insert some more elements into the run if it's too short. Insertion sort is faster than
		// merge sort on short sequences, so this significantly improves performance.
		end = provide_sorted_batch(v.view_mut(), start, end, is_less);

		// Push this run onto the stack.
		runs.push(TimSortRun {
			start,
			len: end - start,
		});
		start = end;

		// Merge some pairs of adjacent runs to satisfy the invariants.
		while let Some(r) = collapse(runs.as_slice(), len) {
			let left = runs[r];
			let right = runs[r + 1];
			let merge_slice = v.slice_mut(s![left.start..right.start + right.len]);
			// SAFETY: `buf_ptr` must hold enough capacity for the shorter of the two sides, and
			// neither side may be on length 0.
			unsafe {
				merge(merge_slice, left.len, buf_ptr, is_less);
			}
			runs[r + 1] = TimSortRun {
				start: left.start,
				len: left.len + right.len,
			};
			runs.remove(r);
		}
	}

	// Finally, exactly one run must remain in the stack.
	debug_assert!(runs.len() == 1 && runs[0].start == 0 && runs[0].len == len);

	// Examines the stack of runs and identifies the next pair of runs to merge. More specifically,
	// if `Some(r)` is returned, that means `runs[r]` and `runs[r + 1]` must be merged next. If the
	// algorithm should continue building a new run instead, `None` is returned.
	//
	// TimSort is infamous for its buggy implementations, as described here:
	// http://envisage-project.eu/timsort-specification-and-verification/
	//
	// The gist of the story is: we must enforce the invariants on the top four runs on the stack.
	// Enforcing them on just top three is not sufficient to ensure that the invariants will still
	// hold for *all* runs in the stack.
	//
	// This function correctly checks invariants for the top four runs. Additionally, if the top
	// run starts at index 0, it will always demand a merge operation until the stack is fully
	// collapsed, in order to complete the sort.
	#[inline]
	fn collapse(runs: &[TimSortRun], stop: usize) -> Option<usize> {
		let n = runs.len();
		if n >= 2
			&& (runs[n - 1].start + runs[n - 1].len == stop
				|| runs[n - 2].len <= runs[n - 1].len
				|| (n >= 3 && runs[n - 3].len <= runs[n - 2].len + runs[n - 1].len)
				|| (n >= 4 && runs[n - 4].len <= runs[n - 3].len + runs[n - 2].len))
		{
			if n >= 3 && runs[n - 3].len < runs[n - 1].len {
				Some(n - 3)
			} else {
				Some(n - 2)
			}
		} else {
			None
		}
	}

	// Extremely basic versions of Vec.
	// Their use is super limited and by having the code here, it allows reuse between the sort
	// implementations.
	struct BufGuard<T, ElemDeallocF>
	where
		ElemDeallocF: Fn(*mut T, usize),
	{
		buf_ptr: ptr::NonNull<T>,
		capacity: usize,
		elem_dealloc_fn: ElemDeallocF,
	}

	impl<T, ElemDeallocF> BufGuard<T, ElemDeallocF>
	where
		ElemDeallocF: Fn(*mut T, usize),
	{
		fn new<ElemAllocF>(
			len: usize,
			elem_alloc_fn: ElemAllocF,
			elem_dealloc_fn: ElemDeallocF,
		) -> Self
		where
			ElemAllocF: Fn(usize) -> *mut T,
		{
			Self {
				buf_ptr: ptr::NonNull::new(elem_alloc_fn(len)).unwrap(),
				capacity: len,
				elem_dealloc_fn,
			}
		}
	}

	impl<T, ElemDeallocF> Drop for BufGuard<T, ElemDeallocF>
	where
		ElemDeallocF: Fn(*mut T, usize),
	{
		fn drop(&mut self) {
			(self.elem_dealloc_fn)(self.buf_ptr.as_ptr(), self.capacity);
		}
	}

	struct RunVec<RunAllocF, RunDeallocF>
	where
		RunAllocF: Fn(usize) -> *mut TimSortRun,
		RunDeallocF: Fn(*mut TimSortRun, usize),
	{
		buf_ptr: ptr::NonNull<TimSortRun>,
		capacity: usize,
		len: usize,
		run_alloc_fn: RunAllocF,
		run_dealloc_fn: RunDeallocF,
	}

	impl<RunAllocF, RunDeallocF> RunVec<RunAllocF, RunDeallocF>
	where
		RunAllocF: Fn(usize) -> *mut TimSortRun,
		RunDeallocF: Fn(*mut TimSortRun, usize),
	{
		fn new(run_alloc_fn: RunAllocF, run_dealloc_fn: RunDeallocF) -> Self {
			// Most slices can be sorted with at most 16 runs in-flight.
			const START_RUN_CAPACITY: usize = 16;

			Self {
				buf_ptr: ptr::NonNull::new(run_alloc_fn(START_RUN_CAPACITY)).unwrap(),
				capacity: START_RUN_CAPACITY,
				len: 0,
				run_alloc_fn,
				run_dealloc_fn,
			}
		}

		fn push(&mut self, val: TimSortRun) {
			if self.len == self.capacity {
				let old_capacity = self.capacity;
				let old_buf_ptr = self.buf_ptr.as_ptr();

				self.capacity *= 2;
				self.buf_ptr = ptr::NonNull::new((self.run_alloc_fn)(self.capacity)).unwrap();

				// SAFETY: buf_ptr new and old were correctly allocated and old_buf_ptr has
				// old_capacity valid elements.
				unsafe {
					ptr::copy_nonoverlapping(old_buf_ptr, self.buf_ptr.as_ptr(), old_capacity);
				}

				(self.run_dealloc_fn)(old_buf_ptr, old_capacity);
			}

			// SAFETY: The invariant was just checked.
			unsafe {
				self.buf_ptr.as_ptr().add(self.len).write(val);
			}
			self.len += 1;
		}

		fn remove(&mut self, index: usize) {
			if index >= self.len {
				panic!("Index out of bounds");
			}

			// SAFETY: buf_ptr needs to be valid and len invariant upheld.
			unsafe {
				// the place we are taking from.
				let ptr = self.buf_ptr.as_ptr().add(index);

				// Shift everything down to fill in that spot.
				ptr::copy(ptr.add(1), ptr, self.len - index - 1);
			}
			self.len -= 1;
		}

		fn as_slice(&self) -> &[TimSortRun] {
			// SAFETY: Safe as long as buf_ptr is valid and len invariant was upheld.
			unsafe { &*ptr::slice_from_raw_parts(self.buf_ptr.as_ptr(), self.len) }
		}

		fn len(&self) -> usize {
			self.len
		}
	}

	impl<RunAllocF, RunDeallocF> core::ops::Index<usize> for RunVec<RunAllocF, RunDeallocF>
	where
		RunAllocF: Fn(usize) -> *mut TimSortRun,
		RunDeallocF: Fn(*mut TimSortRun, usize),
	{
		type Output = TimSortRun;

		fn index(&self, index: usize) -> &Self::Output {
			if index < self.len {
				// SAFETY: buf_ptr and len invariant must be upheld.
				unsafe {
					return &*(self.buf_ptr.as_ptr().add(index));
				}
			}

			panic!("Index out of bounds");
		}
	}

	impl<RunAllocF, RunDeallocF> core::ops::IndexMut<usize> for RunVec<RunAllocF, RunDeallocF>
	where
		RunAllocF: Fn(usize) -> *mut TimSortRun,
		RunDeallocF: Fn(*mut TimSortRun, usize),
	{
		fn index_mut(&mut self, index: usize) -> &mut Self::Output {
			if index < self.len {
				// SAFETY: buf_ptr and len invariant must be upheld.
				unsafe {
					return &mut *(self.buf_ptr.as_ptr().add(index));
				}
			}

			panic!("Index out of bounds");
		}
	}

	impl<RunAllocF, RunDeallocF> Drop for RunVec<RunAllocF, RunDeallocF>
	where
		RunAllocF: Fn(usize) -> *mut TimSortRun,
		RunDeallocF: Fn(*mut TimSortRun, usize),
	{
		fn drop(&mut self) {
			// As long as TimSortRun is Copy we don't need to drop them individually but just the
			// whole allocation.
			(self.run_dealloc_fn)(self.buf_ptr.as_ptr(), self.capacity);
		}
	}
}

/// Internal type used by merge_sort.
#[derive(Clone, Copy, Debug)]
pub struct TimSortRun {
	len: usize,
	start: usize,
}

/// Takes a range as denoted by start and end, that is already sorted and extends it to the right if
/// necessary with sorts optimized for smaller ranges such as insertion sort.
fn provide_sorted_batch<T, F>(
	mut v: ArrayViewMut1<'_, T>,
	start: usize,
	mut end: usize,
	is_less: &mut F,
) -> usize
where
	F: FnMut(&T, &T) -> bool,
{
	let len = v.len();
	assert!(end >= start && end <= len);

	// This value is a balance between least comparisons and best performance, as
	// influenced by for example cache locality.
	const MIN_INSERTION_RUN: usize = 10;

	// Insert some more elements into the run if it's too short. Insertion sort is faster than
	// merge sort on short sequences, so this significantly improves performance.
	let start_end_diff = end - start;

	if start_end_diff < MIN_INSERTION_RUN && end < len {
		// v[start_found..end] are elements that are already sorted in the input. We want to extend
		// the sorted region to the left, so we push up MIN_INSERTION_RUN - 1 to the right. Which is
		// more efficient that trying to push those already sorted elements to the left.
		end = cmp::min(start + MIN_INSERTION_RUN, len);
		let presorted_start = cmp::max(start_end_diff, 1);

		insertion_sort_shift_left(v.slice_mut(s![start..end]), presorted_start, is_less);
	}

	end
}

// Finds a streak of presorted elements starting at the beginning of the slice. Returns the first
/// value that is not part of said streak, and a bool denoting whether the streak was reversed.
/// Streaks can be increasing or decreasing.
fn find_streak<T, F>(v: ArrayView1<'_, T>, is_less: &mut F) -> (usize, bool)
where
	F: FnMut(&T, &T) -> bool,
{
	let len = v.len();

	if len < 2 {
		return (len, false);
	}

	let mut end = 2;

	// SAFETY: See below specific.
	unsafe {
		// SAFETY: We checked that len >= 2, so 0 and 1 are valid indices.
		let assume_reverse = is_less(v.uget(1), v.uget(0));

		// SAFETY: We know end >= 2 and check end < len.
		// From that follows that accessing v at end and end - 1 is safe.
		if assume_reverse {
			while end < len && is_less(v.uget(end), v.uget(end - 1)) {
				end += 1;
			}

			(end, true)
		} else {
			while end < len && !is_less(v.uget(end), v.uget(end - 1)) {
				end += 1;
			}
			(end, false)
		}
	}
}