Debian Codegraph @

packages/seacas/applications/numbers/nu_plane3.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 PLANE3 (COORD, NUMNP, DIST, DISTR, NDIM, P1, P2, TOLER,
8 * NODEL, SORTYP, MAP, SORUP, INUM, OPT, SELECT)
9 DIMENSION COORD (NUMNP,*), DIST(*), DISTR(*), P1(*), P2(*),
10 * TOLER(*), MAP(*)
11 CHARACTER*(*) NODEL, SORTYP, OPT
12 LOGICAL SORUP, SELECT(*), ISABRT
13 include 'nu_io.blk'
14
15 CALL LOCOUT ('PLANE', NDIM, NODEL, TOLER, SORTYP, P1, P2, ' ')
16
17 A = P2(1)
18 B = P2(2)
19 C = P2(3)
20 D = A * P1(1) + B * P1(2) + C * P1(3)
21
22 TEMP = TOLER(1)
23 TOLER(1) = MAX(0.0, TEMP - TOLER(2))
24 TOLER(2) = MAX(0.0, TEMP + TOLER(2))
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 DIST(I) = ABS(A * X0 + B * Y0 + C * Z0 - D) /
32 * SQRT(A**2 + B**2 + C**2)
33 DISTR(I)=(X0 - P1(1))**2 + (Y0 - P1(2))**2 + (Z0 - P1(3))**2
34 END IF
35 10 CONTINUE
36
37 INUM = 0
38 DISMIN = 1.0E30
39 DO 20 I=1, NUMNP
40 IF (SELECT(I)) THEN
41 DISMIN = MIN(DIST(I), ABS(DISMIN-TEMP))
42 IF (DIST(I) .GE. TOLER(1) .AND. DIST(I) .LE. TOLER(2)) THEN
43 INUM = INUM + 1
44 MAP(INUM) = I
45 END IF
46 END IF
47 20 CONTINUE
48
49 IF (SORTYP .EQ. 'X') THEN
50 CALL INDEXX (COORD(1,1), MAP, INUM, .FALSE.)
51 ELSE IF (SORTYP .EQ. 'Y') THEN
52 CALL INDEXX (COORD(1,2), MAP, INUM, .FALSE.)
53 ELSE IF (SORTYP .EQ. 'Z') THEN
54 CALL INDEXX (COORD(1,3), MAP, INUM, .FALSE.)
55 ELSE IF (SORTYP .EQ. 'RADIAL') THEN
56 CALL INDEXX (DISTR, MAP, INUM, .FALSE.)
57 ELSE IF (SORTYP .EQ. 'DISTANCE') THEN
58 CALL INDEXX (DIST, MAP, INUM, .FALSE.)
59 END IF
60
61 IF (SORUP) THEN
62 IBEG = 1
63 IEND = INUM
64 IINC = 1
65 ELSE
66 IBEG = INUM
67 IEND = 1
68 IINC = -1
69 END IF
70
71 IF (OPT .EQ. '*' .OR. INDEX(OPT, 'P') .GT. 0) THEN
72 DO 30 IO=IOMIN, IOMAX
73 WRITE (IO, 40) NODEL
74 30 CONTINUE
75 40 FORMAT (/,T50,'DISTANCE',/2X,A8,T16,'X',T26,'Y',T36,'Z',
76 * T45,'NORMAL',T57,'RADIAL',/)
77 DO 60 IN = IBEG, IEND, IINC
78 IF (ISABRT()) RETURN
79 I = MAP(IN)
80 DO 50 IO=IOMIN, IOMAX
81 WRITE (IO, 90) I, (COORD(I,J),J=1,3), DIST(I),
82 * SQRT(DISTR(I))
83 50 CONTINUE
84 60 CONTINUE
85 IF (INUM .EQ. 0) THEN
86 DO 70 IO=IOMIN, IOMAX
87 WRITE (IO, 80) DISMIN
88 70 CONTINUE
89 END IF
90 END IF
91 80 FORMAT (/' None found within tolerance, minimum distance = ',
92 * 1PE12.3,/)
93 90 FORMAT (I10, 3(F10.4), 2(1PE12.3))
94 RETURN
95 END