| 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 dorot(ndim, numnp, xn, yn, zn, rotmat, rotcen) |
| 8 |
real xn(*), yn(*), zn(*) |
| 9 |
real rotmat(3,3), rotcen(3) |
| 10 |
|
| 11 |
if (NDIM .EQ. 3) THEN |
| 12 |
DO 10 JNP = 1, NUMNP |
| 13 |
X = XN(JNP) - ROTCEN(1) |
| 14 |
Y = YN(JNP) - ROTCEN(2) |
| 15 |
Z = ZN(JNP) - ROTCEN(3) |
| 16 |
XN(JNP) = X*ROTMAT(1,1) + Y*ROTMAT(2,1) + Z*ROTMAT(3,1) |
| 17 |
$ + ROTCEN(1) |
| 18 |
YN(JNP) = X*ROTMAT(1,2) + Y*ROTMAT(2,2) + Z*ROTMAT(3,2) |
| 19 |
$ + ROTCEN(2) |
| 20 |
ZN(JNP) = X*ROTMAT(1,3) + Y*ROTMAT(2,3) + Z*ROTMAT(3,3) |
| 21 |
$ + ROTCEN(3) |
| 22 |
10 continue |
| 23 |
ELSE IF (NDIM .EQ. 2) THEN |
| 24 |
DO 20 JNP = 1, NUMNP |
| 25 |
X = XN(JNP) - ROTCEN(1) |
| 26 |
Y = YN(JNP) - ROTCEN(2) |
| 27 |
XN(JNP) = X*ROTMAT(1,1) + Y*ROTMAT(2,1) + ROTCEN(1) |
| 28 |
YN(JNP) = X*ROTMAT(1,2) + Y*ROTMAT(2,2) + ROTCEN(2) |
| 29 |
20 continue |
| 30 |
END IF |
| 31 |
return |
| 32 |
end |