0
|
1 |
#======================================================================
|
|
2 |
# S V D C M P . P L
|
|
3 |
# doc: Sun Aug 1 09:51:37 1999
|
17
|
4 |
# dlm: Wed Mar 11 16:54:26 2015
|
0
|
5 |
# (c) 1999 A.M. Thurnherr
|
17
|
6 |
# uE-Info: 188 1 NIL 0 0 72 10 2 4 NIL ofnI
|
0
|
7 |
#======================================================================
|
|
8 |
|
|
9 |
# SVDCMP routine from Numerical Recipes adapted to ANTS
|
|
10 |
|
|
11 |
# HISTORY:
|
|
12 |
# Aug 01, 1999: - manually converted from c-source
|
17
|
13 |
# Jul 19, 2001: - done *something* (message only?)
|
|
14 |
# Mar 11, 2015: - picked up this never-used code because of need to fit circles
|
|
15 |
|
0
|
16 |
|
|
17 |
# Notes:
|
|
18 |
# - everything passed as refs
|
|
19 |
|
|
20 |
require "$ANTS/nrutil.pl";
|
|
21 |
require "$ANTS/pythag.pl";
|
|
22 |
|
17
|
23 |
use strict;
|
|
24 |
|
0
|
25 |
sub svdcmp($$$)
|
17
|
26 |
{
|
0
|
27 |
my($aR,$wR,$vR) = @_; # params
|
|
28 |
my($flag,$i,$its,$j,$jj,$k,$l,$nm); # int
|
|
29 |
my($anorm,$c,$f,$g,$h,$s,$scale,$x,$y,$z); # float
|
|
30 |
my(@rv1); # float[]
|
|
31 |
|
|
32 |
vector(\@rv1,1,$#{$vR});
|
17
|
33 |
$g = $scale = $anorm = 0;
|
0
|
34 |
for ($i=1; $i<=$#{$vR}; $i++) {
|
|
35 |
$l = $i+1;
|
|
36 |
$rv1[$i] = $scale*$g;
|
17
|
37 |
$g = $s = $scale = 0;
|
0
|
38 |
if ($i <= $#{$aR}) {
|
|
39 |
for ($k=$i; $k<=$#{$aR}; $k++) {
|
|
40 |
$scale += abs($aR->[$k][$i]);
|
|
41 |
}
|
|
42 |
if ($scale) {
|
|
43 |
for ($k=$i; $k<=$#{$aR}; $k++) {
|
|
44 |
$aR->[$k][$i] /= $scale;
|
|
45 |
$s += $aR->[$k][$i]*$aR->[$k][$i];
|
|
46 |
}
|
|
47 |
$f = $aR->[$i][$i];
|
|
48 |
$g = -&SIGN(sqrt($s),$f);
|
|
49 |
$h = $f*$g-$s;
|
|
50 |
$aR->[$i][$i] = $f-$g;
|
|
51 |
for ($j=$l; $j<=$#{$vR}; $j++) {
|
|
52 |
for ($s=0,$k=$i; $k<=$#{$aR}; $k++) {
|
|
53 |
$s += $aR->[$k][$i]*$aR->[$k][$j];
|
|
54 |
}
|
|
55 |
$f = $s/$h;
|
|
56 |
for ($k=$i; $k<=$#{$aR}; $k++) {
|
|
57 |
$aR->[$k][$j] += $f*$aR->[$k][$i];
|
|
58 |
}
|
|
59 |
}
|
|
60 |
for ($k=$i; $k<=$#{$aR}; $k++) {
|
|
61 |
$aR->[$k][$i] *= $scale;
|
|
62 |
}
|
|
63 |
}
|
|
64 |
}
|
|
65 |
$wR->[$i] = $scale * $g;
|
|
66 |
$g = 0; $s = 0; $scale = 0;
|
|
67 |
if ($i <= $#{$aR} && $i != $#{$vR}) {
|
|
68 |
for ($k=$l; $k<=$#{$vR}; $k++) {
|
|
69 |
$scale += abs($aR->[$i][$k]);
|
|
70 |
}
|
|
71 |
if ($scale) {
|
|
72 |
for ($k=$l; $k<=$#{$vR}; $k++) {
|
|
73 |
$aR->[$i][$k] /= $scale;
|
|
74 |
$s += $aR->[$i][$k]*$aR->[$i][$k];
|
|
75 |
}
|
|
76 |
$f = $aR->[$i][$l];
|
|
77 |
$g = -&SIGN(sqrt($s),$f);
|
|
78 |
$h = $f*$g-$s;
|
|
79 |
$aR->[$i][$l] = $f-$g;
|
|
80 |
for ($k=$l; $k<=$#{$vR}; $k++) {
|
|
81 |
$rv1[$k] = $aR->[$i][$k]/$h;
|
|
82 |
}
|
|
83 |
for ($j=$l; $j<=$#{$aR}; $j++) {
|
|
84 |
for ($s=0,$k=$l; $k<=$#{$vR}; $k++) {
|
|
85 |
$s += $aR->[$j][$k]*$aR->[$i][$k];
|
|
86 |
}
|
|
87 |
for ($k=$l; $k<=$#{$vR}; $k++) {
|
|
88 |
$aR->[$j][$k] += $s*$rv1[$k];
|
|
89 |
}
|
|
90 |
}
|
|
91 |
for ($k=$l; $k<=$#{$vR}; $k++) {
|
|
92 |
$aR->[$i][$k] *= $scale;
|
|
93 |
}
|
|
94 |
}
|
|
95 |
}
|
17
|
96 |
$anorm = MAX($anorm,(abs($wR->[$i])+abs($rv1[$i])));
|
0
|
97 |
}
|
|
98 |
for ($i=$#{$vR}; $i>=1; $i--) {
|
|
99 |
if ($i < $#{$vR}) {
|
|
100 |
if ($g) {
|
|
101 |
for ($j=$l; $j<=$#{$vR}; $j++) {
|
|
102 |
$vR->[$j][$i] = ($aR->[$i][$j]/$aR->[$i][$l])/$g;
|
|
103 |
}
|
|
104 |
for ($j=$l; $j<=$#{$vR}; $j++) {
|
|
105 |
for ($s=0,$k=$l; $k<=$#{$vR}; $k++) {
|
|
106 |
$s += $aR->[$i][$k]*$vR->[$k][$j];
|
|
107 |
}
|
|
108 |
for ($k=$l; $k<=$#{$vR}; $k++) {
|
|
109 |
$vR->[$k][$j] += $s*$vR->[$k][$i];
|
|
110 |
}
|
|
111 |
}
|
|
112 |
}
|
17
|
113 |
for ($j=$l; $j<=$#{$vR}; $j++) {
|
0
|
114 |
$vR->[$i][$j] = 0; $vR->[$j][$i] = 0;
|
|
115 |
}
|
|
116 |
}
|
|
117 |
$vR->[$i][$i] = 1;
|
|
118 |
$g = $rv1[$i];
|
|
119 |
$l = $i;
|
|
120 |
}
|
17
|
121 |
for ($i=MIN($#{$aR},$#{$vR}); $i>=1; $i--) {
|
0
|
122 |
$l = $i+1;
|
|
123 |
$g = $wR->[$i];
|
|
124 |
for ($j=$l; $j<=$#{$vR}; $j++) {
|
|
125 |
$aR->[$i][$j] = 0;
|
|
126 |
}
|
|
127 |
if ($g) {
|
|
128 |
$g = 1/$g;
|
|
129 |
for ($j=$l; $j<=$#{$vR}; $j++) {
|
|
130 |
for ($s=0,$k=$l; $k<=$#{$aR}; $k++) {
|
|
131 |
$s += $aR->[$k][$i]*$aR->[$k][$j];
|
|
132 |
}
|
|
133 |
$f = ($s/$aR->[$i][$i])*$g;
|
|
134 |
for ($k=$i; $k<=$#{$aR}; $k++) {
|
|
135 |
$aR->[$k][$j] += $f*$aR->[$k][$i];
|
|
136 |
}
|
|
137 |
}
|
|
138 |
for ($j=$i; $j<=$#{$aR}; $j++) {
|
|
139 |
$aR->[$j][$i] *= $g;
|
|
140 |
}
|
|
141 |
} else {
|
|
142 |
for ($j=$i; $j<=$#{$aR}; $j++) {
|
|
143 |
$aR->[$j][$i] = 0;
|
|
144 |
}
|
|
145 |
}
|
|
146 |
++$aR->[$i][$i];
|
|
147 |
}
|
|
148 |
for ($k=$#{$vR}; $k>=1; $k--) {
|
|
149 |
for ($its=1; $its<=30; $its++) {
|
|
150 |
$flag = 1;
|
|
151 |
for ($l=$k; $l>=1; $l--) {
|
|
152 |
$nm = $l-1;
|
|
153 |
if ((abs($rv1[$l])+$anorm) == $anorm) {
|
|
154 |
$flag = 0;
|
17
|
155 |
last;
|
0
|
156 |
}
|
17
|
157 |
last if ($nm == 0) || ((abs($wR->[$nm])+$anorm) == $anorm); ## $nm == 0 test not in original code
|
0
|
158 |
}
|
|
159 |
if ($flag) {
|
|
160 |
$c = 0;
|
|
161 |
$s = 1;
|
|
162 |
for ($i=$l; $i<=$k; $i++) {
|
|
163 |
$f = $s*$rv1[$i];
|
|
164 |
$rv1[$i] = $c*$rv1[$i];
|
17
|
165 |
last if ((abs($f)+$anorm) == $anorm);
|
0
|
166 |
$g = $wR->[$i];
|
|
167 |
$h = &pythag($f,$g);
|
|
168 |
$wR->[$i] = $h;
|
|
169 |
$h = 1/$h;
|
|
170 |
$c = $g*$h;
|
|
171 |
$s = -$f*$h;
|
|
172 |
for ($j=1; $j<=$#{$aR}; $j++) {
|
|
173 |
$y = $aR->[$j][$nm];
|
|
174 |
$z = $aR->[$j][$i];
|
|
175 |
$aR->[$j][$nm] = $y*$c+$z*$s;
|
|
176 |
$aR->[$j][$i] = $z*$c-$y*$s;
|
|
177 |
}
|
|
178 |
}
|
|
179 |
}
|
|
180 |
$z = $wR->[$k];
|
|
181 |
if ($l == $k) {
|
|
182 |
if ($z < 0) {
|
|
183 |
$wR->[$k] = -$z;
|
|
184 |
for ($j=1; $j<=$#{$vR}; $j++) {
|
|
185 |
$vR->[$j][$k] = -$vR->[$j][$k];
|
|
186 |
}
|
|
187 |
}
|
17
|
188 |
# print(STDERR "its($k) = $its\n");
|
|
189 |
last;
|
0
|
190 |
}
|
|
191 |
croak("no convergence in 30 svdcmp iterations\n") if ($its == 30);
|
|
192 |
$x = $wR->[$l];
|
|
193 |
$nm = $k-1;
|
|
194 |
$y = $wR->[$nm];
|
|
195 |
$g = $rv1[$nm];
|
|
196 |
$h = $rv1[$k];
|
|
197 |
$f = (($y-$z)*($y+$z)+($g-$h)*($g+$h))/(2.0*$h*$y);
|
|
198 |
$g = &pythag($f,1);
|
|
199 |
$f = (($x-$z)*($x+$z)+$h*(($y/($f+&SIGN($g,$f)))-$h))/$x;
|
|
200 |
$c = 1; $s = 1;
|
|
201 |
for ($j=$l; $j<=$nm; $j++) {
|
|
202 |
$i = $j+1;
|
|
203 |
$g = $rv1[$i];
|
|
204 |
$y = $wR->[$i];
|
|
205 |
$h = $s*$g;
|
|
206 |
$g = $c*$g;
|
|
207 |
$z = &pythag($f,$h);
|
|
208 |
$rv1[$j] = $z;
|
|
209 |
$c = $f/$z;
|
|
210 |
$s = $h/$z;
|
|
211 |
$f = $x*$c+$g*$s;
|
|
212 |
$g = $g*$c-$x*$s;
|
|
213 |
$h = $y*$s;
|
|
214 |
$y *= $c;
|
|
215 |
for ($jj=1; $jj<=$#{$vR}; $jj++) {
|
|
216 |
$x = $vR->[$jj][$j];
|
|
217 |
$z = $vR->[$jj][$i];
|
|
218 |
$vR->[$jj][$j] = $x*$c+$z*$s;
|
|
219 |
$vR->[$jj][$i] = $z*$c-$x*$s;
|
|
220 |
}
|
|
221 |
$z = &pythag($f,$h);
|
|
222 |
$wR->[$j] = $z;
|
|
223 |
if ($z) {
|
|
224 |
$z = 1/$z;
|
|
225 |
$c = $f*$z;
|
|
226 |
$s = $h*$z;
|
|
227 |
}
|
|
228 |
$f = $c*$g+$s*$y;
|
|
229 |
$x = $c*$y-$s*$g;
|
|
230 |
for ($jj=1; $jj<=$#{$aR}; $jj++) {
|
|
231 |
$y = $aR->[$jj][$j];
|
|
232 |
$z = $aR->[$jj][$i];
|
|
233 |
$aR->[$jj][$j] = $y*$c+$z*$s;
|
|
234 |
$aR->[$jj][$i] = $z*$c-$y*$s;
|
|
235 |
}
|
|
236 |
}
|
|
237 |
$rv1[$l] = 0;
|
|
238 |
$rv1[$k] = $f;
|
|
239 |
$wR->[$k] = $x;
|
|
240 |
}
|
|
241 |
}
|
|
242 |
}
|
|
243 |
|
|
244 |
|