Debian Codegraph @

packages/seacas/applications/numbers/nu_line2.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 LINE2 (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 X1 = P1(1)
30 Y1 = P1(2)
31 DLINE = A**2 + B**2
32 IF (DLINE .EQ. 0.0) THEN
33 CALL PRTERR ('CMDERR', 'Zero length line input')
34 RETURN
35 END IF
36
37 DO 10 I=1, NUMNP
38 IF (SELECT(I)) THEN
39 X0 = COORD(I,1)
40 Y0 = COORD(I,2)
41 T(I) = -1. * (A * (X1 - X0) + B * (Y1 - Y0)) / (A**2 + B**2)
42
43 X = X1 + A * T(I)
44 Y = Y1 + B * T(I)
45
46 DIST(I) = (X - X0)**2 + (Y - Y0)**2
47 END IF
48 10 CONTINUE
49 INUM = 0
50 DISMIN = 1.0E38
51 DO 20 I=1, NUMNP
52 IF (SELECT(I)) THEN
53 DISMIN = MIN(DIST(I), ABS(DISMIN-TEMP))
54 IF (DIST(I) .GE. TOLER(1)**2 .AND. DIST(I) .LE. TOLER(2)**2
55 * .AND. BMULT * T(I) .GE. 0.0 .AND. BMULT * T(I) .LE. 1.0)
56 * THEN
57 INUM = INUM + 1
58 MAP(INUM) = I
59 END IF
60 END IF
61 20 CONTINUE
62
63 IF (SORTYP .EQ. 'X') THEN
64 CALL INDEXX (COORD(1,1), MAP, INUM, .FALSE.)
65 ELSE IF (SORTYP .EQ. 'Y') THEN
66 CALL INDEXX (COORD(1,2), MAP, INUM, .FALSE.)
67 ELSE IF (SORTYP .EQ. 'T' .OR. SORTYP .EQ. 'PARAMETR') THEN
68 CALL INDEXX (T, 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 (/,T40,'DISTANCE',/2X,A8,T16,'X',T26,'Y',T36,'Z',
88 * T35,'NORMAL',T45,'PARAMETRIC',/)
89
90 DO 60 IN = IBEG, IEND, IINC
91 IF (ISABRT()) RETURN
92 I = MAP(IN)
93 DO 50 IO=IOMIN, IOMAX
94 WRITE (IO, 90) I, (COORD(I,J),J=1,2), SQRT(DIST(I)),
95 * T(I)
96 50 CONTINUE
97 60 CONTINUE
98
99 IF (INUM .EQ. 0) THEN
100 DO 70 IO=IOMIN, IOMAX
101 WRITE (IO, 80) SQRT(DISMIN)
102 70 CONTINUE
103 END IF
104 END IF
105 80 FORMAT (/' None found within range, minimum distance = ',
106 * 1PE12.3,/)
107 90 FORMAT (I10, 2(F10.4), 2(1PE12.3))
108 RETURN
109 END