Debian Codegraph @

packages/seacas/applications/numbers/nu_line3.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 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