Debian Codegraph @

packages/seacas/applications/numbers/nu_donrm3.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 DONRM3 (COORD, LTNESS, MAP, DIRCOS, TEMP,
8 * NSEG, NUMNIQ, NUMNP)
9 DIMENSION COORD(NUMNP, *), LTNESS(4,*), MAP(*), DIRCOS(5,*),
10 * TEMP(3,*)
11
12 DO 10 ISEG = 1, NSEG
13 XI = COORD(LTNESS(1,ISEG),1 )
14 YI = COORD(LTNESS(1,ISEG),2 )
15 ZI = COORD(LTNESS(1,ISEG),3 )
16
17 XJ = COORD(LTNESS(2,ISEG),1 )
18 YJ = COORD(LTNESS(2,ISEG),2 )
19 ZJ = COORD(LTNESS(2,ISEG),3 )
20
21 XK = COORD(LTNESS(3,ISEG),1 )
22 YK = COORD(LTNESS(3,ISEG),2 )
23 ZK = COORD(LTNESS(3,ISEG),3 )
24
25 XL = COORD(LTNESS(4,ISEG),1 )
26 YL = COORD(LTNESS(4,ISEG),2 )
27 ZL = COORD(LTNESS(4,ISEG),3 )
28
29 AI = (YK - YI) * (ZL - ZJ) - (ZK - ZI) * (YL - YJ)
30 BJ = (ZK - ZI) * (XL - XJ) - (XK - XI) * (ZL - ZJ)
31 CK = (XK - XI) * (YL - YJ) - (YK - YI) * (XL - XJ)
32 RMAG = SQRT ( AI**2 + BJ**2 + CK**2)
33
34 TEMP(1,ISEG) = AI / RMAG
35 TEMP(2,ISEG) = BJ / RMAG
36 TEMP(3,ISEG) = CK / RMAG
37
38 10 CONTINUE
39
40 DO 20 I=1,NUMNIQ
41 DIRCOS(1,I) = 0.0
42 DIRCOS(2,I) = 0.0
43 DIRCOS(3,I) = 0.0
44 20 CONTINUE
45
46 DO 40 ISEG = 1, NSEG
47 DO 30 J = 1, 4
48 MISEG = MAP( 4 * (ISEG-1) + J )
49 DIRCOS(1,MISEG) = DIRCOS(1,MISEG) + TEMP(1,ISEG)
50 DIRCOS(2,MISEG) = DIRCOS(2,MISEG) + TEMP(2,ISEG)
51 DIRCOS(3,MISEG) = DIRCOS(3,MISEG) + TEMP(3,ISEG)
52 30 CONTINUE
53 40 CONTINUE
54
55 C ... NORMALIZE ALL DIRECTION COSINES
56
57 DO 50 I = 1, NUMNIQ
58 A = DIRCOS(1,I)
59 B = DIRCOS(2,I)
60 C = DIRCOS(3,I)
61 R = SQRT(A**2 + B**2 + C**2)
62 DIRCOS(1,I) = A/R
63 DIRCOS(2,I) = B/R
64 DIRCOS(3,I) = C/R
65 50 CONTINUE
66 RETURN
67 END