You can not select more than 25 topics Topics must start with a chinese character,a letter or number, can include dashes ('-') and can be up to 35 characters long.

slartgp.f 5.4 kB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202
  1. *> \brief \b SLARTGP generates a plane rotation so that the diagonal is nonnegative.
  2. *
  3. * =========== DOCUMENTATION ===========
  4. *
  5. * Online html documentation available at
  6. * http://www.netlib.org/lapack/explore-html/
  7. *
  8. *> \htmlonly
  9. *> Download SLARTGP + dependencies
  10. *> <a href="http://www.netlib.org/cgi-bin/netlibfiles.tgz?format=tgz&filename=/lapack/lapack_routine/slartgp.f">
  11. *> [TGZ]</a>
  12. *> <a href="http://www.netlib.org/cgi-bin/netlibfiles.zip?format=zip&filename=/lapack/lapack_routine/slartgp.f">
  13. *> [ZIP]</a>
  14. *> <a href="http://www.netlib.org/cgi-bin/netlibfiles.txt?format=txt&filename=/lapack/lapack_routine/slartgp.f">
  15. *> [TXT]</a>
  16. *> \endhtmlonly
  17. *
  18. * Definition:
  19. * ===========
  20. *
  21. * SUBROUTINE SLARTGP( F, G, CS, SN, R )
  22. *
  23. * .. Scalar Arguments ..
  24. * REAL CS, F, G, R, SN
  25. * ..
  26. *
  27. *
  28. *> \par Purpose:
  29. * =============
  30. *>
  31. *> \verbatim
  32. *>
  33. *> SLARTGP generates a plane rotation so that
  34. *>
  35. *> [ CS SN ] . [ F ] = [ R ] where CS**2 + SN**2 = 1.
  36. *> [ -SN CS ] [ G ] [ 0 ]
  37. *>
  38. *> This is a slower, more accurate version of the Level 1 BLAS routine SROTG,
  39. *> with the following other differences:
  40. *> F and G are unchanged on return.
  41. *> If G=0, then CS=(+/-)1 and SN=0.
  42. *> If F=0 and (G .ne. 0), then CS=0 and SN=(+/-)1.
  43. *>
  44. *> The sign is chosen so that R >= 0.
  45. *> \endverbatim
  46. *
  47. * Arguments:
  48. * ==========
  49. *
  50. *> \param[in] F
  51. *> \verbatim
  52. *> F is REAL
  53. *> The first component of vector to be rotated.
  54. *> \endverbatim
  55. *>
  56. *> \param[in] G
  57. *> \verbatim
  58. *> G is REAL
  59. *> The second component of vector to be rotated.
  60. *> \endverbatim
  61. *>
  62. *> \param[out] CS
  63. *> \verbatim
  64. *> CS is REAL
  65. *> The cosine of the rotation.
  66. *> \endverbatim
  67. *>
  68. *> \param[out] SN
  69. *> \verbatim
  70. *> SN is REAL
  71. *> The sine of the rotation.
  72. *> \endverbatim
  73. *>
  74. *> \param[out] R
  75. *> \verbatim
  76. *> R is REAL
  77. *> The nonzero component of the rotated vector.
  78. *>
  79. *> This version has a few statements commented out for thread safety
  80. *> (machine parameters are computed on each entry). 10 feb 03, SJH.
  81. *> \endverbatim
  82. *
  83. * Authors:
  84. * ========
  85. *
  86. *> \author Univ. of Tennessee
  87. *> \author Univ. of California Berkeley
  88. *> \author Univ. of Colorado Denver
  89. *> \author NAG Ltd.
  90. *
  91. *> \date December 2016
  92. *
  93. *> \ingroup OTHERauxiliary
  94. *
  95. * =====================================================================
  96. SUBROUTINE SLARTGP( F, G, CS, SN, R )
  97. *
  98. * -- LAPACK auxiliary routine (version 3.7.0) --
  99. * -- LAPACK is a software package provided by Univ. of Tennessee, --
  100. * -- Univ. of California Berkeley, Univ. of Colorado Denver and NAG Ltd..--
  101. * December 2016
  102. *
  103. * .. Scalar Arguments ..
  104. REAL CS, F, G, R, SN
  105. * ..
  106. *
  107. * =====================================================================
  108. *
  109. * .. Parameters ..
  110. REAL ZERO
  111. PARAMETER ( ZERO = 0.0E0 )
  112. REAL ONE
  113. PARAMETER ( ONE = 1.0E0 )
  114. REAL TWO
  115. PARAMETER ( TWO = 2.0E0 )
  116. * ..
  117. * .. Local Scalars ..
  118. * LOGICAL FIRST
  119. INTEGER COUNT, I
  120. REAL EPS, F1, G1, SAFMIN, SAFMN2, SAFMX2, SCALE
  121. * ..
  122. * .. External Functions ..
  123. REAL SLAMCH
  124. EXTERNAL SLAMCH
  125. * ..
  126. * .. Intrinsic Functions ..
  127. INTRINSIC ABS, INT, LOG, MAX, SIGN, SQRT
  128. * ..
  129. * .. Save statement ..
  130. * SAVE FIRST, SAFMX2, SAFMIN, SAFMN2
  131. * ..
  132. * .. Data statements ..
  133. * DATA FIRST / .TRUE. /
  134. * ..
  135. * .. Executable Statements ..
  136. *
  137. * IF( FIRST ) THEN
  138. SAFMIN = SLAMCH( 'S' )
  139. EPS = SLAMCH( 'E' )
  140. SAFMN2 = SLAMCH( 'B' )**INT( LOG( SAFMIN / EPS ) /
  141. $ LOG( SLAMCH( 'B' ) ) / TWO )
  142. SAFMX2 = ONE / SAFMN2
  143. * FIRST = .FALSE.
  144. * END IF
  145. IF( G.EQ.ZERO ) THEN
  146. CS = SIGN( ONE, F )
  147. SN = ZERO
  148. R = ABS( F )
  149. ELSE IF( F.EQ.ZERO ) THEN
  150. CS = ZERO
  151. SN = SIGN( ONE, G )
  152. R = ABS( G )
  153. ELSE
  154. F1 = F
  155. G1 = G
  156. SCALE = MAX( ABS( F1 ), ABS( G1 ) )
  157. IF( SCALE.GE.SAFMX2 ) THEN
  158. COUNT = 0
  159. 10 CONTINUE
  160. COUNT = COUNT + 1
  161. F1 = F1*SAFMN2
  162. G1 = G1*SAFMN2
  163. SCALE = MAX( ABS( F1 ), ABS( G1 ) )
  164. IF( SCALE.GE.SAFMX2 )
  165. $ GO TO 10
  166. R = SQRT( F1**2+G1**2 )
  167. CS = F1 / R
  168. SN = G1 / R
  169. DO 20 I = 1, COUNT
  170. R = R*SAFMX2
  171. 20 CONTINUE
  172. ELSE IF( SCALE.LE.SAFMN2 ) THEN
  173. COUNT = 0
  174. 30 CONTINUE
  175. COUNT = COUNT + 1
  176. F1 = F1*SAFMX2
  177. G1 = G1*SAFMX2
  178. SCALE = MAX( ABS( F1 ), ABS( G1 ) )
  179. IF( SCALE.LE.SAFMN2 )
  180. $ GO TO 30
  181. R = SQRT( F1**2+G1**2 )
  182. CS = F1 / R
  183. SN = G1 / R
  184. DO 40 I = 1, COUNT
  185. R = R*SAFMN2
  186. 40 CONTINUE
  187. ELSE
  188. R = SQRT( F1**2+G1**2 )
  189. CS = F1 / R
  190. SN = G1 / R
  191. END IF
  192. IF( R.LT.ZERO ) THEN
  193. CS = -CS
  194. SN = -SN
  195. R = -R
  196. END IF
  197. END IF
  198. RETURN
  199. *
  200. * End of SLARTG
  201. *
  202. END