diff options
Diffstat (limited to 'core/sort.h')
-rw-r--r-- | core/sort.h | 322 |
1 files changed, 322 insertions, 0 deletions
diff --git a/core/sort.h b/core/sort.h new file mode 100644 index 0000000000..583437a099 --- /dev/null +++ b/core/sort.h @@ -0,0 +1,322 @@ +/*************************************************************************/ +/* sort.h */ +/*************************************************************************/ +/* This file is part of: */ +/* GODOT ENGINE */ +/* http://www.godotengine.org */ +/*************************************************************************/ +/* Copyright (c) 2007-2014 Juan Linietsky, Ariel Manzur. */ +/* */ +/* Permission is hereby granted, free of charge, to any person obtaining */ +/* a copy of this software and associated documentation files (the */ +/* "Software"), to deal in the Software without restriction, including */ +/* without limitation the rights to use, copy, modify, merge, publish, */ +/* distribute, sublicense, and/or sell copies of the Software, and to */ +/* permit persons to whom the Software is furnished to do so, subject to */ +/* the following conditions: */ +/* */ +/* The above copyright notice and this permission notice shall be */ +/* included in all copies or substantial portions of the Software. */ +/* */ +/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */ +/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */ +/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/ +/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */ +/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */ +/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */ +/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ +/*************************************************************************/ +#ifndef SORT_H +#define SORT_H + +#include "typedefs.h" +/** + @author ,,, <red@lunatea> +*/ + +template<class T> +struct _DefaultComparator { + + inline bool operator()(const T&a,const T&b) const { return (a<b); } +}; + +template<class T, class Comparator=_DefaultComparator<T> > +class SortArray { + + enum { + + INTROSORT_TRESHOLD=16 + }; + +public: + + Comparator compare; + + + inline const T& median_of_3(const T& a, const T& b, const T& c) const { + + if (compare(a, b)) + if (compare(b, c)) + return b; + else if (compare(a, c)) + return c; + else + return a; + else if (compare(a, c)) + return a; + else if (compare(b, c)) + return c; + else + return b; + } + + + + inline int bitlog(int n) const { + int k; + for (k = 0; n != 1; n >>= 1) + ++k; + return k; + } + + + /* Heap / Heapsort functions */ + + inline void push_heap(int p_first,int p_hole_idx,int p_top_index,T p_value,T* p_array) const { + + int parent = (p_hole_idx - 1) / 2; + while (p_hole_idx > p_top_index && compare(p_array[p_first + parent], p_value)) { + + p_array[p_first + p_hole_idx] = p_array[p_first + parent]; + p_hole_idx = parent; + parent = (p_hole_idx - 1) / 2; + } + p_array[p_first + p_hole_idx] = p_value; + } + + inline void pop_heap(int p_first, int p_last, int p_result, T p_value, T* p_array) const { + + p_array[p_result]=p_array[p_first]; + adjust_heap(p_first,0,p_last-p_first,p_value,p_array); + } + inline void pop_heap(int p_first,int p_last,T* p_array) const { + + pop_heap(p_first,p_last-1,p_last-1,p_array[p_last-1],p_array); + } + + inline void adjust_heap(int p_first,int p_hole_idx,int p_len,T p_value,T* p_array) const { + + + int top_index = p_hole_idx; + int second_child = 2 * p_hole_idx + 2; + + while (second_child < p_len) { + + if (compare(p_array[p_first + second_child],p_array[p_first + (second_child - 1)])) + second_child--; + + p_array[p_first + p_hole_idx] = p_array[p_first + second_child]; + p_hole_idx = second_child; + second_child = 2 * (second_child + 1); + } + + if (second_child == p_len) { + p_array[p_first + p_hole_idx] = p_array[p_first + (second_child - 1)]; + p_hole_idx = second_child - 1; + } + push_heap(p_first, p_hole_idx, top_index, p_value,p_array); + } + + inline void sort_heap(int p_first,int p_last,T* p_array) const { + + while(p_last-p_first > 1) { + + pop_heap(p_first,p_last--,p_array); + } + } + + inline void make_heap(int p_first, int p_last,T* p_array) const { + if (p_last - p_first < 2) + return; + int len = p_last - p_first; + int parent = (len - 2)/2; + + while (true) { + adjust_heap(p_first, parent, len, p_array[p_first + parent], p_array); + if (parent == 0) + return; + parent--; + } + } + + inline void partial_sort(int p_first,int p_last,int p_middle,T* p_array) const { + + make_heap(p_first,p_middle,p_array); + for(int i=p_middle;i<p_last;i++) + if (compare( p_array[i],p_array[p_first])) + pop_heap(p_first,p_middle,i,p_array[i],p_array); + sort_heap(p_first,p_middle,p_array); + } + + inline void partial_select(int p_first,int p_last,int p_middle,T* p_array) const { + + make_heap(p_first,p_middle,p_array); + for(int i=p_middle;i<p_last;i++) + if (compare( p_array[i],p_array[p_first])) + pop_heap(p_first,p_middle,i,p_array[i],p_array); + } + + inline int partitioner(int p_first, int p_last, T p_pivot, T* p_array) const { + + while (true) { + while (compare(p_array[p_first],p_pivot)) + p_first++; + p_last--; + while (compare(p_pivot,p_array[p_last])) + p_last--; + + if (!(p_first < p_last)) + return p_first; + + SWAP(p_array[p_first],p_array[p_last]); + p_first++; + } + } + + inline void introsort(int p_first, int p_last, T* p_array, int p_max_depth) const { + + while( p_last - p_first > INTROSORT_TRESHOLD ) { + + if (p_max_depth == 0) { + partial_sort(p_first,p_last,p_last,p_array); + return; + } + + p_max_depth--; + + int cut = partitioner( + p_first, + p_last, + median_of_3( + p_array[p_first], + p_array[p_first + (p_last-p_first)/2], + p_array[p_last-1] + ), + p_array + ); + + introsort(cut,p_last,p_array,p_max_depth); + p_last=cut; + + } + } + + inline void introselect(int p_first, int p_nth, int p_last, T* p_array, int p_max_depth) const { + + while( p_last - p_first > 3 ) { + + if (p_max_depth == 0) { + partial_select(p_first,p_nth+1,p_last,p_array); + SWAP(p_first,p_nth); + return; + } + + p_max_depth--; + + int cut = partitioner( + p_first, + p_last, + median_of_3( + p_array[p_first], + p_array[p_first + (p_last-p_first)/2], + p_array[p_last-1] + ), + p_array + ); + + if (cut<=p_nth) + p_first=cut; + else + p_last=cut; + + } + + insertion_sort(p_first,p_last,p_array); + } + + inline void unguarded_linear_insert(int p_last,T p_value,T* p_array) const { + + int next = p_last-1; + while (compare(p_value,p_array[next])) { + p_array[p_last]=p_array[next]; + p_last = next; + next--; + } + p_array[p_last] = p_value; + } + + inline void linear_insert(int p_first,int p_last,T*p_array) const { + + T val = p_array[p_last]; + if (compare(val, p_array[p_first])) { + + for (int i=p_last; i>p_first; i--) + p_array[i]=p_array[i-1]; + + p_array[p_first] = val; + } else + unguarded_linear_insert(p_last, val, p_array); + } + + inline void insertion_sort(int p_first,int p_last,T* p_array) const { + + if (p_first==p_last) + return; + for (int i=p_first+1; i!=p_last ; i++) + linear_insert(p_first,i,p_array); + } + + inline void unguarded_insertion_sort(int p_first,int p_last,T* p_array) const { + + for (int i=p_first; i!=p_last ; i++) + unguarded_linear_insert(i,p_array[i],p_array); + } + + inline void final_insertion_sort(int p_first,int p_last,T* p_array) const { + + if (p_last - p_first > INTROSORT_TRESHOLD) { + insertion_sort(p_first,p_first+INTROSORT_TRESHOLD,p_array); + unguarded_insertion_sort(p_first+INTROSORT_TRESHOLD,p_last,p_array); + } else { + + insertion_sort(p_first,p_last,p_array); + + } + } + + inline void sort_range(int p_first, int p_last,T* p_array) const { + + if (p_first != p_last) { + introsort(p_first, p_last,p_array,bitlog(p_last - p_first) * 2); + final_insertion_sort(p_first, p_last, p_array); + } + } + + inline void sort(T* p_array,int p_len) const { + + sort_range(0,p_len,p_array); + } + + inline void nth_element(int p_first,int p_last,int p_nth,T* p_array) const { + + if (p_first==p_last || p_nth==p_last) + return; + introselect(p_first,p_nth,p_last,p_array,bitlog(p_last - p_first) * 2); + } + +}; + + + + +#endif |