Debian Codegraph @

packages/seacas/applications/fastq/excorn.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 EXCORN (MXND, XN, YN, LNODES, ANGLE, N0, N1, N2, XNEW,
8 & YNEW)
9 C***********************************************************************
10
11 C SUBROUTINE EXCORN = CALCULATES A POSITION AN AVERAGE LENGTH AWAY
12 C FROM A CORNER NODE
13
14 C***********************************************************************
15
16 DIMENSION XN (MXND), YN (MXND), LNODES (7, MXND), ANGLE (MXND)
17
18 LOGICAL SIDEP
19
20 C XNEW = XN (N0) + XN (N2) - XN (N1)
21 C YNEW = YN (N0) + YN (N2) - YN (N1)
22
23 PID2 = 0.5 * ATAN2(0.0, -1.0)
24
25 C ANG2 = ATAN2 (YN (N1)-YN (N0), XN (N1)-XN (N0))+PID2
26 BANG1 = ATAN2 (YN (N1) - YN (N2), XN (N1) - XN (N2))
27 BANG2 = ATAN2 (YN (N1) - YN (N0), XN (N1) - XN (N0))
28 IF (SIDEP (ANGLE (N2)))THEN
29 ANG1 = BANG1 - (ANGLE (N2) * .5)
30 ELSE
31 ANG1 = BANG1 - PID2
32 ENDIF
33 IF (SIDEP (ANGLE (N0)))THEN
34 ANG2 = BANG2 + (ANGLE (N0) * .5)
35 ELSE
36 ANG2 = BANG2 + PID2
37 ENDIF
38 DIST1 = SQRT ((YN (N2)-YN (N1)) **2 + (XN (N2)-XN (N1)) **2)
39 DIST2 = SQRT ((YN (N0)-YN (N1)) **2 + (XN (N0)-XN (N1)) **2)
40 DIST = (DIST1 + DIST2) * .5
41 XNEW = ( (DIST * COS (ANG1) + XN (N2)) +
42 & (DIST * COS (ANG2) + XN (N0)) ) * .5
43 YNEW = ( (DIST * SIN (ANG1) + YN (N2)) +
44 & (DIST * SIN (ANG2) + YN (N0)) ) * .5
45 C XNEW = DIST * COS (ANG1) + XN (N2)
46 C YNEW = DIST * SIN (ANG1) + YN (N2)
47
48 RETURN
49
50 END