| 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 |