Debian Codegraph @

packages/seacas/applications/fastq/arcpar.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 ARCPAR (MP, KT, KNUM, COOR, LINKP, IPNTR1, IPNTR2,
8 & IPNTR3, IP3, XCEN, YCEN, THETA1, THETA2, TANG, R1, R2, ERR,
9 & ICCW, ICW, XK, XA)
10 C***********************************************************************
11
12 C SUBROUTINE ARCPAR = THIS ROUTINE CALCULATES THE ARC 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 TWOPI = PI + PI
33 ERR = .FALSE.
34
35 C ARC WITH CENTER GIVEN
36 C ARC GOES FROM 1ST POINT TO 2ND IN *COUNTER-CLOCKWISE* DIRECTION.
37
38 IF (KT .EQ. 3) THEN
39 XCEN = COOR (1, IPNTR3)
40 YCEN = COOR (2, IPNTR3)
41
42 C CIRCLE WITH THIRD POINT ON ARC
43
44 ELSEIF (KT .EQ. 4) THEN
45 THETA1 = ATAN2 (COOR (2, IPNTR3) - COOR (2, IPNTR1),
46 & COOR (1, IPNTR3) - COOR (1, IPNTR1)) + PI / 2.0
47 THETA2 = ATAN2 (COOR (2, IPNTR3) - COOR (2, IPNTR2),
48 & COOR (1, IPNTR3) - COOR (1, IPNTR2)) + PI / 2.0
49 DET = - COS (THETA1) * SIN (THETA2) +
50 & COS (THETA2) * SIN (THETA1)
51 X11 = 0.5 * (COOR (1, IPNTR1) + COOR (1, IPNTR3))
52 Y11 = 0.5 * (COOR (2, IPNTR1) + COOR (2, IPNTR3))
53 X21 = 0.5 * (COOR (1, IPNTR2) + COOR (1, IPNTR3))
54 Y21 = 0.5 * (COOR (2, IPNTR2) + COOR (2, IPNTR3))
55 R = ( - SIN (THETA2) * (X21 - X11) +
56 & COS (THETA2) * (Y21 - Y11)) / DET
57 XCEN = X11 + R * COS (THETA1)
58 YCEN = Y11 + R * SIN (THETA1)
59
60 C CIRCLE WITH RADIUS GIVEN
61
62 ELSEIF (KT .EQ. 6) THEN
63 DX = 0.5 * (COOR (1, IPNTR2) - COOR (1, IPNTR1))
64 DY = 0.5 * (COOR (2, IPNTR2) - COOR (2, IPNTR1))
65 CHORD = SQRT (DX * DX + DY * DY)
66 R = ABS (COOR (1, IPNTR3))
67 IF (R .LE. CHORD) THEN
68 XCEN = 0.5 * (COOR (1, IPNTR1) + COOR (1, IPNTR2))
69 YCEN = 0.5 * (COOR (2, IPNTR1) + COOR (2, IPNTR2))
70 ELSE
71 ARM = SQRT (R * R - CHORD * CHORD)
72 IF (IP3.LT.0) THEN
73 XCEN = COOR (1, IPNTR1) + DX + ARM * DY / CHORD
74 YCEN = COOR (2, IPNTR1) + DY - ARM * DX / CHORD
75 ELSE
76 XCEN = COOR (1, IPNTR1) + DX - ARM * DY / CHORD
77 YCEN = COOR (2, IPNTR1) + DY + ARM * DX / CHORD
78 ENDIF
79 ENDIF
80 ENDIF
81
82 C CHECK TO MAKE SURE THAT THE BEGINNING AND ENDING RADIUS EXIST
83
84 IF ((( COOR (1, IPNTR1) .EQ. XCEN) .AND.
85 & (COOR (2, IPNTR1) .EQ. YCEN)) .OR.
86 & ((COOR (1, IPNTR2) .EQ. XCEN) .AND.
87 & (COOR (2, IPNTR2) .EQ. YCEN))) THEN
88 CALL PLTFLU
89 WRITE (*, 10000) ABS (KNUM)
90 ERR = .TRUE.
91 GOTO 100
92 ENDIF
93 R1 = SQRT ( (COOR (1, IPNTR1) - XCEN) **2 + (COOR (2, IPNTR1) -
94 & YCEN) **2)
95 R2 = SQRT ( (COOR (1, IPNTR2) - XCEN) **2 + (COOR (2, IPNTR2) -
96 & YCEN) **2)
97 THETA1 = ATAN2 (COOR (2, IPNTR1) - YCEN, COOR (1, IPNTR1) - XCEN)
98 THETA2 = ATAN2 (COOR (2, IPNTR2) - YCEN, COOR (1, IPNTR2) - XCEN)
99
100 C ARC WITH THE CENTER GIVEN
101
102 IF (KT .EQ. 3) THEN
103 IF (IPNTR1 .EQ. IPNTR2) THEN
104 THETA2 = THETA1 + TWOPI
105 ELSEIF ((IP3 .GE. 0) .AND. (THETA2 .LE. THETA1)) THEN
106 THETA2 = THETA2 + TWOPI
107 ELSEIF ((IP3 .LT. 0) .AND. (THETA1 .LE. THETA2)) THEN
108 THETA1 = THETA1 + TWOPI
109 ENDIF
110 TANG = THETA2 - THETA1
111 IF (IP3 .LT. 0) THEN
112 ICCW = IPNTR2
113 ICW = IPNTR1
114 ELSE
115 ICCW = IPNTR1
116 ICW = IPNTR2
117 ENDIF
118
119 C CIRCULAR ARC WITH 3RD POINT ON ARC - CLOCKWISE OR COUNTER-CLOCKWISE
120
121 ELSEIF (KT .EQ. 4) THEN
122 THETA3 = ATAN2 (COOR (2, IPNTR3) - YCEN, COOR (1, IPNTR3) -
123 & XCEN)
124 IF (THETA2 .LE. THETA1) THETA2 = THETA2 + TWOPI
125 IF (THETA3 .LE. THETA1) THETA3 = THETA3 + TWOPI
126 TANG = THETA2 - THETA1
127 IF (THETA3 .GT. THETA2) THEN
128 TANG = - (TWOPI - TANG)
129 ICCW = IPNTR2
130 ICW = IPNTR1
131 ELSE
132 ICCW = IPNTR1
133 ICW = IPNTR2
134 ENDIF
135
136 C CIRRCULAR ARC WITH RADIUS GIVEN - CLOCKWISE OR COUNTER-CLOCKWISE
137
138 ELSEIF (KT .EQ. 6) THEN
139 IF ( (IP3 .GE. 0) .AND. (THETA2 .LE. THETA1))
140 & THETA2 = THETA2 + TWOPI
141 IF ( (IP3 .LT. 0) .AND. (THETA1 .LE. THETA2))
142 & THETA1 = THETA1 + TWOPI
143 TANG = THETA2 - THETA1
144 IF (IP3 .GE. 0) THEN
145 ICCW = IPNTR1
146 ICW = IPNTR2
147 ELSE
148 ICCW = IPNTR2
149 ICW = IPNTR1
150 ENDIF
151 ENDIF
152
153 C DEFINE THE SPIRAL PARAMETERS (R = XA * EXP (XK * THETA))
154
155 XK = (LOG (R2 / R1)) / (THETA2 - THETA1)
156 DIVID = EXP (XK * THETA2)
157 IF (DIVID .GT. 0.) THEN
158 XA = R2 / DIVID
159 ELSE
160 WRITE (*, 10010) IABS (KNUM)
161 ERR = .TRUE.
162 GOTO 100
163 ENDIF
164
165 100 CONTINUE
166
167 RETURN
168
169 10000 FORMAT (' CENTER POINT FOR LINE', I5, ' LIES ON ONE OF',
170 & ' THE ENDPOINTS')
171 10010 FORMAT (' DEFINITION FOR ARC LINE', I5, ' IS INVLAID')
172
173 END