]>
Commit | Line | Data |
---|---|---|
3820ca8e | 1 | |
2 | CDECK ID>, HWUROF. | |
3 | ||
4 | *CMZ :- -26/04/91 11.11.56 by Bryan Webber | |
5 | ||
6 | *-- Author : Bryan Webber | |
7 | ||
8 | C----------------------------------------------------------------------- | |
9 | ||
10 | SUBROUTINE HWUROF(R,P,Q) | |
11 | ||
12 | C----------------------------------------------------------------------- | |
13 | ||
14 | C ROTATES VECTORS BY ROTATION MATRIX R | |
15 | ||
16 | C----------------------------------------------------------------------- | |
17 | ||
18 | DOUBLE PRECISION S1,S2,S3,R(3,3),P(3),Q(3) | |
19 | ||
20 | S1=R(1,1)*P(1)+R(1,2)*P(2)+R(1,3)*P(3) | |
21 | ||
22 | S2=R(2,1)*P(1)+R(2,2)*P(2)+R(2,3)*P(3) | |
23 | ||
24 | S3=R(3,1)*P(1)+R(3,2)*P(2)+R(3,3)*P(3) | |
25 | ||
26 | Q(1)=S1 | |
27 | ||
28 | Q(2)=S2 | |
29 | ||
30 | Q(3)=S3 | |
31 | ||
32 | END |