| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483 |
- /******************************************************************************
- * This file is part of TinTin++ *
- * *
- * Copyright (C) 2004-2020 Igor van den Hoven *
- * *
- * TinTin++ is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 3 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with TinTin++. If not, see https://www.gnu.org/licenses. *
- ******************************************************************************/
- /******************************************************************************
- * T I N T I N + + *
- * *
- * coded by Igor van den Hoven 2020 *
- ******************************************************************************/
- #include "tintin.h"
- #include <assert.h>
- //typedef int CMPFUNC (const void *a, const void *b);
- void quad_sort32(int *array, int *swap, size_t nmemb, size_t block, CMPFUNC *cmp);
- void quad_swap32(int *array, int *swap, size_t nmemb, CMPFUNC *cmp)
- {
- size_t offset;
- register unsigned char loop;
- register int *pta, *pts, *ptt, tmp;
- pta = array;
- for (offset = 0 ; offset + 4 <= nmemb ; offset += 4)
- {
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- if (cmp(&pta[2], &pta[3]) > 0)
- {
- tmp = pta[2];
- pta[2] = pta[3];
- pta[3] = tmp;
- }
- if (cmp(&pta[1], &pta[2]) > 0)
- {
- if (cmp(&pta[0], &pta[3]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[2];
- pta[2] = tmp;
- tmp = pta[1];
- pta[1] = pta[3];
- pta[3] = tmp;
- }
- else if (cmp(&pta[0], &pta[2]) <= 0)
- {
- if (cmp(&pta[1], &pta[3]) <= 0)
- {
- tmp = pta[1];
- pta[1] = pta[2];
- pta[2] = tmp;
- }
- else
- {
- tmp = pta[1];
- pta[1] = pta[2];
- pta[2] = pta[3];
- pta[3] = tmp;
- }
- }
- else
- {
- if (cmp(&pta[1], &pta[3]) <= 0)
- {
- tmp = pta[0];
- pta[0] = pta[2];
- pta[2] = pta[1];
- pta[1] = tmp;
- }
- else
- {
- tmp = pta[0];
- pta[0] = pta[2];
- pta[2] = pta[3];
- pta[3] = pta[1];
- pta[1] = tmp;
- }
- }
- }
- pta += 4;
- }
- switch (nmemb - offset)
- {
- case 0:
- case 1:
- break;
- case 2:
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- break;
- case 3:
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- if (cmp(&pta[1], &pta[2]) > 0)
- {
- tmp = pta[1];
- pta[1] = pta[2];
- pta[2] = tmp;
- }
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- break;
- default:
- assert(nmemb - offset > 3);
- }
- pta = array;
- for (offset = 0 ; offset + 16 <= nmemb ; offset += 16)
- {
- if (cmp(&pta[3], &pta[4]) <= 0)
- {
- if (cmp(&pta[11], &pta[12]) <= 0)
- {
- if (cmp(&pta[7], &pta[8]) <= 0)
- {
- pta += 16;
- continue;
- }
- pts = swap;
- for (loop = 0 ; loop < 16 ; loop++)
- *pts++ = *pta++;
- goto step3;
- }
- pts = swap;
- for (loop = 0 ; loop < 8 ; loop++)
- *pts++ = *pta++;
- goto step2;
- }
- // step1:
- pts = swap;
- if (cmp(&pta[3], &pta[7]) <= 0)
- {
- ptt = pta + 4;
- for (loop = 0 ; loop < 5 ; loop++)
- if (cmp(pta, ptt) > 0)
- *pts++ = *ptt++;
- else
- *pts++ = *pta++;
- while (pta < array + offset + 4)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (ptt < array + offset + 8)
- {
- *pts++ = *ptt++;
- }
- pta = ptt;
- }
- else if (cmp(&pta[0], &pta[7]) > 0)
- {
- if (cmp(&pta[8], &pta[15]) > 0)
- {
- if (cmp(&pta[4], &pta[11]) > 0)
- {
- tmp = pta[0]; pta[0] = pta[12]; pta[12] = tmp;
- tmp = pta[1]; pta[1] = pta[13]; pta[13] = tmp;
- tmp = pta[2]; pta[2] = pta[14]; pta[14] = tmp;
- tmp = pta[3]; pta[3] = pta[15]; pta[15] = tmp;
- tmp = pta[4]; pta[4] = pta[8]; pta[8] = tmp;
- tmp = pta[5]; pta[5] = pta[9]; pta[9] = tmp;
- tmp = pta[6]; pta[6] = pta[10]; pta[10] = tmp;
- tmp = pta[7]; pta[7] = pta[11]; pta[11] = tmp;
- pta += 16;
- continue;
- }
- pta += 4;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta += 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta += 4;
- goto step3;
- }
- pta += 4;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta += 4;
- }
- else
- {
- ptt = pta + 4;
- for (loop = 0 ; loop < 5 ; loop++)
- if (cmp(pta, ptt) > 0)
- *pts++ = *ptt++;
- else
- *pts++ = *pta++;
- while (ptt < array + offset + 8)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (pta < array + offset + 4)
- {
- *pts++ = *pta++;
- }
- pta = ptt;
- }
- step2:
- if (cmp(&pta[3], &pta[7]) <= 0)
- {
- ptt = pta + 4;
- for (loop = 0 ; loop < 4 ; loop++)
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- while (pta < array + offset + 12)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (ptt < array + offset + 16)
- {
- *pts++ = *ptt++;
- }
- }
- else if (cmp(&pta[0], &pta[7]) > 0)
- {
- pta += 4;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- }
- else
- {
- ptt = pta + 4;
- for (loop = 0 ; loop < 5 ; loop++)
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- while (ptt < array + offset + 16)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (pta < array + offset + 12)
- {
- *pts++ = *pta++;
- }
- }
- step3:
- pta = array + offset;
- pts = swap;
- if (cmp(&pts[7], &pts[15]) <= 0)
- {
- ptt = pts + 8;
- for (loop = 0 ; loop < 8 ; loop++)
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- while (pts < swap + 8)
- {
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- }
- while (ptt < swap + 16)
- {
- *pta++ = *ptt++;
- }
- }
- else if (cmp(&pts[0], &pts[15]) > 0)
- {
- pts += 8;
- for (loop = 0 ; loop < 8 ; loop++)
- *pta++ = *pts++;
- pts -= 16;
- for (loop = 0 ; loop < 8 ; loop++)
- *pta++ = *pts++;
- }
- else
- {
- ptt = pts + 8;
- for (loop = 0 ; loop < 9 ; loop++)
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- while (ptt < swap + 16)
- {
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- }
- while (pts < swap + 8)
- {
- *pta++ = *pts++;
- }
- }
- }
- switch (nmemb - offset)
- {
- case 0:
- case 1:
- case 2:
- case 3:
- case 4:
- return;
- default:
- quad_sort32(pta, swap, nmemb - offset, 4, cmp);
- }
- }
- void quad_sort64(long long *array, long long *swap, size_t nmemb, size_t block, CMPFUNC *cmp);
- void quad_swap64(long long *array, long long *swap, size_t nmemb, CMPFUNC *cmp)
- {
- size_t offset;
- register long long *pta, *pts, *ptt, tmp;
- pta = array;
- for (offset = 0 ; offset + 4 <= nmemb ; offset += 4)
- {
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- if (cmp(&pta[2], &pta[3]) > 0)
- {
- tmp = pta[2];
- pta[2] = pta[3];
- pta[3] = tmp;
- }
- if (cmp(&pta[1], &pta[2]) > 0)
- {
- if (cmp(&pta[0], &pta[3]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[2];
- pta[2] = tmp;
- tmp = pta[1];
- pta[1] = pta[3];
- pta[3] = tmp;
- }
- else if (cmp(&pta[0], &pta[2]) <= 0)
- {
- if (cmp(&pta[1], &pta[3]) <= 0)
- {
- tmp = pta[1];
- pta[1] = pta[2];
- pta[2] = tmp;
- }
- else
- {
- tmp = pta[1];
- pta[1] = pta[2];
- pta[2] = pta[3];
- pta[3] = tmp;
- }
- }
- else
- {
- if (cmp(&pta[1], &pta[3]) <= 0)
- {
- tmp = pta[0];
- pta[0] = pta[2];
- pta[2] = pta[1];
- pta[1] = tmp;
- }
- else
- {
- tmp = pta[0];
- pta[0] = pta[2];
- pta[2] = pta[3];
- pta[3] = pta[1];
- pta[1] = tmp;
- }
- }
- }
- pta += 4;
- }
- switch (nmemb - offset)
- {
- case 0:
- case 1:
- break;
- case 2:
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- break;
- case 3:
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- if (cmp(&pta[1], &pta[2]) > 0)
- {
- tmp = pta[1];
- pta[1] = pta[2];
- pta[2] = tmp;
- }
- if (cmp(&pta[0], &pta[1]) > 0)
- {
- tmp = pta[0];
- pta[0] = pta[1];
- pta[1] = tmp;
- }
- break;
- default:
- assert(nmemb - offset > 3);
- }
- pta = array;
- for (offset = 0 ; offset + 16 <= nmemb ; offset += 16)
- {
- if (cmp(&pta[3], &pta[4]) <= 0)
- {
- if (cmp(&pta[11], &pta[12]) <= 0)
- {
- if (cmp(&pta[7], &pta[8]) <= 0)
- {
- pta += 16;
- continue;
- }
- pts = swap;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- goto step3;
- }
- pts = swap;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- goto step2;
- }
- // step1:
- pts = swap;
- if (cmp(&pta[3], &pta[7]) <= 0)
- {
- ptt = pta + 4;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- while (pta < array + offset + 4)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (ptt < array + offset + 8)
- {
- *pts++ = *ptt++;
- }
- pta = ptt;
- }
- else if (cmp(&pta[0], &pta[7]) > 0)
- {
- if (cmp(&pta[8], &pta[15]) > 0)
- {
- if (cmp(&pta[4], &pta[11]) > 0)
- {
- tmp = pta[0]; pta[0] = pta[12]; pta[12] = tmp;
- tmp = pta[1]; pta[1] = pta[13]; pta[13] = tmp;
- tmp = pta[2]; pta[2] = pta[14]; pta[14] = tmp;
- tmp = pta[3]; pta[3] = pta[15]; pta[15] = tmp;
- tmp = pta[4]; pta[4] = pta[8]; pta[8] = tmp;
- tmp = pta[5]; pta[5] = pta[9]; pta[9] = tmp;
- tmp = pta[6]; pta[6] = pta[10]; pta[10] = tmp;
- tmp = pta[7]; pta[7] = pta[11]; pta[11] = tmp;
- pta += 16;
- continue;
- }
- pta += 4;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta += 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta += 4;
- goto step3;
- }
- pta += 4;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta += 4;
- }
- else
- {
- ptt = pta + 4;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- while (ptt < array + offset + 8)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (pta < array + offset + 4)
- {
- *pts++ = *pta++;
- }
- pta = ptt;
- }
- step2:
- if (cmp(&pta[3], &pta[7]) <= 0)
- {
- ptt = pta + 4;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- // *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- while (pta < array + offset + 12)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (ptt < array + offset + 16)
- {
- *pts++ = *ptt++;
- }
- }
- else if (cmp(&pta[0], &pta[7]) > 0)
- {
- pta += 4;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- pta -= 8;
- *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++; *pts++ = *pta++;
- }
- else
- {
- ptt = pta + 4;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- while (ptt < array + offset + 16)
- {
- *pts++ = cmp(pta, ptt) > 0 ? *ptt++ : *pta++;
- }
- while (pta < array + offset + 12)
- {
- *pts++ = *pta++;
- }
- }
- step3:
- pta = array + offset;
- pts = swap;
- if (cmp(&pts[7], &pts[15]) <= 0)
- {
- ptt = pts + 8;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- // *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- while (pts < swap + 8)
- {
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- }
- while (ptt < swap + 16)
- {
- *pta++ = *ptt++;
- }
- }
- else if (cmp(&pts[0], &pts[15]) > 0)
- {
- pts += 8;
- *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++;
- *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++;
- pts -= 16;
- *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++;
- *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++; *pta++ = *pts++;
- }
- else
- {
- ptt = pts + 8;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- while (ptt < swap + 16)
- {
- *pta++ = cmp(pts, ptt) > 0 ? *ptt++ : *pts++;
- }
- while (pts < swap + 8)
- {
- *pta++ = *pts++;
- }
- }
- }
- switch (nmemb - offset)
- {
- case 0:
- case 1:
- case 2:
- case 3:
- case 4:
- return;
- default:
- quad_sort64(pta, swap, nmemb - offset, 4, cmp);
- }
- }
- void quad_sort32(int *array, int *swap, size_t nmemb, size_t block, CMPFUNC *cmp)
- {
- size_t offset;
- register int *pta, *pts, *c, *c_max, *d, *d_max;
- while (block < nmemb)
- {
- offset = 0;
- while (offset + block < nmemb)
- {
- pta = array;
- pta += offset;
- c_max = pta + block;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- if (offset + block * 3 < nmemb)
- {
- c_max = pta + block * 3;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- c_max = pta + block * 2;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- offset += block * 4;
- continue;
- }
- pts = swap;
- c = pta;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- c = c_max;
- c_max = offset + block * 4 <= nmemb ? c + block * 2 : array + nmemb;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- goto step3;
- }
- pts = swap;
- c = pta;
- c_max = pta + block * 2;
- while (c < c_max)
- *pts++ = *c++;
- goto step2;
- }
- else if (offset + block * 2 < nmemb)
- {
- c_max = pta + block * 2;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- offset += block * 4;
- continue;
- }
- pts = swap;
- c = pta;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- goto step2;
- }
- else
- {
- offset += block * 4;
- continue;
- }
- }
- // step1:
- pts = swap;
- c = pta;
- d = c_max;
- d_max = offset + block * 2 <= nmemb ? d + block : array + nmemb;
- if (cmp(c_max - 1, d_max - 1) <= 0)
- {
- while (c < c_max)
- {
- while (cmp(c, d) > 0)
- {
- *pts++ = *d++;
- }
- *pts++ = *c++;
- }
- while (d < d_max)
- *pts++ = *d++;
- }
- else if (cmp(c, d_max - 1) > 0)
- {
- if (offset + block * 4 <= nmemb)
- {
- int *e, *e_max, *f, *f_max, tmp;
- e = pta + block * 2;
- e_max = e + block;
- f = e_max;
- f_max = f + block;
- if (cmp(e, f_max - 1) > 0)
- {
- if (cmp(d, f_max - 1) > 0)
- {
- while (c < c_max)
- {
- tmp = *c;
- *c++ = *f;
- *f++ = tmp;
- }
- while (d < d_max)
- {
- tmp = *d;
- *d++ = *e;
- *e++ = tmp;
- }
- offset += block * 4;
- continue;
- }
- }
- }
- while (d < d_max - 8)
- {
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- }
- while (d < d_max)
- *pts++ = *d++;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- else
- {
- while (d < d_max)
- {
- while (cmp(c, d) <= 0)
- {
- *pts++ = *c++;
- }
- *pts++ = *d++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- step2:
- if (offset + block * 2 < nmemb)
- {
- c = pta + block * 2;
- if (offset + block * 3 < nmemb)
- {
- c_max = c + block;
- d = c_max;
- d_max = offset + block * 4 <= nmemb ? d + block : array + nmemb;
- if (cmp(c_max - 1, d_max - 1) <= 0)
- {
- while (c < c_max)
- {
- while (cmp(c, d) > 0)
- {
- *pts++ = *d++;
- }
- *pts++ = *c++;
- }
- while (d < d_max)
- *pts++ = *d++;
- }
- else if (cmp(c, d_max - 1) > 0)
- {
- while (d < d_max - 8)
- {
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- }
- while (d < d_max)
- *pts++ = *d++;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- else
- {
- while (d < d_max)
- {
- while (cmp(c, d) <= 0)
- {
- *pts++ = *c++;
- }
- *pts++ = *d++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- }
- else
- {
- d = c;
- d_max = array + nmemb;
- pts = swap;
- c = pts;
- c_max = c + block * 2;
- goto quickstep;
- }
- }
- step3:
- pts = swap;
- c = pts;
- if (offset + block * 2 < nmemb)
- {
- c_max = c + block * 2;
- d = c_max;
- d_max = offset + block * 4 <= nmemb ? d + block * 2 : pts + nmemb - offset;
- quickstep:
- if (cmp(c_max - 1, d_max - 1) <= 0)
- {
- while (c < c_max)
- {
- while (cmp(c, d) > 0)
- {
- *pta++ = *d++;
- }
- *pta++ = *c++;
- }
- while (d < d_max)
- *pta++ = *d++;
- }
- else if (cmp(c, d_max - 1) > 0)
- {
- while (d < d_max - 16)
- {
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- }
- while (d < d_max)
- *pta++ = *d++;
- while (c < c_max - 16)
- {
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- }
- while (c < c_max)
- *pta++ = *c++;
- }
- else
- {
- while (d < d_max)
- {
- while (cmp(d, c) > 0)
- {
- *pta++ = *c++;
- }
- *pta++ = *d++;
- }
- while (c < c_max)
- *pta++ = *c++;
- }
- }
- else
- {
- d_max = pts + nmemb - offset;
- while (c < d_max - 8)
- {
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- }
- while (c < d_max)
- *pta++ = *c++;
- }
- offset += block * 4;
- }
- block *= 4;
- }
- }
- void quad_sort64(long long *array, long long *swap, size_t nmemb, size_t block, CMPFUNC *cmp)
- {
- size_t offset;
- register long long *pta, *pts, *c, *c_max, *d, *d_max;
- while (block < nmemb)
- {
- offset = 0;
- while (offset + block < nmemb)
- {
- pta = array;
- pta += offset;
- c_max = pta + block;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- if (offset + block * 3 < nmemb)
- {
- c_max = pta + block * 3;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- c_max = pta + block * 2;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- offset += block * 4;
- continue;
- }
- pts = swap;
- c = pta;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- c = c_max;
- c_max = offset + block * 4 <= nmemb ? c + block * 2 : array + nmemb;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- goto step3;
- }
- pts = swap;
- c = pta;
- c_max = pta + block * 2;
- while (c < c_max)
- *pts++ = *c++;
- goto step2;
- }
- else if (offset + block * 2 < nmemb)
- {
- c_max = pta + block * 2;
- if (cmp(c_max - 1, c_max) <= 0)
- {
- offset += block * 4;
- continue;
- }
- pts = swap;
- c = pta;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- goto step2;
- }
- else
- {
- offset += block * 4;
- continue;
- }
- }
- // step1:
- pts = swap;
- c = pta;
- d = c_max;
- d_max = offset + block * 2 <= nmemb ? d + block : array + nmemb;
- if (cmp(c_max - 1, d_max - 1) <= 0)
- {
- while (c < c_max)
- {
- while (cmp(c, d) > 0)
- {
- *pts++ = *d++;
- }
- *pts++ = *c++;
- }
- while (d < d_max)
- *pts++ = *d++;
- }
- else if (cmp(c, d_max - 1) > 0)
- {
- if (offset + block * 4 <= nmemb)
- {
- long long *e, *e_max, *f, *f_max, tmp;
- e = pta + block * 2;
- e_max = e + block;
- f = e_max;
- f_max = f + block;
- if (cmp(e, f_max - 1) > 0)
- {
- if (cmp(d, f_max - 1) > 0)
- {
- while (c < c_max)
- {
- tmp = *c;
- *c++ = *f;
- *f++ = tmp;
- }
- while (d < d_max)
- {
- tmp = *d;
- *d++ = *e;
- *e++ = tmp;
- }
- offset += block * 4;
- continue;
- }
- }
- }
- while (d < d_max - 8)
- {
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- }
- while (d < d_max)
- *pts++ = *d++;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- else
- {
- while (d < d_max)
- {
- while (cmp(c, d) <= 0)
- {
- *pts++ = *c++;
- }
- *pts++ = *d++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- step2:
- if (offset + block * 2 < nmemb)
- {
- c = pta + block * 2;
- if (offset + block * 3 < nmemb)
- {
- c_max = c + block;
- d = c_max;
- d_max = offset + block * 4 <= nmemb ? d + block : array + nmemb;
- if (cmp(c_max - 1, d_max - 1) <= 0)
- {
- while (c < c_max)
- {
- while (cmp(c, d) > 0)
- {
- *pts++ = *d++;
- }
- *pts++ = *c++;
- }
- while (d < d_max)
- *pts++ = *d++;
- }
- else if (cmp(c, d_max - 1) > 0)
- {
- while (d < d_max - 8)
- {
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- *pts++ = *d++; *pts++ = *d++; *pts++ = *d++; *pts++ = *d++;
- }
- while (d < d_max)
- *pts++ = *d++;
- while (c < c_max - 8)
- {
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- *pts++ = *c++; *pts++ = *c++; *pts++ = *c++; *pts++ = *c++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- else
- {
- while (d < d_max)
- {
- while (cmp(c, d) <= 0)
- {
- *pts++ = *c++;
- }
- *pts++ = *d++;
- }
- while (c < c_max)
- *pts++ = *c++;
- }
- }
- else
- {
- d = c;
- d_max = array + nmemb;
- pts = swap;
- c = pts;
- c_max = c + block * 2;
- goto quickstep;
- }
- }
- step3:
- pts = swap;
- c = pts;
- if (offset + block * 2 < nmemb)
- {
- c_max = c + block * 2;
- d = c_max;
- d_max = offset + block * 4 <= nmemb ? d + block * 2 : pts + nmemb - offset;
- quickstep:
- if (cmp(c_max - 1, d_max - 1) <= 0)
- {
- while (c < c_max)
- {
- while (cmp(c, d) > 0)
- {
- *pta++ = *d++;
- }
- *pta++ = *c++;
- }
- while (d < d_max)
- *pta++ = *d++;
- }
- else if (cmp(c, d_max - 1) > 0)
- {
- while (d < d_max - 16)
- {
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- *pta++ = *d++; *pta++ = *d++; *pta++ = *d++; *pta++ = *d++;
- }
- while (d < d_max)
- *pta++ = *d++;
- while (c < c_max - 16)
- {
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- }
- while (c < c_max)
- *pta++ = *c++;
- }
- else
- {
- while (d < d_max)
- {
- while (cmp(d, c) > 0)
- {
- *pta++ = *c++;
- }
- *pta++ = *d++;
- }
- while (c < c_max)
- *pta++ = *c++;
- }
- }
- else
- {
- d_max = pts + nmemb - offset;
- while (c < d_max - 8)
- {
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- *pta++ = *c++; *pta++ = *c++; *pta++ = *c++; *pta++ = *c++;
- }
- while (c < d_max)
- *pta++ = *c++;
- }
- offset += block * 4;
- }
- block *= 4;
- }
- }
- void quadsort(void *array, size_t nmemb, size_t size, CMPFUNC *cmp)
- {
- void *swap;
- swap = malloc(nmemb * size);
- if (size == sizeof(int))
- {
- quad_swap32(array, swap, nmemb, cmp);
- quad_sort32(array, swap, nmemb, 16, cmp);
- }
- else if (size == sizeof(long long))
- {
- quad_swap64(array, swap, nmemb, cmp);
- quad_sort64(array, swap, nmemb, 16, cmp);
- }
- else
- {
- assert(size == 4 || size == 8);
- }
- free(swap);
- }
- int cmp_int(const void * a, const void * b)
- {
- return *(int *) a - *(int *) b;
- }
- int cmp_str(const void * a, const void * b)
- {
- return strcmp(*(const char **) a, *(const char **) b);
- }
- int cmp_float(const void * a, const void * b)
- {
- return *(float *) a - *(float *) b;
- }
- int cmp_num(const void * a, const void * b)
- {
- if (is_number(*(char **) a) && is_number(*(char **) b))
- {
- long double num_a = is_number(*(char **) a) ? tintoi(*(char **) a) : 0;
- long double num_b = is_number(*(char **) b) ? tintoi(*(char **) b) : 0;
- if (num_a < num_b)
- {
- return -1;
- }
- if (num_a > num_b)
- {
- return 1;
- }
- return 0;
- }
- else if (is_number(*(char **) a))
- {
- return -1;
- }
- else if (is_number(*(char **) b))
- {
- return 1;
- }
- else
- {
- return strcmp(*(const char **) a, *(const char **) b);
- }
- }
|