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
00030
00031
00032
00033
00034
00035 #ifndef TEMPLATE_LAPACK_LARTG_HEADER
00036 #define TEMPLATE_LAPACK_LARTG_HEADER
00037
00038
00039 template<class Treal>
00040 int template_lapack_lartg(const Treal *f, const Treal *g, Treal *cs,
00041 Treal *sn, Treal *r__)
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 logical first = TRUE_;
00088
00089 integer i__1;
00090 Treal d__1, d__2;
00091
00092 integer i__;
00093 Treal scale;
00094 integer count;
00095 Treal f1, g1, safmn2, safmx2;
00096 Treal safmin, eps;
00097
00098
00099
00100 if (first) {
00101 first = FALSE_;
00102 safmin = template_lapack_lamch("S", (Treal)0);
00103 eps = template_lapack_lamch("E", (Treal)0);
00104 d__1 = template_lapack_lamch("B", (Treal)0);
00105 i__1 = (integer) (template_blas_log(safmin / eps) / template_blas_log(template_lapack_lamch("B", (Treal)0)) /
00106 2.);
00107 safmn2 = template_lapack_pow_di(&d__1, &i__1);
00108 safmx2 = 1. / safmn2;
00109 }
00110 if (*g == 0.) {
00111 *cs = 1.;
00112 *sn = 0.;
00113 *r__ = *f;
00114 } else if (*f == 0.) {
00115 *cs = 0.;
00116 *sn = 1.;
00117 *r__ = *g;
00118 } else {
00119 f1 = *f;
00120 g1 = *g;
00121
00122 d__1 = absMACRO(f1), d__2 = absMACRO(g1);
00123 scale = maxMACRO(d__1,d__2);
00124 if (scale >= safmx2) {
00125 count = 0;
00126 L10:
00127 ++count;
00128 f1 *= safmn2;
00129 g1 *= safmn2;
00130
00131 d__1 = absMACRO(f1), d__2 = absMACRO(g1);
00132 scale = maxMACRO(d__1,d__2);
00133 if (scale >= safmx2) {
00134 goto L10;
00135 }
00136
00137 d__1 = f1;
00138
00139 d__2 = g1;
00140 *r__ = template_blas_sqrt(d__1 * d__1 + d__2 * d__2);
00141 *cs = f1 / *r__;
00142 *sn = g1 / *r__;
00143 i__1 = count;
00144 for (i__ = 1; i__ <= i__1; ++i__) {
00145 *r__ *= safmx2;
00146
00147 }
00148 } else if (scale <= safmn2) {
00149 count = 0;
00150 L30:
00151 ++count;
00152 f1 *= safmx2;
00153 g1 *= safmx2;
00154
00155 d__1 = absMACRO(f1), d__2 = absMACRO(g1);
00156 scale = maxMACRO(d__1,d__2);
00157 if (scale <= safmn2) {
00158 goto L30;
00159 }
00160
00161 d__1 = f1;
00162
00163 d__2 = g1;
00164 *r__ = template_blas_sqrt(d__1 * d__1 + d__2 * d__2);
00165 *cs = f1 / *r__;
00166 *sn = g1 / *r__;
00167 i__1 = count;
00168 for (i__ = 1; i__ <= i__1; ++i__) {
00169 *r__ *= safmn2;
00170
00171 }
00172 } else {
00173
00174 d__1 = f1;
00175
00176 d__2 = g1;
00177 *r__ = template_blas_sqrt(d__1 * d__1 + d__2 * d__2);
00178 *cs = f1 / *r__;
00179 *sn = g1 / *r__;
00180 }
00181 if (absMACRO(*f) > absMACRO(*g) && *cs < 0.) {
00182 *cs = -(*cs);
00183 *sn = -(*sn);
00184 *r__ = -(*r__);
00185 }
00186 }
00187 return 0;
00188
00189
00190
00191 }
00192
00193 #endif