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