Debian Codegraph @

packages/seacas/applications/fastq/elpspr.f

raw
1 C Copyright(C) 1999-2020 National Technology & Engineering Solutions
2 C of Sandia, LLC (NTESS). Under the terms of Contract DE-NA0003525 with
3 C NTESS, the U.S. Government retains certain rights in this software.
4 C
5 C See packages/seacas/LICENSE for details
6
7 SUBROUTINE ELPSPR (MP, KT, KNUM, COOR, LINKP, IPNTR1, IPNTR2,
8 & IPNTR3, IP3, XCEN, YCEN, THETA1, THETA2, TANG, ICCW, ICW,
9 & AVALUE, BVALUE, ERR)
10 C***********************************************************************
11
12 C SUBROUTINE ELPSPR = THIS ROUTINE CALCULATES THE ELIPSE PARAMETERS
13
14 C***********************************************************************
15
16 C VARIABLES USED:
17 C TANG = TOTAL ANGLE SCRIBED BY THE ARC
18 C THETA1 = FIRST CCW ANGLE OF THE ARC
19 C THETA2 = SECOND CCW ANGLE OF THE ARC
20 C IPNTR1 = POINTER TO FIRST COORDINATE VALUE
21 C IPNTR2 = POINTER TO SECOND COORDINATE VALUE
22 C IPNTR3 = POINTER TO THIRD COORDINATE VALUE
23 C IP3 = THE THIRD POINT NUMBER (CAN BE NEGATED)
24
25 C***********************************************************************
26
27 DIMENSION COOR (2, MP), LINKP (2, MP)
28
29 LOGICAL ERR
30
31 PI = ATAN2(0.0, -1.0)
32
33 TWOPI = PI + PI
34 ERR = .FALSE.
35
36 C ELIPSE GOES FROM 1ST POINT TO 2ND IN *COUNTER-CLOCKWISE* DIRECTION.
37
38 XCEN = COOR (1, IPNTR3)
39 YCEN = COOR (2, IPNTR3)
40
41 C CHECK TO MAKE SURE THAT THE BEGINNING AND ENDING RADIUS EXIST
42
43 IF (( (COOR (1, IPNTR1) .EQ. XCEN).AND.
44 & (COOR (2,IPNTR1) .EQ. YCEN)).OR.
45 & ((COOR (1, IPNTR2) .EQ. XCEN).AND.
46 & (COOR (2, IPNTR2) .EQ. YCEN)))THEN
47 CALL PLTFLU
48 WRITE (*, 10000)ABS (KNUM)
49 ERR = .TRUE.
50 GOTO 100
51 ENDIF
52 THETA1 = ATAN2 (COOR (2, IPNTR1) - YCEN, COOR (1, IPNTR1) - XCEN)
53 THETA2 = ATAN2 (COOR (2, IPNTR2) - YCEN, COOR (1, IPNTR2) - XCEN)
54
55 C NOW CALCULATE THE MAJOR AXIS (AVALUE) AND THE MINOR AXIS (BVALUE)
56
57 X1 = COOR (1, IPNTR1) - XCEN
58 Y1 = COOR (2, IPNTR1) - YCEN
59 X2 = COOR (1, IPNTR2) - XCEN
60 Y2 = COOR (2, IPNTR2) - YCEN
61
62 C CHOOSE THE APPROPRIATE ELIPSE DEFINITION
63
64 IF (Y1 * Y1 .EQ. Y2 * Y2) THEN
65 AVALUE = SQRT (X1 * X1 + Y1 * Y1)
66 BVALUE = AVALUE
67 ELSEIF ((Y1 .EQ. 0.) .AND. (X2 .EQ. 0.)) THEN
68 AVALUE = X1
69 BVALUE = Y2
70 ELSEIF ((Y2 .EQ. 0.) .AND. (X1 .EQ. 0.)) THEN
71 AVALUE = X2
72 BVALUE = Y1
73 ELSE
74 RATIO = SQRT (ABS ( (X1 * X1 - X2 * X2) /
75 & (Y1 * Y1 - Y2 * Y2) ))
76 IF (RATIO .EQ. 0.) THEN
77 AVALUE = SQRT (X1 * X1 + Y1 * Y1)
78 BVALUE = AVALUE
79 ELSEIF (RATIO .EQ. 1.0) THEN
80 AVALUE = SQRT (X1 * X1 + Y1 * Y1)
81 BVALUE = AVALUE
82 ELSE
83 IF ((Y2 .EQ. 0.) .OR. ((X2 .EQ. 0.) .AND. (Y1 .NE. 0.)) )
84 & THEN
85 IF (RATIO .GT. 1.) THEN
86 VX = 1.
87 VY = - (1./RATIO**2) * (X1 / Y1)
88 ELSE
89 VX = 1.
90 VY = - (RATIO**2) * (X1 / Y1)
91 ENDIF
92 D0 = SQRT (X1 * X1 + Y1 * Y1)
93 A8 = ACOS ( ((X1 * VX) + (Y1 * VY)) /
94 & (D0 * SQRT (VX * VX + VY * VY)) )
95 A7 = PI - A8
96 A2 = ABS (ATAN2 (Y1, X1))
97 THETA1 = ABS(ATAN2 (VY, 1.))
98 ELSE
99 IF (RATIO .GT. 1.) THEN
100 VX = 1.
101 VY = - (1./RATIO**2) * (X2 / Y2)
102 ELSE
103 VX = 1.
104 VY = - (RATIO**2) * (X2 / Y2)
105 ENDIF
106 D0 = SQRT (X2 * X2 + Y2 * Y2)
107 A8 = ACOS ( ((X2 * VX) + (Y2 * VY)) /
108 & (D0 * SQRT (VX * VX + VY * VY)) )
109 A7 = PI - A8
110 A2 = ABS (ATAN2 (Y2, X2))
111 THETA1 = ABS(ATAN2 (VY, 1.))
112 ENDIF
113
114 RADMAX = MAX(A7,A8)
115 CALL ETHETA (A7, A8, A2, THETA1, RADMAX, THETA, ERR)
116 IF (ERR) THEN
117 WRITE (*, 10010) ABS (KNUM)
118 GOTO 100
119 ENDIF
120
121 CVALUE = D0 * SIN (A8 - THETA) / SIN (A2 - A8 + THETA)
122 BVALUE = SQRT (ABS (CVALUE **2 / (RATIO **2 - 1)) )
123 AVALUE = BVALUE * RATIO
124 ENDIF
125 ENDIF
126
127 C NOW GET THE ANGLES GOING THE RIGHT WAY
128
129 THETA1 = ATAN2 (COOR (2, IPNTR1) - YCEN, COOR (1, IPNTR1) - XCEN)
130 THETA2 = ATAN2 (COOR (2, IPNTR2) - YCEN, COOR (1, IPNTR2) - XCEN)
131 IF (IPNTR1 .EQ. IPNTR2) THEN
132 THETA2 = THETA1 + TWOPI
133 ELSEIF ( (IP3 .GE. 0) .AND. (THETA2 .LE. THETA1) ) THEN
134 THETA2 = THETA2+TWOPI
135 ELSEIF ( (IP3 .LT. 0) .AND. (THETA1 .LE. THETA2) ) THEN
136 THETA1 = THETA1+TWOPI
137 ENDIF
138 TANG = THETA2 - THETA1
139 IF (IP3 .LT. 0) THEN
140 ICCW = IPNTR2
141 ICW = IPNTR1
142 ELSE
143 ICCW = IPNTR1
144 ICW = IPNTR2
145 ENDIF
146
147 100 CONTINUE
148
149 RETURN
150
151 10000 FORMAT (' CENTER POINT FOR LINE', I5, ' LIES ON ONE OF',
152 & ' THE ENDPOINTS')
153 10010 FORMAT (' POINTS GIVEN FOR LINE', I5, ' DO NOT DEFINE AN ELIPSE')
154
155 END