Debian Codegraph @

packages/seacas/libraries/plt/pltpgz.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 C=======================================================================
8 FUNCTION PLTPGZ(N,X,Y,Z,XQ,YQ)
9 DIMENSION X(3),Y(3),Z(3),D(2)
10
11 X21 = X(2) - X(1)
12 X31 = X(3) - X(1)
13 Y21 = Y(2) - Y(1)
14 Y31 = Y(3) - Y(1)
15 Z21 = Z(2) - Z(1)
16 Z31 = Z(3) - Z(1)
17 A = Y31*Z21 - Z31*Y21
18 B = Z31*X21 - X31*Z21
19 C = X31*Y21 - Y31*X21
20 IF (C.EQ.0.) THEN
21 DO 2200 I = 1,N - 2
22 D(1) = X(I+1) - X(I)
23 D(2) = Y(I+1) - Y(I)
24 DDD = D(1)*D(1) + D(2)*D(2)
25 IF (DDD.NE.0.) THEN
26 GO TO 2210
27
28 END IF
29
30 2200 CONTINUE
31 2210 CONTINUE
32 IF (DDD.EQ.0.) THEN
33 PLTPGZ = 0.0
34 RETURN
35
36 END IF
37
38 DDP = D(1)*XQ + D(2)*YQ
39 DDP1 = D(1)*X(1) + D(2)*Y(1)
40 ALPHA = (DDP-DDP1)/DDD
41 PLTPGZ = Z(1) + ALPHA* (Z(2)-Z(1))
42 RETURN
43
44 END IF
45
46 PLTPGZ = ((A* (X(1)-XQ)+B* (Y(1)-YQ))/C) + Z(1)
47 RETURN
48
49 END