00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029 #include "SortingTools.h"
00030
00031
00032 int SortingTools::sortScalars(int n, double *y, int *perm) const {
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043 int i, j;
00044 int igap = n / 2;
00045
00046 if (igap == 0) {
00047 if ((n > 0) && (perm != 0)) {
00048 perm[0] = 0;
00049 }
00050 return 0;
00051 }
00052
00053 if (perm) {
00054 for (i = 0; i < n; ++i)
00055 perm[i] = i;
00056 }
00057
00058 while (igap > 0) {
00059 for (i=igap; i<n; ++i) {
00060 for (j=i-igap; j>=0; j-=igap) {
00061 if (y[j] > y[j+igap]) {
00062 double tmpD = y[j];
00063 y[j] = y[j+igap];
00064 y[j+igap] = tmpD;
00065 if (perm) {
00066 int tmpI = perm[j];
00067 perm[j] = perm[j+igap];
00068 perm[j+igap] = tmpI;
00069 }
00070 }
00071 else {
00072 break;
00073 }
00074 }
00075 }
00076 igap = igap / 2;
00077 }
00078
00079 return 0;
00080
00081 }
00082
00083
00084 int SortingTools::sortScalars_Vectors(int num, double *lambda, double *Q, int ldQ) const {
00085
00086
00087
00088
00089
00090
00091 int info = 0;
00092 int i, j;
00093
00094 int igap = num / 2;
00095
00096 if ((Q) && (ldQ > 0)) {
00097 double *vec = new double[ldQ];
00098 double tmp;
00099 while (igap > 0) {
00100 for (i=igap; i < num; ++i) {
00101 for (j=i-igap; j>=0; j-=igap) {
00102 if (lambda[j] > lambda[j+igap]) {
00103 tmp = lambda[j];
00104 lambda[j] = lambda[j+igap];
00105 lambda[j+igap] = tmp;
00107 memcpy(vec, Q + j*ldQ, ldQ*sizeof(double));
00108 memcpy(Q + j*ldQ, Q + (j+igap)*ldQ, ldQ*sizeof(double));
00109 memcpy(Q + (j+igap)*ldQ, vec, ldQ*sizeof(double));
00110 }
00111 else {
00112 break;
00113 }
00114 }
00115 }
00116 igap = igap / 2;
00117 }
00118 delete[] vec;
00119 }
00120 else {
00121 while (igap > 0) {
00122 for (i=igap; i < num; ++i) {
00123 for (j=i-igap; j>=0; j-=igap) {
00124 if (lambda[j] > lambda[j+igap]) {
00125
00126 double tmp = lambda[j];
00127 lambda[j] = lambda[j+igap];
00128 lambda[j+igap] = tmp;
00129 }
00130 else {
00131 break;
00132 }
00133 }
00134 }
00135 igap = igap / 2;
00136 }
00137 }
00138
00139 return info;
00140
00141 }
00142
00143