Debian Codegraph @

packages/seacas/applications/fastq/linlen.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 LINLEN (MP, COOR, LINKP, KNUM, LNUM, KT, I3, J1, J2,
8 & J3, DIST, ERR)
9 C***********************************************************************
10
11 C SUBROUTINE LINLEN = CALCULATES THE LENGTH OF A GIVEN LINE
12
13 C***********************************************************************
14
15 C VARIABLES USED:
16 C NID = AN ARRAY OF UNIQUE NODE IDENTIFIERS.
17 C REAL = .TRUE. FOR AN ACTUAL GENERATION
18 C = .FALSE. FOR A TRIAL GENERATION
19 C ERR = .TRUE. IF AN ERROR WAS ENCOUNTERED
20 C J1 = POINTER FOR THE FIRST POINT
21 C J2 = POINTER FOR THE SECOND POINT
22 C J3 = POINTER FOR THE THIRD POINT
23 C MAXNP = MAXIMUM NUMBER OF NODES ON THE PERIMETER
24 C NOTE: MAXNP MUST BE ADJUSTED FOR THE CURRENT
25 C LOCATION IN X, Y, & NID
26 C KT = THE LINE TYPE:
27 C = 1 FOR STRAIGHT LINES
28 C = 2 FOR CORNER LINES
29 C = 3 FOR ARC WITH CENTER GIVEN
30 C = 4 FOR ARC WITH THIRD POINT ON THE ARC
31 C = 5 FOR PARABOLA
32 C = 6 FOR ARC WITH RADIUS GIVEN
33
34 C***********************************************************************
35
36 DIMENSION COOR (2, MP), LINKP (2, MP)
37
38 LOGICAL ERR
39
40 PI = ATAN2(0.0, -1.0)
41
42 DIST = 0.
43 ERR = .TRUE.
44
45 C STRAIGHT LINE GENERATION
46
47 IF (KT.EQ.1) THEN
48 YDIFF = COOR (2, J2) -COOR (2, J1)
49 XDIFF = COOR (1, J2) -COOR (1, J1)
50 DIST = SQRT (YDIFF ** 2 + XDIFF ** 2)
51 IF (DIST.EQ.0.) THEN
52 WRITE (*, 10000) KNUM
53 RETURN
54 ENDIF
55
56 C CORNER GENERATION
57
58 ELSEIF (KT.EQ.2) THEN
59 XDA = COOR (1, J3) -COOR (1, J1)
60 YDA = COOR (2, J3) -COOR (2, J1)
61 XDB = COOR (1, J2) -COOR (1, J3)
62 YDB = COOR (2, J2) -COOR (2, J3)
63 DA = SQRT (XDA ** 2 + YDA ** 2)
64 DB = SQRT (XDB ** 2 + YDB ** 2)
65 IF ((DA.EQ.0.) .OR. (DB.EQ.0.) )THEN
66 WRITE (*, 10000) KNUM
67 RETURN
68 ENDIF
69 DIST = DA+DB
70
71 C CIRCULAR ARC
72
73 ELSEIF ((KT.EQ.3) .OR. (KT.EQ.4) .OR. (KT.EQ.6) )THEN
74 XSTART = COOR (1, J1)
75 YSTART = COOR (2, J1)
76 CALL ARCPAR (MP, KT, KNUM, COOR, LINKP, J1, J2, J3, I3,
77 & XCEN, YCEN, THETA1, THETA2, TANG, R1, R2, ERR, ICCW, ICW,
78 & XK, XA)
79
80 C GENERATE THE CIRCLE
81
82 ANG = THETA1
83 DEL = TANG/30
84 DO 100 I = 2, 29
85 ANG = ANG+DEL
86 RADIUS = XA * EXP (XK * ANG)
87 XEND = XCEN+COS (ANG) * RADIUS
88 YEND = YCEN+SIN (ANG) * RADIUS
89 DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2)
90 XSTART = XEND
91 YSTART = YEND
92 100 CONTINUE
93 XEND = COOR (1, J2)
94 YEND = COOR (2, J2)
95 DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2)
96
97 C ELIPSE
98
99 ELSEIF (KT .EQ. 7) THEN
100 XSTART = COOR (1, J1)
101 YSTART = COOR (2, J1)
102 CALL ELPSPR (MP, KT, KNUM, COOR, LINKP, J1, J2, J3,
103 & I3, XCEN, YCEN, THETA1, THETA2, TANG, IDUM1, IDUM2,
104 & AVALUE, BVALUE, ERR)
105
106 C GENERATE THE ELIPSE
107
108 ANG = THETA1
109 DEL = TANG/30
110 DO 110 I = 2, 29
111 ANG = ANG+DEL
112 RADIUS = SQRT ( (AVALUE **2 * BVALUE **2) /
113 & ( (BVALUE **2 * COS (ANG) **2) +
114 & (AVALUE **2 * SIN (ANG) **2) ) )
115 XEND = XCEN+COS (ANG) * RADIUS
116 YEND = YCEN+SIN (ANG) * RADIUS
117 DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2)
118 XSTART = XEND
119 YSTART = YEND
120 110 CONTINUE
121 XEND = COOR (1, J2)
122 YEND = COOR (2, J2)
123 DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2)
124
125 C PARABOLA
126
127 ELSEIF (KT.EQ.5) THEN
128
129 C CHECK LEGITIMACY OF DATA
130
131 XMID = (COOR (1, J1) +COOR (1, J2) ) * 0.5
132 YMID = (COOR (2, J1) +COOR (2, J2) ) * 0.5
133 DOT = (COOR (1, J2) -COOR (1, J1) ) * (COOR (1, J3) -XMID)
134 & + (COOR (2, J2) -COOR (2, J1) ) * (COOR (2, J3) -YMID)
135 PERP = SQRT ((COOR (1, J2) -COOR (1, J1) ) ** 2 +
136 & (COOR (2, J2) - COOR (2, J1) ) ** 2) *
137 & SQRT ((COOR (1, J3) -XMID) ** 2 + (COOR (2, J3)
138 & -YMID) ** 2)
139 IF (DOT.GE.0.05 * PERP) THEN
140 WRITE (*, 10030) KNUM
141 RETURN
142 ENDIF
143
144 C GETARC LENGTH
145
146 HALFW = SQRT ((COOR (1, J2) -COOR (1, J1) ) ** 2 +
147 & (COOR (2, J2) - COOR (2, J1) ) ** 2 ) * 0.5
148 IF (HALFW.EQ.0.) THEN
149 WRITE (*, 10000) KNUM
150 RETURN
151 ENDIF
152 HEIGHT = SQRT ((XMID-COOR (1, J3) ) ** 2
153 & + (YMID-COOR (2, J3) ) ** 2)
154 COEF = HEIGHT/HALFW ** 2
155 TCOEF = 2.0 * COEF
156
157 C PARC IS A STATEMENT FUNCTION
158
159 PLEFT = PARC (-TCOEF * HALFW, TCOEF)
160 ARCTOT = 2.0 * PARC (TCOEF * HALFW, TCOEF)
161 ARCDEL = ARCTOT/30
162 ARCNXT = ARCDEL
163 ARCNOW = 0.0
164 THETA = ATAN2 (COOR (2, J2) -COOR (2, J1) , COOR (1, J2)
165 & - COOR (1, J1) )
166
167 C CORRECT FOR ORIENTATION
168
169 CROSS = (COOR (1, J3) -XMID) * (COOR (2, J2) -COOR (2, J1) )-
170 & (COOR (2, J3) -YMID) * (COOR (1, J2) -COOR (1, J1) )
171 IF (CROSS.LT.0.0) THETA = THETA+PI
172 SINT = SIN (THETA)
173 COST = COS (THETA)
174
175 C FIND POINTS APPROXIMATELY BY INTEGRATION
176
177 XL = -HALFW
178 FL = SQRT (1.0+ (TCOEF * XL) ** 2)
179 KOUNT = 1
180 DELX = 2.0 * HALFW/200.0
181 XSTART = COOR (1, J1)
182 YSTART = COOR (2, J1)
183 DO 120 I = 1, 100
184 FM = SQRT (1.0+ (TCOEF * (XL+DELX) ) ** 2)
185 XR = - HALFW + DBLE(I) * 2.0 * DELX
186 FR = SQRT (1.0+ (TCOEF * XR) ** 2)
187 ARCOLD = ARCNOW
188 ARCNOW = ARCNOW+DELX * (FL+4.0 * FM+FR) / 3.0
189 IF (ARCNOW.GE.ARCNXT) THEN
190
191 C COMPUTE POSITION IN LOCAL COORDINATE SYSTEM
192
193 FRAC = (ARCNXT-ARCOLD) / (ARCNOW-ARCOLD)
194 XK = XL+FRAC * 2.0 * DELX
195 YK = COEF * XK ** 2
196
197 C CORRECT FOR ORIENTATION PROBLEM
198
199 IF (CROSS.LT.0.0) XK = -XK
200
201 C ROTATE IN LINE WITH GLOBAL COORDINATE SYSTEM
202
203 ROTX = XK * COST - YK * SINT
204 ROTY = YK * COST + XK * SINT
205
206 C RESTORE XK
207
208 IF (CROSS.LT.0.0) XK = -XK
209
210 C TRANSLATE
211
212 XEND = ROTX+COOR (1, J3)
213 YEND = ROTY+COOR (2, J3)
214 DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) **2)
215 KOUNT = KOUNT+1
216 XSTART = XEND
217 YSTART = YEND
218
219 C PREPARE FOR NEXT POINT
220
221 IF (KOUNT.GE.29) GOTO 130
222 ARCNXT = ARCNXT+ARCDEL
223
224 C RESTART INTEGRATION
225
226 XR = XK
227 FR = SQRT (1.0+ (TCOEF * XR) ** 2)
228
229 C CORRECT FOR INTEGRATION ERROR
230
231 ARCNOW = PARC (TCOEF * XR, TCOEF) -PLEFT
232 ENDIF
233 XL = XR
234 FL = FR
235 120 CONTINUE
236 130 CONTINUE
237 XEND = COOR (1, J2)
238 YEND = COOR (2, J2)
239 DIST = DIST+SQRT ((XEND-XSTART) ** 2+ (YEND-YSTART) ** 2)
240 ENDIF
241
242 C NORMAL EXIT
243
244 ERR = .FALSE.
245 RETURN
246
247 10000 FORMAT (' ZERO LINE LENGTH ENCOUNTERED FOR LINE', I5)
248 10030 FORMAT (' POINTS GIVEN FOR LINE', I5, ' DO NOT DEFINE A PARABOLA')
249
250 END