00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013 #include "f2c.h"
00014 #include "blaswrap.h"
00015
00016
00017
00018 static doublereal c_b4 = 1.;
00019
00020 int dlanv2_(doublereal *a, doublereal *b, doublereal *c__,
00021 doublereal *d__, doublereal *rt1r, doublereal *rt1i, doublereal *rt2r,
00022 doublereal *rt2i, doublereal *cs, doublereal *sn)
00023 {
00024
00025 doublereal d__1, d__2;
00026
00027
00028 double d_sign(doublereal *, doublereal *), sqrt(doublereal);
00029
00030
00031 doublereal p, z__, aa, bb, cc, dd, cs1, sn1, sab, sac, eps, tau, temp,
00032 scale, bcmax, bcmis, sigma;
00033 extern doublereal dlapy2_(doublereal *, doublereal *), dlamch_(char *);
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
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 eps = dlamch_("P");
00100 if (*c__ == 0.) {
00101 *cs = 1.;
00102 *sn = 0.;
00103 goto L10;
00104
00105 } else if (*b == 0.) {
00106
00107
00108
00109 *cs = 0.;
00110 *sn = 1.;
00111 temp = *d__;
00112 *d__ = *a;
00113 *a = temp;
00114 *b = -(*c__);
00115 *c__ = 0.;
00116 goto L10;
00117 } else if (*a - *d__ == 0. && d_sign(&c_b4, b) != d_sign(&c_b4, c__)) {
00118 *cs = 1.;
00119 *sn = 0.;
00120 goto L10;
00121 } else {
00122
00123 temp = *a - *d__;
00124 p = temp * .5;
00125
00126 d__1 = abs(*b), d__2 = abs(*c__);
00127 bcmax = max(d__1,d__2);
00128
00129 d__1 = abs(*b), d__2 = abs(*c__);
00130 bcmis = min(d__1,d__2) * d_sign(&c_b4, b) * d_sign(&c_b4, c__);
00131
00132 d__1 = abs(p);
00133 scale = max(d__1,bcmax);
00134 z__ = p / scale * p + bcmax / scale * bcmis;
00135
00136
00137
00138
00139 if (z__ >= eps * 4.) {
00140
00141
00142
00143 d__1 = sqrt(scale) * sqrt(z__);
00144 z__ = p + d_sign(&d__1, &p);
00145 *a = *d__ + z__;
00146 *d__ -= bcmax / z__ * bcmis;
00147
00148
00149
00150 tau = dlapy2_(c__, &z__);
00151 *cs = z__ / tau;
00152 *sn = *c__ / tau;
00153 *b -= *c__;
00154 *c__ = 0.;
00155 } else {
00156
00157
00158
00159
00160 sigma = *b + *c__;
00161 tau = dlapy2_(&sigma, &temp);
00162 *cs = sqrt((abs(sigma) / tau + 1.) * .5);
00163 *sn = -(p / (tau * *cs)) * d_sign(&c_b4, &sigma);
00164
00165
00166
00167
00168 aa = *a * *cs + *b * *sn;
00169 bb = -(*a) * *sn + *b * *cs;
00170 cc = *c__ * *cs + *d__ * *sn;
00171 dd = -(*c__) * *sn + *d__ * *cs;
00172
00173
00174
00175
00176 *a = aa * *cs + cc * *sn;
00177 *b = bb * *cs + dd * *sn;
00178 *c__ = -aa * *sn + cc * *cs;
00179 *d__ = -bb * *sn + dd * *cs;
00180
00181 temp = (*a + *d__) * .5;
00182 *a = temp;
00183 *d__ = temp;
00184
00185 if (*c__ != 0.) {
00186 if (*b != 0.) {
00187 if (d_sign(&c_b4, b) == d_sign(&c_b4, c__)) {
00188
00189
00190
00191 sab = sqrt((abs(*b)));
00192 sac = sqrt((abs(*c__)));
00193 d__1 = sab * sac;
00194 p = d_sign(&d__1, c__);
00195 tau = 1. / sqrt((d__1 = *b + *c__, abs(d__1)));
00196 *a = temp + p;
00197 *d__ = temp - p;
00198 *b -= *c__;
00199 *c__ = 0.;
00200 cs1 = sab * tau;
00201 sn1 = sac * tau;
00202 temp = *cs * cs1 - *sn * sn1;
00203 *sn = *cs * sn1 + *sn * cs1;
00204 *cs = temp;
00205 }
00206 } else {
00207 *b = -(*c__);
00208 *c__ = 0.;
00209 temp = *cs;
00210 *cs = -(*sn);
00211 *sn = temp;
00212 }
00213 }
00214 }
00215
00216 }
00217
00218 L10:
00219
00220
00221
00222 *rt1r = *a;
00223 *rt2r = *d__;
00224 if (*c__ == 0.) {
00225 *rt1i = 0.;
00226 *rt2i = 0.;
00227 } else {
00228 *rt1i = sqrt((abs(*b))) * sqrt((abs(*c__)));
00229 *rt2i = -(*rt1i);
00230 }
00231 return 0;
00232
00233
00234
00235 }