Debian Codegraph @

packages/seacas/applications/numbers/nu_pendis.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 PENDIS (SCORD, FCORD, DIST, NDIM, NNOD)
8 DIMENSION SCORD(*), FCORD(NDIM, NNOD)
9
10 IF (NDIM .EQ. 3) THEN
11
12 C -- DETERMINE PLANE EQUATION
13
14 XI = FCORD(1, 1)
15 YI = FCORD(2, 1)
16 ZI = FCORD(3, 1)
17
18 XJ = FCORD(1, 2)
19 YJ = FCORD(2, 2)
20 ZJ = FCORD(3, 2)
21
22 XK = FCORD(1, 3)
23 YK = FCORD(2, 3)
24 ZK = FCORD(3, 3)
25
26 XL = FCORD(1, 4)
27 YL = FCORD(2, 4)
28 ZL = FCORD(3, 4)
29
30 A = (YK - YI) * (ZL - ZJ) - (ZK - ZI) * (YL - YJ)
31 B = (ZK - ZI) * (XL - XJ) - (XK - XI) * (ZL - ZJ)
32 C = (XK - XI) * (YL - YJ) - (YK - YI) * (XL - XJ)
33 RMAG = SQRT (A**2 + B**2 + C**2)
34
35 A = A / RMAG
36 B = B / RMAG
37 C = C / RMAG
38 D = A * FCORD(1,1) + B * FCORD(2,1) + C * FCORD(3,1)
39
40 DIST = ABS(A * SCORD(1) + B * SCORD(2) + C * SCORD(3) - D) /
41 * SQRT(A**2 + B**2 + C**2)
42
43 ELSE IF (NDIM .EQ. 2) THEN
44 A = FCORD(1,2) - FCORD(1,1)
45 B = FCORD(2,2) - FCORD(2,1)
46
47 X1 = FCORD(1,1)
48 Y1 = FCORD(2,1)
49
50 X0 = SCORD(1)
51 Y0 = SCORD(2)
52 T = -1. * (A * (X1 - X0) + B * (Y1 - Y0)) / (A**2 + B**2)
53
54 X = X1 + A * T
55 Y = Y1 + B * T
56
57 DIST = SQRT((X - X0)**2 + (Y - Y0)**2)
58 END IF
59 RETURN
60 END