* * $Id: htridi.F,v 1.1.1.1 1996/04/01 15:02:36 mclareni Exp $ * * $Log: htridi.F,v $ * Revision 1.1.1.1 1996/04/01 15:02:36 mclareni * Mathlib gen * * #include "gen/pilot.h" SUBROUTINE HTRIDI(NM,N,AR,AI,D,E,E2,TAU) INTEGER I,J,K,L,N,II,NM,JP1 REAL AR(NM,N),AI(NM,N),D(N),E(N),E2(N),TAU(2,N) REAL F,FI,G,GI,H,HH,SI,SCALE TAU(1,N) = 1.0 TAU(2,N) = 0.0 DO 100 I = 1, N 100 D(I) = AR(I,I) DO 300 II = 1, N I = N + 1 - II L = I - 1 H = 0.0 SCALE = 0.0 IF (L .LT. 1) GO TO 130 DO 120 K = 1, L 120 SCALE = SCALE + ABS(AR(I,K)) + ABS(AI(I,K)) IF (SCALE .NE. 0.0) GO TO 140 TAU(1,L) = 1.0 TAU(2,L) = 0.0 130 E(I) = 0.0 E2(I) = 0.0 GO TO 290 140 DO 150 K = 1, L AR(I,K) = AR(I,K) / SCALE AI(I,K) = AI(I,K) / SCALE H = H + AR(I,K) * AR(I,K) + AI(I,K) * AI(I,K) 150 CONTINUE E2(I) = SCALE * SCALE * H G = SQRT(H) E(I) = SCALE * G F = ABS(CMPLX(AR(I,L),AI(I,L))) IF (F .EQ. 0.0) GO TO 160 TAU(1,L) = (AI(I,L) * TAU(2,I) - AR(I,L) * TAU(1,I)) / F SI = (AR(I,L) * TAU(2,I) + AI(I,L) * TAU(1,I)) / F H = H + F * G G = 1.0 + G / F AR(I,L) = G * AR(I,L) AI(I,L) = G * AI(I,L) IF (L .EQ. 1) GO TO 270 GO TO 170 160 TAU(1,L) = -TAU(1,I) SI = TAU(2,I) AR(I,L) = G 170 F = 0.0 DO 240 J = 1, L G = 0.0 GI = 0.0 DO 180 K = 1, J G = G + AR(J,K) * AR(I,K) + AI(J,K) * AI(I,K) GI = GI - AR(J,K) * AI(I,K) + AI(J,K) * AR(I,K) 180 CONTINUE JP1 = J + 1 IF (L .LT. JP1) GO TO 220 DO 200 K = JP1, L G = G + AR(K,J) * AR(I,K) - AI(K,J) * AI(I,K) GI = GI - AR(K,J) * AI(I,K) - AI(K,J) * AR(I,K) 200 CONTINUE 220 E(J) = G / H TAU(2,J) = GI / H F = F + E(J) * AR(I,J) - TAU(2,J) * AI(I,J) 240 CONTINUE HH = F / (H + H) DO 260 J = 1, L F = AR(I,J) G = E(J) - HH * F E(J) = G FI = -AI(I,J) GI = TAU(2,J) - HH * FI TAU(2,J) = -GI DO 260 K = 1, J AR(J,K) = AR(J,K) - F * E(K) - G * AR(I,K) X + FI * TAU(2,K) + GI * AI(I,K) AI(J,K) = AI(J,K) - F * TAU(2,K) - G * AI(I,K) X - FI * E(K) - GI * AR(I,K) 260 CONTINUE 270 DO 280 K = 1, L AR(I,K) = SCALE * AR(I,K) AI(I,K) = SCALE * AI(I,K) 280 CONTINUE TAU(2,L) = -SI 290 HH = D(I) D(I) = AR(I,I) AR(I,I) = HH AI(I,I) = SCALE * SCALE * H 300 CONTINUE RETURN END