| 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 |