C 04/16/86 11:32:33 04/16/86 11:31:39 $380300.PLS SUBROUTINE ROTMTX (A,B,AP,BP,R,RH,THETA) C C GIVEN UNPRIMED AND PRIMED VECTORS, 'ROTMTX' WILL CONSTRUCT THE C ROTATION MATRIX 'R' WHICH TAKES 'A' INTO 'AP' AND 'B' INTO'BP'. C OPTIONALLY, THE EQUIVALENT ROTATION AXIS 'RH' AND THE ANGLE OF C ROTATION 'THETA' ABOUT THAT AXIS ARE PROVIDED. C c REAL*8 $$$DT(6) /'$$DATE$$','04/16/86','11:31:39', c | ' ROTMTX',' FORTRAN','PLS '/ DIMENSION A(3),B(3),AP(3),BP(3),R(3),RH(3) DIMENSION AH(3),BH(3),AHP(3),BHP(3),AHPP(3),BHPP(3) DIMENSION AS(3),BS(3),RHP(3),Z(3),ZP(3) REAL DR data DR/0.01745329/ AM = SQRT(A(1)**2 + A(2)**2 + A(3)**2) BM = SQRT(B(1)**2 + B(2)**2 + B(3)**2) APM = SQRT(AP(1)**2 + AP(2)**2 + AP(3)**2) BPM = SQRT(BP(1)**2 + BP(2)**2 + BP(3)**2) DO 20 I=1,3 AH(I) = A(I)/AM BH(I) = B(I)/BM AHP(I) = AP(I)/APM BHP(I) = BP(I)/BPM AS(I) = (AH(I) + AHP(I)) BS(I) = (BH(I) + BHP(I)) 20 CONTINUE CALL VECCRS(AHPP,AH,AHP) CALL VECCRS(BHPP,BH,BHP) CALL VECCRS(AHPP,AS,AHPP) CALL VECCRS(BHPP,BS,BHPP) CALL VECCRS(RHP,AHPP,BHPP) CALL VECNOR(RHP) CALL VECCRS(Z,AH,RHP) CALL VECNOR(Z) CALL VECCRS(ZP,AHP,RHP) CALL VECNOR(ZP) CSTH=VECSCL(Z,ZP) SNTH=VEC3SC(RHP,Z,ZP) TH=ATAN2(SNTH,CSTH)/DR CALL ONAXRT(AHP,AH,RHP,TH,R) CALL VECCPY(RH,RHP) THETA=TH 100 RETURN END