Debian Codegraph @

Modules/ThirdParty/VNL/src/vxl/v3p/netlib/lapack/double/dlagv2.f

raw
1 SUBROUTINE DLAGV2( A, LDA, B, LDB, ALPHAR, ALPHAI, BETA, CSL, SNL,
2 $ CSR, SNR )
3 *
4 * -- LAPACK auxiliary routine (version 3.0) --
5 * Univ. of Tennessee, Univ. of California Berkeley, NAG Ltd.,
6 * Courant Institute, Argonne National Lab, and Rice University
7 * June 30, 1999
8 *
9 * .. Scalar Arguments ..
10 INTEGER LDA, LDB
11 DOUBLE PRECISION CSL, CSR, SNL, SNR
12 * ..
13 * .. Array Arguments ..
14 DOUBLE PRECISION A( LDA, * ), ALPHAI( 2 ), ALPHAR( 2 ),
15 $ B( LDB, * ), BETA( 2 )
16 * ..
17 *
18 * Purpose
19 * =======
20 *
21 * DLAGV2 computes the Generalized Schur factorization of a real 2-by-2
22 * matrix pencil (A,B) where B is upper triangular. This routine
23 * computes orthogonal (rotation) matrices given by CSL, SNL and CSR,
24 * SNR such that
25 *
26 * 1) if the pencil (A,B) has two real eigenvalues (include 0/0 or 1/0
27 * types), then
28 *
29 * [ a11 a12 ] := [ CSL SNL ] [ a11 a12 ] [ CSR -SNR ]
30 * [ 0 a22 ] [ -SNL CSL ] [ a21 a22 ] [ SNR CSR ]
31 *
32 * [ b11 b12 ] := [ CSL SNL ] [ b11 b12 ] [ CSR -SNR ]
33 * [ 0 b22 ] [ -SNL CSL ] [ 0 b22 ] [ SNR CSR ],
34 *
35 * 2) if the pencil (A,B) has a pair of complex conjugate eigenvalues,
36 * then
37 *
38 * [ a11 a12 ] := [ CSL SNL ] [ a11 a12 ] [ CSR -SNR ]
39 * [ a21 a22 ] [ -SNL CSL ] [ a21 a22 ] [ SNR CSR ]
40 *
41 * [ b11 0 ] := [ CSL SNL ] [ b11 b12 ] [ CSR -SNR ]
42 * [ 0 b22 ] [ -SNL CSL ] [ 0 b22 ] [ SNR CSR ]
43 *
44 * where b11 >= b22 > 0.
45 *
46 *
47 * Arguments
48 * =========
49 *
50 * A (input/output) DOUBLE PRECISION array, dimension (LDA, 2)
51 * On entry, the 2 x 2 matrix A.
52 * On exit, A is overwritten by the ``A-part'' of the
53 * generalized Schur form.
54 *
55 * LDA (input) INTEGER
56 * THe leading dimension of the array A. LDA >= 2.
57 *
58 * B (input/output) DOUBLE PRECISION array, dimension (LDB, 2)
59 * On entry, the upper triangular 2 x 2 matrix B.
60 * On exit, B is overwritten by the ``B-part'' of the
61 * generalized Schur form.
62 *
63 * LDB (input) INTEGER
64 * THe leading dimension of the array B. LDB >= 2.
65 *
66 * ALPHAR (output) DOUBLE PRECISION array, dimension (2)
67 * ALPHAI (output) DOUBLE PRECISION array, dimension (2)
68 * BETA (output) DOUBLE PRECISION array, dimension (2)
69 * (ALPHAR(k)+i*ALPHAI(k))/BETA(k) are the eigenvalues of the
70 * pencil (A,B), k=1,2, i = sqrt(-1). Note that BETA(k) may
71 * be zero.
72 *
73 * CSL (output) DOUBLE PRECISION
74 * The cosine of the left rotation matrix.
75 *
76 * SNL (output) DOUBLE PRECISION
77 * The sine of the left rotation matrix.
78 *
79 * CSR (output) DOUBLE PRECISION
80 * The cosine of the right rotation matrix.
81 *
82 * SNR (output) DOUBLE PRECISION
83 * The sine of the right rotation matrix.
84 *
85 * Further Details
86 * ===============
87 *
88 * Based on contributions by
89 * Mark Fahey, Department of Mathematics, Univ. of Kentucky, USA
90 *
91 * =====================================================================
92 *
93 * .. Parameters ..
94 DOUBLE PRECISION ZERO, ONE
95 PARAMETER ( ZERO = 0.0D+0, ONE = 1.0D+0 )
96 * ..
97 * .. Local Scalars ..
98 DOUBLE PRECISION ANORM, ASCALE, BNORM, BSCALE, H1, H2, H3, QQ,
99 $ R, RR, SAFMIN, SCALE1, SCALE2, T, ULP, WI, WR1,
100 $ WR2
101 * ..
102 * .. External Subroutines ..
103 EXTERNAL DLAG2, DLARTG, DLASV2, DROT
104 * ..
105 * .. External Functions ..
106 DOUBLE PRECISION DLAMCH, DLAPY2
107 EXTERNAL DLAMCH, DLAPY2
108 * ..
109 * .. Intrinsic Functions ..
110 INTRINSIC ABS, MAX
111 * ..
112 * .. Executable Statements ..
113 *
114 SAFMIN = DLAMCH( 'S' )
115 ULP = DLAMCH( 'P' )
116 *
117 * Scale A
118 *
119 ANORM = MAX( ABS( A( 1, 1 ) )+ABS( A( 2, 1 ) ),
120 $ ABS( A( 1, 2 ) )+ABS( A( 2, 2 ) ), SAFMIN )
121 ASCALE = ONE / ANORM
122 A( 1, 1 ) = ASCALE*A( 1, 1 )
123 A( 1, 2 ) = ASCALE*A( 1, 2 )
124 A( 2, 1 ) = ASCALE*A( 2, 1 )
125 A( 2, 2 ) = ASCALE*A( 2, 2 )
126 *
127 * Scale B
128 *
129 BNORM = MAX( ABS( B( 1, 1 ) ), ABS( B( 1, 2 ) )+ABS( B( 2, 2 ) ),
130 $ SAFMIN )
131 BSCALE = ONE / BNORM
132 B( 1, 1 ) = BSCALE*B( 1, 1 )
133 B( 1, 2 ) = BSCALE*B( 1, 2 )
134 B( 2, 2 ) = BSCALE*B( 2, 2 )
135 *
136 * Check if A can be deflated
137 *
138 IF( ABS( A( 2, 1 ) ).LE.ULP ) THEN
139 CSL = ONE
140 SNL = ZERO
141 CSR = ONE
142 SNR = ZERO
143 A( 2, 1 ) = ZERO
144 B( 2, 1 ) = ZERO
145 *
146 * Check if B is singular
147 *
148 ELSE IF( ABS( B( 1, 1 ) ).LE.ULP ) THEN
149 CALL DLARTG( A( 1, 1 ), A( 2, 1 ), CSL, SNL, R )
150 CSR = ONE
151 SNR = ZERO
152 CALL DROT( 2, A( 1, 1 ), LDA, A( 2, 1 ), LDA, CSL, SNL )
153 CALL DROT( 2, B( 1, 1 ), LDB, B( 2, 1 ), LDB, CSL, SNL )
154 A( 2, 1 ) = ZERO
155 B( 1, 1 ) = ZERO
156 B( 2, 1 ) = ZERO
157 *
158 ELSE IF( ABS( B( 2, 2 ) ).LE.ULP ) THEN
159 CALL DLARTG( A( 2, 2 ), A( 2, 1 ), CSR, SNR, T )
160 SNR = -SNR
161 CALL DROT( 2, A( 1, 1 ), 1, A( 1, 2 ), 1, CSR, SNR )
162 CALL DROT( 2, B( 1, 1 ), 1, B( 1, 2 ), 1, CSR, SNR )
163 CSL = ONE
164 SNL = ZERO
165 A( 2, 1 ) = ZERO
166 B( 2, 1 ) = ZERO
167 B( 2, 2 ) = ZERO
168 *
169 ELSE
170 *
171 * B is nonsingular, first compute the eigenvalues of (A,B)
172 *
173 CALL DLAG2( A, LDA, B, LDB, SAFMIN, SCALE1, SCALE2, WR1, WR2,
174 $ WI )
175 *
176 IF( WI.EQ.ZERO ) THEN
177 *
178 * two real eigenvalues, compute s*A-w*B
179 *
180 H1 = SCALE1*A( 1, 1 ) - WR1*B( 1, 1 )
181 H2 = SCALE1*A( 1, 2 ) - WR1*B( 1, 2 )
182 H3 = SCALE1*A( 2, 2 ) - WR1*B( 2, 2 )
183 *
184 RR = DLAPY2( H1, H2 )
185 QQ = DLAPY2( SCALE1*A( 2, 1 ), H3 )
186 *
187 IF( RR.GT.QQ ) THEN
188 *
189 * find right rotation matrix to zero 1,1 element of
190 * (sA - wB)
191 *
192 CALL DLARTG( H2, H1, CSR, SNR, T )
193 *
194 ELSE
195 *
196 * find right rotation matrix to zero 2,1 element of
197 * (sA - wB)
198 *
199 CALL DLARTG( H3, SCALE1*A( 2, 1 ), CSR, SNR, T )
200 *
201 END IF
202 *
203 SNR = -SNR
204 CALL DROT( 2, A( 1, 1 ), 1, A( 1, 2 ), 1, CSR, SNR )
205 CALL DROT( 2, B( 1, 1 ), 1, B( 1, 2 ), 1, CSR, SNR )
206 *
207 * compute inf norms of A and B
208 *
209 H1 = MAX( ABS( A( 1, 1 ) )+ABS( A( 1, 2 ) ),
210 $ ABS( A( 2, 1 ) )+ABS( A( 2, 2 ) ) )
211 H2 = MAX( ABS( B( 1, 1 ) )+ABS( B( 1, 2 ) ),
212 $ ABS( B( 2, 1 ) )+ABS( B( 2, 2 ) ) )
213 *
214 IF( ( SCALE1*H1 ).GE.ABS( WR1 )*H2 ) THEN
215 *
216 * find left rotation matrix Q to zero out B(2,1)
217 *
218 CALL DLARTG( B( 1, 1 ), B( 2, 1 ), CSL, SNL, R )
219 *
220 ELSE
221 *
222 * find left rotation matrix Q to zero out A(2,1)
223 *
224 CALL DLARTG( A( 1, 1 ), A( 2, 1 ), CSL, SNL, R )
225 *
226 END IF
227 *
228 CALL DROT( 2, A( 1, 1 ), LDA, A( 2, 1 ), LDA, CSL, SNL )
229 CALL DROT( 2, B( 1, 1 ), LDB, B( 2, 1 ), LDB, CSL, SNL )
230 *
231 A( 2, 1 ) = ZERO
232 B( 2, 1 ) = ZERO
233 *
234 ELSE
235 *
236 * a pair of complex conjugate eigenvalues
237 * first compute the SVD of the matrix B
238 *
239 CALL DLASV2( B( 1, 1 ), B( 1, 2 ), B( 2, 2 ), R, T, SNR,
240 $ CSR, SNL, CSL )
241 *
242 * Form (A,B) := Q(A,B)Z' where Q is left rotation matrix and
243 * Z is right rotation matrix computed from DLASV2
244 *
245 CALL DROT( 2, A( 1, 1 ), LDA, A( 2, 1 ), LDA, CSL, SNL )
246 CALL DROT( 2, B( 1, 1 ), LDB, B( 2, 1 ), LDB, CSL, SNL )
247 CALL DROT( 2, A( 1, 1 ), 1, A( 1, 2 ), 1, CSR, SNR )
248 CALL DROT( 2, B( 1, 1 ), 1, B( 1, 2 ), 1, CSR, SNR )
249 *
250 B( 2, 1 ) = ZERO
251 B( 1, 2 ) = ZERO
252 *
253 END IF
254 *
255 END IF
256 *
257 * Unscaling
258 *
259 A( 1, 1 ) = ANORM*A( 1, 1 )
260 A( 2, 1 ) = ANORM*A( 2, 1 )
261 A( 1, 2 ) = ANORM*A( 1, 2 )
262 A( 2, 2 ) = ANORM*A( 2, 2 )
263 B( 1, 1 ) = BNORM*B( 1, 1 )
264 B( 2, 1 ) = BNORM*B( 2, 1 )
265 B( 1, 2 ) = BNORM*B( 1, 2 )
266 B( 2, 2 ) = BNORM*B( 2, 2 )
267 *
268 IF( WI.EQ.ZERO ) THEN
269 ALPHAR( 1 ) = A( 1, 1 )
270 ALPHAR( 2 ) = A( 2, 2 )
271 ALPHAI( 1 ) = ZERO
272 ALPHAI( 2 ) = ZERO
273 BETA( 1 ) = B( 1, 1 )
274 BETA( 2 ) = B( 2, 2 )
275 ELSE
276 ALPHAR( 1 ) = ANORM*WR1 / SCALE1 / BNORM
277 ALPHAI( 1 ) = ANORM*WI / SCALE1 / BNORM
278 ALPHAR( 2 ) = ALPHAR( 1 )
279 ALPHAI( 2 ) = -ALPHAI( 1 )
280 BETA( 1 ) = ONE
281 BETA( 2 ) = ONE
282 END IF
283 *
284 10 CONTINUE
285 *
286 RETURN
287 *
288 * End of DLAGV2
289 *
290 END