ref: d32578073676ce90769c378cbd5c61db22c1b49e
dir: /sys/src/cmd/disk/sacfs/ssort6.c/
#include <u.h>
#include <libc.h>
#include "ssort.h"
#define pred(i, h) ((t=(i)-(h))<0? t+n: t)
#define succ(i, h) ((t=(i)+(h))>=n? t-n: t)
enum
{
BUCK = ~(~0u>>1), /* high bit */
MAXI = ~0u>>1, /* biggest int */
};
typedef int Elem;
static void qsort2(Elem*, Elem*, int n);
static int ssortit(int a[], int p[], int s[], int q[], int n, int h, int *pe, int nbuck);
static void lift(int si, int q[], int i);
int sharedlen(int i, int j, int s[], int q[]);
int
ssort(int a[], int s[], int n)
{
int i, l;
int c, cc, ncc, lab, cum, nbuck;
int k;
int *p = 0;
int result = 0;
int *q = 0;
int *al;
int *pl;
# define finish(r) if(1){result=r; goto out;}else
for(k=0,i=0; i<n; i++)
if(a[i] > k)
k = a[i]; /* max element */
k++;
if(k>n)
finish(2);
nbuck = 0;
p = malloc(n*sizeof(int));
if(p == 0)
finish(1);
if(s) { /* shared lengths */
q = malloc(((n+1)>>1)*sizeof(int));
if(q == 0)
finish(1);
for(i=0; i<n; i++)
s[i] = q[i>>1] = MAXI;
q[i>>1] = MAXI;
}
pl = p + n - k;
al = a;
memset(pl, -1, k*sizeof(int));
for(i=0; i<n; i++) { /* (1) link */
l = a[i];
al[i] = pl[l];
pl[l] = i;
}
for(i=0; i<k; i++) /* check input - no holes */
if(pl[i]<0)
finish(2);
lab = 0; /* (2) create p and label a */
cum = 0;
i = 0;
for(c = 0; c < k; c++){
for(cc = pl[c]; cc != -1; cc = ncc){
ncc = al[cc];
al[cc] = lab;
cum++;
p[i++] = cc;
}
if(lab + 1 == cum) {
i--;
} else {
p[i-1] |= BUCK;
nbuck++;
}
if(s) {
s[lab] = 0;
lift(0, q, lab);
}
lab = cum;
}
ssortit(a, p, s, q, n, 1, p+i, nbuck);
memcpy(a, p, n*sizeof(int));
out:
free(p);
free(q);
return result;
}
/*
* calculate the suffix array for the bytes in buf,
* terminated by a unique end marker less than any character in buf
* returns the index of the identity permutation,
* and -1 if there was an error.
*/
int
ssortbyte(uchar buf[], int p[], int s[], int n)
{
int *a, *q, buckets[256*256];
int i, last, lastc, cum, c, cc, ncc, lab, id, nbuck;
a = malloc((n+1)*sizeof(int));
if(a == nil)
return -1;
q = nil;
if(s) { /* shared lengths */
q = malloc(((n+2)>>1)*sizeof(int));
if(q == nil){
free(a);
return -1;
}
for(i=0; i<n+1; i++)
s[i] = q[i>>1] = MAXI;
q[i>>1] = MAXI;
}
memset(buckets, -1, sizeof(buckets));
c = buf[n-1] << 8;
last = c;
for(i = n - 2; i >= 0; i--){
c = (buf[i] << 8) | (c >> 8);
a[i] = buckets[c];
buckets[c] = i;
}
/*
* end of string comes before anything else
*/
a[n] = 0;
if(s) {
s[0] = 0;
lift(0, q, 0);
}
lab = 1;
cum = 1;
i = 0;
lastc = 1; /* won't match c & 0xff00 for any c */
nbuck = 0;
for(c = 0; c < 256*256; c++) {
/*
* last character is followed by unique end of string
*/
if(c == last) {
a[n-1] = lab;
if(s) {
s[lab] = 0;
lift(0, q, lab);
}
cum++;
lab++;
lastc = c & 0xff00;
}
for(cc = buckets[c]; cc != -1; cc = ncc) {
ncc = a[cc];
a[cc] = lab;
cum++;
p[i++] = cc;
}
if(lab == cum)
continue;
if(lab + 1 == cum)
i--;
else {
p[i - 1] |= BUCK;
nbuck++;
}
if(s) {
cc = (c & 0xff00) == lastc;
s[lab] = cc;
lift(cc, q, lab);
}
lastc = c & 0xff00;
lab = cum;
}
id = ssortit(a, p, s, q, n+1, 2, p+i, nbuck);
free(a);
free(q);
return id;
}
/*
* can get an interval for the shared lengths from [h,3h) by recording h
* rather than h + sharedlen(..) when relabelling. if so, no calls to lift are needed.
*/
static int
ssortit(int a[], int p[], int shared[], int q[], int n, int h, int *pe, int nbuck)
{
int *s, *ss, *packing, *sorting;
int v, sv, vv, packed, lab, t, i;
for(; h < n && p < pe; h=2*h) {
packing = p;
nbuck = 0;
for(sorting = p; sorting < pe; sorting = s){
/*
* find length of stuff to sort
*/
lab = a[*sorting];
for(s = sorting; ; s++) {
sv = *s;
v = a[succ(sv & ~BUCK, h)];
if(v & BUCK)
v = lab;
a[sv & ~BUCK] = v | BUCK;
if(sv & BUCK)
break;
}
*s++ &= ~BUCK;
nbuck++;
qsort2(sorting, a, s - sorting);
v = a[*sorting];
a[*sorting] = lab;
packed = 0;
for(ss = sorting + 1; ss < s; ss++) {
sv = *ss;
vv = a[sv];
if(vv == v) {
*packing++ = ss[-1];
packed++;
} else {
if(packed) {
*packing++ = ss[-1] | BUCK;
}
lab += packed + 1;
if(shared) {
v = h + sharedlen(v&~BUCK, vv&~BUCK, shared, q);
shared[lab] = v;
lift(v, q, lab);
}
packed = 0;
v = vv;
}
a[sv] = lab;
}
if(packed) {
*packing++ = ss[-1] | BUCK;
}
}
pe = packing;
}
/*
* reconstuct the permutation matrix
* return index of the entire string
*/
v = a[0];
for(i = 0; i < n; i++)
p[a[i]] = i;
return v;
}
/* Propagate a new entry s[i], with value si, into q[]. */
static void
lift(int si, int q[], int i)
{
for(i >>= 1; q[i] > si; i &= ~-i) /* squash the low 1-bit */
q[i] = si;
}
/*
* Find in s[] the minimum value over the interval i<=k<=j, using
* tree q[] to do logarithmic, rather than linear search
*/
int
sharedlen(int i, int j, int s[], int q[])
{
int k, v;
int min = MAXI;
int max = 0;
if(i > j) { /* swap i & j */
i ^= j;
j ^= i;
i ^= j;
}
i++;
while(i <= j && min > max) {
k = i & -i;
if(i & 1)
v = s[i];
else
v = q[i>>1];
if(i+k > j+1) {
if(v > max)
max = v;
if(s[i] < min)
min = s[i];
i++;
} else {
if(v < min)
min = v;
i += k;
}
}
return min;
}
/*
* qsort specialized for sorting permutations based on successors
*/
static void
vecswap2(Elem *a, Elem *b, int n)
{
while (n-- > 0) {
Elem t = *a;
*a++ = *b;
*b++ = t;
}
}
#define swap2(a, b) { t = *(a); *(a) = *(b); *(b) = t; }
#define ptr2char(i, asucc) (asucc[*(i)])
static Elem*
med3(Elem *a, Elem *b, Elem *c, Elem *asucc)
{
Elem va, vb, vc;
if ((va=ptr2char(a, asucc)) == (vb=ptr2char(b, asucc)))
return a;
if ((vc=ptr2char(c, asucc)) == va || vc == vb)
return c;
return va < vb ?
(vb < vc ? b : (va < vc ? c : a))
: (vb > vc ? b : (va < vc ? a : c));
}
static void
inssort(Elem *a, Elem *asucc, int n)
{
Elem *pi, *pj, t;
for (pi = a + 1; --n > 0; pi++)
for (pj = pi; pj > a; pj--) {
if(ptr2char(pj-1, asucc) <= ptr2char(pj, asucc))
break;
swap2(pj, pj-1);
}
}
static void
qsort2(Elem *a, Elem *asucc, int n)
{
Elem d, r, partval;
Elem *pa, *pb, *pc, *pd, *pl, *pm, *pn, t;
if (n < 15) {
inssort(a, asucc, n);
return;
}
pl = a;
pm = a + (n >> 1);
pn = a + (n-1);
if (n > 30) { /* On big arrays, pseudomedian of 9 */
d = (n >> 3);
pl = med3(pl, pl+d, pl+2*d, asucc);
pm = med3(pm-d, pm, pm+d, asucc);
pn = med3(pn-2*d, pn-d, pn, asucc);
}
pm = med3(pl, pm, pn, asucc);
swap2(a, pm);
partval = ptr2char(a, asucc);
pa = pb = a + 1;
pc = pd = a + n-1;
for (;;) {
while (pb <= pc && (r = ptr2char(pb, asucc)-partval) <= 0) {
if (r == 0) {
swap2(pa, pb);
pa++;
}
pb++;
}
while (pb <= pc && (r = ptr2char(pc, asucc)-partval) >= 0) {
if (r == 0) {
swap2(pc, pd);
pd--;
}
pc--;
}
if (pb > pc)
break;
swap2(pb, pc);
pb++;
pc--;
}
pn = a + n;
r = pa-a;
if(pb-pa < r)
r = pb-pa;
vecswap2(a, pb-r, r);
r = pn-pd-1;
if(pd-pc < r)
r = pd-pc;
vecswap2(pb, pn-r, r);
if ((r = pb-pa) > 1)
qsort2(a, asucc, r);
if ((r = pd-pc) > 1)
qsort2(a + n-r, asucc, r);
}