00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013 #include "f2c.h"
00014 #include "blaswrap.h"
00015
00016 int clargv_(integer *n, complex *x, integer *incx, complex *
00017 y, integer *incy, real *c__, integer *incc)
00018 {
00019
00020 integer i__1, i__2;
00021 real r__1, r__2, r__3, r__4, r__5, r__6, r__7, r__8, r__9, r__10;
00022 complex q__1, q__2, q__3;
00023
00024
00025 double log(doublereal), pow_ri(real *, integer *), r_imag(complex *),
00026 sqrt(doublereal);
00027 void r_cnjg(complex *, complex *);
00028
00029
00030 real d__;
00031 complex f, g;
00032 integer i__, j;
00033 complex r__;
00034 real f2, g2;
00035 integer ic;
00036 real di;
00037 complex ff;
00038 real cs, dr;
00039 complex fs, gs;
00040 integer ix, iy;
00041 complex sn;
00042 real f2s, g2s, eps, scale;
00043 integer count;
00044 real safmn2, safmx2;
00045 extern doublereal slapy2_(real *, real *), slamch_(char *);
00046 real safmin;
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088
00089
00090
00091
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105
00106
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131
00132
00133
00134
00135 --c__;
00136 --y;
00137 --x;
00138
00139
00140 safmin = slamch_("S");
00141 eps = slamch_("E");
00142 r__1 = slamch_("B");
00143 i__1 = (integer) (log(safmin / eps) / log(slamch_("B")) / 2.f);
00144 safmn2 = pow_ri(&r__1, &i__1);
00145 safmx2 = 1.f / safmn2;
00146
00147 ix = 1;
00148 iy = 1;
00149 ic = 1;
00150 i__1 = *n;
00151 for (i__ = 1; i__ <= i__1; ++i__) {
00152 i__2 = ix;
00153 f.r = x[i__2].r, f.i = x[i__2].i;
00154 i__2 = iy;
00155 g.r = y[i__2].r, g.i = y[i__2].i;
00156
00157
00158
00159
00160
00161 r__7 = (r__1 = f.r, dabs(r__1)), r__8 = (r__2 = r_imag(&f), dabs(r__2)
00162 );
00163
00164 r__9 = (r__3 = g.r, dabs(r__3)), r__10 = (r__4 = r_imag(&g), dabs(
00165 r__4));
00166 r__5 = dmax(r__7,r__8), r__6 = dmax(r__9,r__10);
00167 scale = dmax(r__5,r__6);
00168 fs.r = f.r, fs.i = f.i;
00169 gs.r = g.r, gs.i = g.i;
00170 count = 0;
00171 if (scale >= safmx2) {
00172 L10:
00173 ++count;
00174 q__1.r = safmn2 * fs.r, q__1.i = safmn2 * fs.i;
00175 fs.r = q__1.r, fs.i = q__1.i;
00176 q__1.r = safmn2 * gs.r, q__1.i = safmn2 * gs.i;
00177 gs.r = q__1.r, gs.i = q__1.i;
00178 scale *= safmn2;
00179 if (scale >= safmx2) {
00180 goto L10;
00181 }
00182 } else if (scale <= safmn2) {
00183 if (g.r == 0.f && g.i == 0.f) {
00184 cs = 1.f;
00185 sn.r = 0.f, sn.i = 0.f;
00186 r__.r = f.r, r__.i = f.i;
00187 goto L50;
00188 }
00189 L20:
00190 --count;
00191 q__1.r = safmx2 * fs.r, q__1.i = safmx2 * fs.i;
00192 fs.r = q__1.r, fs.i = q__1.i;
00193 q__1.r = safmx2 * gs.r, q__1.i = safmx2 * gs.i;
00194 gs.r = q__1.r, gs.i = q__1.i;
00195 scale *= safmx2;
00196 if (scale <= safmn2) {
00197 goto L20;
00198 }
00199 }
00200
00201 r__1 = fs.r;
00202
00203 r__2 = r_imag(&fs);
00204 f2 = r__1 * r__1 + r__2 * r__2;
00205
00206 r__1 = gs.r;
00207
00208 r__2 = r_imag(&gs);
00209 g2 = r__1 * r__1 + r__2 * r__2;
00210 if (f2 <= dmax(g2,1.f) * safmin) {
00211
00212
00213
00214 if (f.r == 0.f && f.i == 0.f) {
00215 cs = 0.f;
00216 r__2 = g.r;
00217 r__3 = r_imag(&g);
00218 r__1 = slapy2_(&r__2, &r__3);
00219 r__.r = r__1, r__.i = 0.f;
00220
00221
00222 r__1 = gs.r;
00223 r__2 = r_imag(&gs);
00224 d__ = slapy2_(&r__1, &r__2);
00225 r__1 = gs.r / d__;
00226 r__2 = -r_imag(&gs) / d__;
00227 q__1.r = r__1, q__1.i = r__2;
00228 sn.r = q__1.r, sn.i = q__1.i;
00229 goto L50;
00230 }
00231 r__1 = fs.r;
00232 r__2 = r_imag(&fs);
00233 f2s = slapy2_(&r__1, &r__2);
00234
00235
00236 g2s = sqrt(g2);
00237
00238
00239
00240
00241
00242
00243
00244 cs = f2s / g2s;
00245
00246
00247
00248 r__3 = (r__1 = f.r, dabs(r__1)), r__4 = (r__2 = r_imag(&f), dabs(
00249 r__2));
00250 if (dmax(r__3,r__4) > 1.f) {
00251 r__1 = f.r;
00252 r__2 = r_imag(&f);
00253 d__ = slapy2_(&r__1, &r__2);
00254 r__1 = f.r / d__;
00255 r__2 = r_imag(&f) / d__;
00256 q__1.r = r__1, q__1.i = r__2;
00257 ff.r = q__1.r, ff.i = q__1.i;
00258 } else {
00259 dr = safmx2 * f.r;
00260 di = safmx2 * r_imag(&f);
00261 d__ = slapy2_(&dr, &di);
00262 r__1 = dr / d__;
00263 r__2 = di / d__;
00264 q__1.r = r__1, q__1.i = r__2;
00265 ff.r = q__1.r, ff.i = q__1.i;
00266 }
00267 r__1 = gs.r / g2s;
00268 r__2 = -r_imag(&gs) / g2s;
00269 q__2.r = r__1, q__2.i = r__2;
00270 q__1.r = ff.r * q__2.r - ff.i * q__2.i, q__1.i = ff.r * q__2.i +
00271 ff.i * q__2.r;
00272 sn.r = q__1.r, sn.i = q__1.i;
00273 q__2.r = cs * f.r, q__2.i = cs * f.i;
00274 q__3.r = sn.r * g.r - sn.i * g.i, q__3.i = sn.r * g.i + sn.i *
00275 g.r;
00276 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00277 r__.r = q__1.r, r__.i = q__1.i;
00278 } else {
00279
00280
00281
00282
00283
00284 f2s = sqrt(g2 / f2 + 1.f);
00285
00286
00287 r__1 = f2s * fs.r;
00288 r__2 = f2s * r_imag(&fs);
00289 q__1.r = r__1, q__1.i = r__2;
00290 r__.r = q__1.r, r__.i = q__1.i;
00291 cs = 1.f / f2s;
00292 d__ = f2 + g2;
00293
00294 r__1 = r__.r / d__;
00295 r__2 = r_imag(&r__) / d__;
00296 q__1.r = r__1, q__1.i = r__2;
00297 sn.r = q__1.r, sn.i = q__1.i;
00298 r_cnjg(&q__2, &gs);
00299 q__1.r = sn.r * q__2.r - sn.i * q__2.i, q__1.i = sn.r * q__2.i +
00300 sn.i * q__2.r;
00301 sn.r = q__1.r, sn.i = q__1.i;
00302 if (count != 0) {
00303 if (count > 0) {
00304 i__2 = count;
00305 for (j = 1; j <= i__2; ++j) {
00306 q__1.r = safmx2 * r__.r, q__1.i = safmx2 * r__.i;
00307 r__.r = q__1.r, r__.i = q__1.i;
00308
00309 }
00310 } else {
00311 i__2 = -count;
00312 for (j = 1; j <= i__2; ++j) {
00313 q__1.r = safmn2 * r__.r, q__1.i = safmn2 * r__.i;
00314 r__.r = q__1.r, r__.i = q__1.i;
00315
00316 }
00317 }
00318 }
00319 }
00320 L50:
00321 c__[ic] = cs;
00322 i__2 = iy;
00323 y[i__2].r = sn.r, y[i__2].i = sn.i;
00324 i__2 = ix;
00325 x[i__2].r = r__.r, x[i__2].i = r__.i;
00326 ic += *incc;
00327 iy += *incy;
00328 ix += *incx;
00329
00330 }
00331 return 0;
00332
00333
00334
00335 }