srotg.f 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  1. *DECK SROTG
  2. SUBROUTINE SROTG (SA, SB, SC, SS)
  3. C***BEGIN PROLOGUE SROTG
  4. C***PURPOSE Construct a plane Givens rotation.
  5. C***LIBRARY SLATEC (BLAS)
  6. C***CATEGORY D1B10
  7. C***TYPE SINGLE PRECISION (SROTG-S, DROTG-D, CROTG-C)
  8. C***KEYWORDS BLAS, GIVENS ROTATION, GIVENS TRANSFORMATION,
  9. C LINEAR ALGEBRA, VECTOR
  10. C***AUTHOR Lawson, C. L., (JPL)
  11. C Hanson, R. J., (SNLA)
  12. C Kincaid, D. R., (U. of Texas)
  13. C Krogh, F. T., (JPL)
  14. C***DESCRIPTION
  15. C
  16. C B L A S Subprogram
  17. C Description of Parameters
  18. C
  19. C --Input--
  20. C SA single precision scalar
  21. C SB single precision scalar
  22. C
  23. C --Output--
  24. C SA single precision result R
  25. C SB single precision result Z
  26. C SC single precision result
  27. C SS single precision result
  28. C
  29. C Construct the Givens transformation
  30. C
  31. C ( SC SS )
  32. C G = ( ) , SC**2 + SS**2 = 1 ,
  33. C (-SS SC )
  34. C
  35. C which zeros the second entry of the 2-vector (SA,SB)**T.
  36. C
  37. C The quantity R = (+/-)SQRT(SA**2 + SB**2) overwrites SA in
  38. C storage. The value of SB is overwritten by a value Z which
  39. C allows SC and SS to be recovered by the following algorithm:
  40. C
  41. C If Z=1 set SC=0.0 and SS=1.0
  42. C If ABS(Z) .LT. 1 set SC=SQRT(1-Z**2) and SS=Z
  43. C If ABS(Z) .GT. 1 set SC=1/Z and SS=SQRT(1-SC**2)
  44. C
  45. C Normally, the subprogram SROT(N,SX,INCX,SY,INCY,SC,SS) will
  46. C next be called to apply the transformation to a 2 by N matrix.
  47. C
  48. C***REFERENCES C. L. Lawson, R. J. Hanson, D. R. Kincaid and F. T.
  49. C Krogh, Basic linear algebra subprograms for Fortran
  50. C usage, Algorithm No. 539, Transactions on Mathematical
  51. C Software 5, 3 (September 1979), pp. 308-323.
  52. C***ROUTINES CALLED (NONE)
  53. C***REVISION HISTORY (YYMMDD)
  54. C 791001 DATE WRITTEN
  55. C 861211 REVISION DATE from Version 3.2
  56. C 891214 Prologue converted to Version 4.0 format. (BAB)
  57. C 920501 Reformatted the REFERENCES section. (WRB)
  58. C***END PROLOGUE SROTG
  59. C***FIRST EXECUTABLE STATEMENT SROTG
  60. IF (ABS(SA) .LE. ABS(SB)) GO TO 10
  61. C
  62. C *** HERE ABS(SA) .GT. ABS(SB) ***
  63. C
  64. U = SA + SA
  65. V = SB / U
  66. C
  67. C NOTE THAT U AND R HAVE THE SIGN OF SA
  68. C
  69. R = SQRT(0.25E0 + V**2) * U
  70. C
  71. C NOTE THAT SC IS POSITIVE
  72. C
  73. SC = SA / R
  74. SS = V * (SC + SC)
  75. SB = SS
  76. SA = R
  77. RETURN
  78. C
  79. C *** HERE ABS(SA) .LE. ABS(SB) ***
  80. C
  81. 10 IF (SB .EQ. 0.0E0) GO TO 20
  82. U = SB + SB
  83. V = SA / U
  84. C
  85. C NOTE THAT U AND R HAVE THE SIGN OF SB
  86. C (R IS IMMEDIATELY STORED IN SA)
  87. C
  88. SA = SQRT(0.25E0 + V**2) * U
  89. C
  90. C NOTE THAT SS IS POSITIVE
  91. C
  92. SS = SB / SA
  93. SC = V * (SS + SS)
  94. IF (SC .EQ. 0.0E0) GO TO 15
  95. SB = 1.0E0 / SC
  96. RETURN
  97. 15 SB = 1.0E0
  98. RETURN
  99. C
  100. C *** HERE SA = SB = 0.0 ***
  101. C
  102. 20 SC = 1.0E0
  103. SS = 0.0E0
  104. RETURN
  105. C
  106. END