Debian Codegraph @

packages/seacas/applications/gjoin/gj_dorot.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 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