Debian Codegraph @

packages/seacas/applications/fastq/eqlang.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 EQLANG (MXND, XN, YN, LXN, NODE, N0, N2, NFROM, DIST,
8 & VRO, XDEL, YDEL)
9 C***********************************************************************
10
11 C SUBROUTINE EQLANG = CALCULATES A VECTOR SUM THAT ATTEMPTS TO
12 C MAINTAIN EQUAL ANGLES FOR A NODE
13
14 C***********************************************************************
15
16 DIMENSION XN(MXND), YN(MXND), LXN(4, MXND)
17
18 LOGICAL EXPAND
19
20 PI = ATAN2(0.0, -1.0)
21 TWOPI = 2.0 * PI
22
23 IF (NFROM .GT. 0) THEN
24
25 C TEST FOR THE EXPANSION CASE
26
27 IF ( ( ((LXN (4, NFROM) .NE. 0) .AND.
28 & (LXN (2, NFROM) .LT. 0)) .OR.
29 & ((LXN (4, NFROM) .LT. 0) .AND.
30 & (LXN (2, NFROM) .GT. 0)) )
31 & .AND.
32 & ((LXN (3, N0) .EQ. 0) .OR. (LXN (3, N2) .EQ. 0)) ) THEN
33 EXPAND = .TRUE.
34 ELSE
35 EXPAND = .FALSE.
36 ENDIF
37
38 ANG1 = ATAN2 ( YN (N2) - YN (NFROM), XN (N2) - XN (NFROM))
39 IF (ANG1 .LT. 0.) ANG1 = ANG1 + TWOPI
40 ANG2 = ATAN2 ( YN (N0) - YN (NFROM), XN (N0) - XN (NFROM))
41 IF (ANG2 .LT. 0.) ANG2 = ANG2 + TWOPI
42 ANG3 = ATAN2 ( YN (NODE) - YN (NFROM), XN (NODE) - XN (NFROM))
43 IF (ANG3 .LT. 0.) ANG3 = ANG3 + TWOPI
44
45 C GET THE APPROPRIATE ANGLE BETWEEN ANGLE 1 AND 2
46
47 ANG12D = ANG2 - ANG1
48 IF (ANG12D .LT. 0.) ANG12D = ANG12D + TWOPI
49
50 C IF THIS IS AN EXPANSION, THEN ADJUST THE ANGLE ACCORDINGLY
51
52 IF (EXPAND) THEN
53 IF (LXN (3, N2) .EQ. 0) THEN
54 ANG12 = ANG1 + (ANG12D * .6)
55 ELSEIF (LXN (3, N0) .EQ. 0) THEN
56 ANG12 = ANG1 + (ANG12D * .4)
57 ELSE
58 ANG12 = ANG1 + (ANG12D * .5)
59 ENDIF
60 ELSE
61 ANG12 = ANG1 + (ANG12D * .5)
62 ENDIF
63 IF (ANG12 .GT. TWOPI) ANG12 = ANG12 - TWOPI
64
65 C GET THE AVERAGE ANGLE BETWEEN ANGLE 12 AND 3
66
67 IF (ANG12 .GT. ANG3) THEN
68 ANG3D = ANG12 - ANG3
69 IF (ANG3D .GT. PI) THEN
70 ANG = ANG12 + ((TWOPI - ANG3D) * .5)
71 ELSE
72 ANG = ANG12 - (ANG3D * .5)
73 ENDIF
74 ELSE
75 ANG3D = ANG3 - ANG12
76 IF (ANG3D .GT. PI) THEN
77 ANG = ANG3 + ((TWOPI - ANG3D) * .5)
78 ELSE
79 ANG = ANG3 - (ANG3D * .5)
80 ENDIF
81 ENDIF
82
83 C GET THE DISTANCE TO MAKE THE OUTSIDE FLAT AT THIS ANGLE
84
85 D1 = SQRT ( ((XN (NFROM) - XN (N0)) ** 2) +
86 & ((YN (NFROM) - YN (N0)) ** 2) )
87 D2 = SQRT ( ((XN (N2) - XN (N0)) ** 2) +
88 & ((YN (N2) - YN (N0)) ** 2) )
89 D3 = SQRT ( ((XN (NFROM) - XN (N2)) ** 2) +
90 & ((YN (NFROM) - YN (N2)) ** 2) )
91 ARG = (SIN (ANG12D) * D1) / D2
92 IF (ARG .GT. 1.0) ARG = 1.0
93 IF (ARG .LT. -1.0) ARG = -1.0
94 BETA = ASIN (ARG)
95 D0 = (D3 * SIN (BETA)) / SIN (PI - BETA - (ANG12D * .5))
96
97 IF (D0 .GT. DIST) THEN
98 IF (EXPAND) THEN
99 DIST0 = D0
100 ELSE
101 DIST0 = (DIST + D0) * .5
102 ENDIF
103 ELSE
104 DIST0 = DIST
105 ENDIF
106
107 C CALCULATE THE NEW COORDINATES
108
109 X0 = XN (NFROM) + (COS (ANG) * DIST0)
110 Y0 = YN (NFROM) + (SIN (ANG) * DIST0)
111 XDEL = (X0 - XN (NODE)) * VRO
112 YDEL = (Y0 - YN (NODE)) * VRO
113
114 ELSE
115 XDEL = 0.
116 YDEL = 0.
117 ENDIF
118
119 RETURN
120
121 END