Debian Codegraph @

packages/seacas/applications/fastq/extnd5.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 EXTND5 (MXND, XN, YN, ANGLE, N1, N2, N3, X, Y, DIST)
8 C***********************************************************************
9
10 C SUBROUTINE EXTND5 = CALCULATES TWO POSITIONS AN AVERAGE LENGTH AWAY
11 C FROM A CORNER NODE AND AT 1/3 ANGLE INTERVALS
12
13 C***********************************************************************
14
15 DIMENSION XN (MXND), YN (MXND)
16 DIMENSION X(5), Y(5)
17
18 ANG = ATAN2 (YN (N1) - YN (N2), XN (N1) - XN (N2))
19 CANG = ANGLE * .25
20 ANG1 = ANG - CANG
21 ANG2 = ANG - 3. * (ANGLE * .125)
22 ANG3 = ANG - 2 * CANG
23 ANG4 = ANG - 5. * (ANGLE * .125)
24 ANG5 = ANG - 3 * CANG
25 DIST1 = SQRT ((YN (N2) - YN (N1)) **2 + (XN (N2) - XN (N1)) **2)
26 DIST2 = SQRT ((YN (N3) - YN (N2)) **2 + (XN (N3) - XN (N2)) **2)
27 DIST = (DIST1 + DIST2) * .5
28 IF (CANG. EQ. 0.) THEN
29 ADIST = DIST
30 ELSE
31 ADIST = DIST / SIN (CANG)
32 ENDIF
33
34 X(1) = ADIST * COS (ANG1) + XN (N2)
35 Y(1) = ADIST * SIN (ANG1) + YN (N2)
36 X(2) = 1.4142 * ADIST * COS (ANG2) + XN (N2)
37 Y(2) = 1.4142 * ADIST * SIN (ANG2) + YN (N2)
38 X(3) = ADIST * COS (ANG3) + XN (N2)
39 Y(3) = ADIST * SIN (ANG3) + YN (N2)
40 X(4) = 1.4142 * ADIST * COS (ANG4) + XN (N2)
41 Y(4) = 1.4142 * ADIST * SIN (ANG4) + YN (N2)
42 X(5) = ADIST * COS (ANG5) + XN (N2)
43 Y(5) = ADIST * SIN (ANG5) + YN (N2)
44
45 RETURN
46
47 END