12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fixed a bug

release/4.3a0
Manohar Paluri 2010-02-21 04:51:42 +00:00
parent 274265a401
commit 7f1c3f9952
1 changed files with 6 additions and 25 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

31
cpp/svdcmp.cpp
View File

@ -264,39 +264,20 @@ void svdcmp(double **a, int m, int n, double w[], double **v, bool sort) {
} }
if (sort) { if (sort) {
int *indices1 = new int[n+1];
int *indices2 = new int[n+1];
for (int i1 = 1; i1 <= n; i1++) { for (int i1 = 1; i1 <= n; i1++) {
indices1[i1] = i1; for (int i2 = i1+1; i2 <= n; i2++) {
indices2[i1] = i1;
}
for (int i1 = 1; i1 <= n; i1++) {
for (int i2 = i1; i2 <= n; i2++) {
if (w[i1] < w[i2]) { if (w[i1] < w[i2]) {
double temp = w[i1]; double temp = w[i1];
w[i1] = w[i2]; w[i1] = w[i2];
w[i2] = temp; w[i2] = temp;
int ind = indices2[i1];
indices2[i1] = indices2[i2];
indices2[i2] = ind;
}
}
}
for (int i1 = 1; i1 <= n; i1++) {
if (indices1[i1] != indices2[i1]) {
int src = indices1[i1], dst = indices2[i1];
for (int j = 1; j <= n; j++) { for (int j = 1; j <= n; j++) {
double temp = v[j][src]; double temp1 = v[j][i1];
v[j][src] = v[j][dst]; v[j][i1] = v[j][i2];
v[j][dst] = temp; v[j][i2] = temp1;
} }
indices1[dst] = src; }
} }
} }
delete[] indices1;
delete[] indices2;
} }
delete[] rv1; delete[] rv1;