| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475 |
- /******************************************************************************
- * 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_num(const void * a, const void * b)
- {
- unsigned char isnum_a, isnum_b;
- isnum_a = is_number(*(char **) a);
- isnum_b = is_number(*(char **) b);
- if (isnum_a && isnum_b)
- {
- long double num_a = tintoi(*(char **) a);
- long double num_b = tintoi(*(char **) b);
- return num_a < num_b ? -1 : num_a > num_b ? 1 : 0;
- }
- else if (isnum_a)
- {
- return -1;
- }
- else if (isnum_b)
- {
- return 1;
- }
- else
- {
- return strcmp(*(const char **) a, *(const char **) b);
- }
- }
|