| 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 POINT3 (COORD, NUMNP, DIST, NDIM, P1, TOLER, |
| 8 |
* NODEL, SORTYP, MAP, ANGLE, SORUP, INUM, OPT, SELECT) |
| 9 |
DIMENSION COORD (NUMNP,*), DIST(*), P1(*), TOLER(*), |
| 10 |
* MAP(*), ANGLE(2,*) |
| 11 |
CHARACTER*(*) NODEL, SORTYP, OPT |
| 12 |
LOGICAL SORUP, SELECT(*), ISABRT |
| 13 |
include 'nu_io.blk' |
| 14 |
PI = ATAN2(0.0, -1.0) |
| 15 |
|
| 16 |
CALL LOCOUT ('POINT', NDIM, NODEL, TOLER, SORTYP, P1, P1, ' ') |
| 17 |
|
| 18 |
TEMP = TOLER(1) |
| 19 |
TOLER(1) = MAX(0.0, TEMP - TOLER(2)) |
| 20 |
TOLER(2) = MAX(0.0, TEMP + TOLER(2)) |
| 21 |
|
| 22 |
X1 = P1(1) |
| 23 |
Y1 = P1(2) |
| 24 |
Z1 = P1(3) |
| 25 |
|
| 26 |
DO 10 I=1, NUMNP |
| 27 |
IF (SELECT(I)) THEN |
| 28 |
X0 = COORD(I,1) |
| 29 |
Y0 = COORD(I,2) |
| 30 |
Z0 = COORD(I,3) |
| 31 |
|
| 32 |
DIST(I) = (X1 - X0)**2 + (Y1 - Y0)**2 + (Z1 - Z0)**2 |
| 33 |
END IF |
| 34 |
10 CONTINUE |
| 35 |
|
| 36 |
INUM = 0 |
| 37 |
DISMIN = 1.0E38 |
| 38 |
DO 20 I=1, NUMNP |
| 39 |
IF (SELECT(I)) THEN |
| 40 |
DISMIN = MIN(DIST(I), ABS(DISMIN-TEMP)) |
| 41 |
IF (DIST(I) .GE. TOLER(1)**2 .AND. DIST(I) .LE. TOLER(2)**2) |
| 42 |
* THEN |
| 43 |
DX = COORD(I,1) - P1(1) |
| 44 |
DY = COORD(I,2) - P1(2) |
| 45 |
DZ = COORD(I,3) - P1(3) |
| 46 |
DS = SQRT(DX**2 + DZ**2) |
| 47 |
|
| 48 |
FIX1 = SIGN(0.5,ABS(DX+DZ)) + SIGN(0.5,-ABS(DX+DZ)) |
| 49 |
FIX2 = SIGN(0.5,ABS(DS+DY)) + SIGN(0.5,-ABS(DS+DY)) |
| 50 |
ANGLE(1,I) = ATAN2(DZ,DX+FIX1) * 180.0 / PI |
| 51 |
ANGLE(2,I) = ATAN2(DY,DS+FIX2) * 180.0 / PI |
| 52 |
|
| 53 |
INUM = INUM + 1 |
| 54 |
MAP(INUM) = I |
| 55 |
END IF |
| 56 |
END IF |
| 57 |
20 CONTINUE |
| 58 |
|
| 59 |
IF (SORTYP .EQ. 'X') THEN |
| 60 |
CALL INDEXX (COORD(1,1), MAP, INUM, .FALSE.) |
| 61 |
ELSE IF (SORTYP .EQ. 'Y') THEN |
| 62 |
CALL INDEXX (COORD(1,2), MAP, INUM, .FALSE.) |
| 63 |
ELSE IF (SORTYP .EQ. 'Z') THEN |
| 64 |
CALL INDEXX (COORD(1,3), MAP, INUM, .FALSE.) |
| 65 |
ELSE IF (SORTYP .EQ. 'THETA') THEN |
| 66 |
CALL INDEXN (ANGLE, 2, 1, MAP, INUM, .FALSE.) |
| 67 |
ELSE IF (SORTYP .EQ. 'PHI') THEN |
| 68 |
CALL INDEXN (ANGLE, 2, 2, MAP, INUM, .FALSE.) |
| 69 |
ELSE IF (SORTYP .EQ. 'DISTANCE') THEN |
| 70 |
CALL INDEXX (DIST, MAP, INUM, .FALSE.) |
| 71 |
END IF |
| 72 |
|
| 73 |
IF (SORUP) THEN |
| 74 |
IBEG = 1 |
| 75 |
IEND = INUM |
| 76 |
IINC = 1 |
| 77 |
ELSE |
| 78 |
IBEG = INUM |
| 79 |
IEND = 1 |
| 80 |
IINC = -1 |
| 81 |
END IF |
| 82 |
|
| 83 |
IF (OPT .EQ. '*' .OR. INDEX(OPT, 'P') .GT. 0) THEN |
| 84 |
DO 30 IO=IOMIN, IOMAX |
| 85 |
WRITE (IO, 40) NODEL |
| 86 |
30 CONTINUE |
| 87 |
40 FORMAT (/,2X,A8,T16,'X',T26,'Y',T36,'Z',T44,'DISTANCE', |
| 88 |
* T58,'THETA',T71,'PHI') |
| 89 |
DO 60 IN = IBEG, IEND, IINC |
| 90 |
IF (ISABRT()) RETURN |
| 91 |
I = MAP(IN) |
| 92 |
DO 50 IO=IOMIN, IOMAX |
| 93 |
WRITE (IO, 90) I, (COORD(I,J),J=1,3), SQRT(DIST(I)), |
| 94 |
* ANGLE(1,I), ANGLE(2,I) |
| 95 |
50 CONTINUE |
| 96 |
60 CONTINUE |
| 97 |
|
| 98 |
IF (INUM .EQ. 0) THEN |
| 99 |
DO 70 IO=IOMIN, IOMAX |
| 100 |
WRITE (IO, 80) SQRT(DISMIN) |
| 101 |
70 CONTINUE |
| 102 |
END IF |
| 103 |
END IF |
| 104 |
80 FORMAT (/' None found within range, minimum distance = ', |
| 105 |
* 1PE12.3,/) |
| 106 |
90 FORMAT (I10, 3(F10.4), 3(1PE12.3)) |
| 107 |
RETURN |
| 108 |
END |