You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
70 lines
1.8 KiB
70 lines
1.8 KiB
C Copyright(C) 1999-2020 National Technology & Engineering Solutions
|
|
C of Sandia, LLC (NTESS). Under the terms of Contract DE-NA0003525 with
|
|
C NTESS, the U.S. Government retains certain rights in this software.
|
|
C
|
|
C See packages/seacas/LICENSE for details
|
|
|
|
C=======================================================================
|
|
SUBROUTINE ROTXYZ (XYZ, ANG, ROTMAT)
|
|
C=======================================================================
|
|
|
|
C --*** ROTXYZ *** (GEN3D) Multiply rotation matrix by XYZ rotation
|
|
C -- Written by Amy Gilkey - revised 05/23/86
|
|
C --
|
|
C --ROTXYZ multiplies the current rotation matrix by the given X or Y
|
|
C --or Z axis rotation. Thus the XYZ axes are in viewing space, not
|
|
C --object space.
|
|
C --
|
|
C --Parameters:
|
|
C -- XYZ - IN - the axis of rotation (X,Y,Z)
|
|
C -- ANG - IN - the angle of rotation (in radians)
|
|
C -- ROTMAT - IN/OUT - the rotation matrix
|
|
|
|
CHARACTER XYZ
|
|
REAL ROTMAT(3,3)
|
|
|
|
REAL BY(3,3), RES(3,3)
|
|
|
|
IF (XYZ .EQ. 'X') THEN
|
|
N1 = 2
|
|
N2 = 3
|
|
N3 = 1
|
|
ELSE IF (XYZ .EQ. 'Y') THEN
|
|
N1 = 3
|
|
N2 = 1
|
|
N3 = 2
|
|
ELSE IF (XYZ .EQ. 'Z') THEN
|
|
N1 = 1
|
|
N2 = 2
|
|
N3 = 3
|
|
ELSE
|
|
n1 = 0
|
|
n2 = 0
|
|
n3 = 0
|
|
CALL PRTERR ('ERROR', 'Invalid axis specification in rotxyz')
|
|
return
|
|
END IF
|
|
|
|
COSANG = COS (ANG)
|
|
SINANG = SIN (ANG)
|
|
BY(N1,N1) = COSANG
|
|
BY(N2,N1) = -SINANG
|
|
BY(N1,N3) = 0.0
|
|
BY(N1,N2) = SINANG
|
|
BY(N2,N2) = COSANG
|
|
BY(N2,N3) = 0.0
|
|
BY(N3,N1) = 0.0
|
|
BY(N3,N2) = 0.0
|
|
BY(N3,N3) = 1.0
|
|
|
|
DO 20 I = 1, 3
|
|
DO 10 J = 1, 3
|
|
RES(I,J) = ROTMAT(I,1)*BY(1,J) + ROTMAT(I,2)*BY(2,J)
|
|
& + ROTMAT(I,3)*BY(3,J)
|
|
10 CONTINUE
|
|
20 CONTINUE
|
|
|
|
CALL CPYREA (3*3, RES, ROTMAT)
|
|
|
|
RETURN
|
|
END
|
|
|