| line |
stmt |
bran |
cond |
sub |
pod |
time |
code |
|
1
|
|
|
|
|
|
|
/* |
|
2
|
|
|
|
|
|
|
*+ |
|
3
|
|
|
|
|
|
|
* Name: |
|
4
|
|
|
|
|
|
|
* palDeuler |
|
5
|
|
|
|
|
|
|
|
|
6
|
|
|
|
|
|
|
* Purpose: |
|
7
|
|
|
|
|
|
|
* Form a rotation matrix from the Euler angles |
|
8
|
|
|
|
|
|
|
|
|
9
|
|
|
|
|
|
|
* Language: |
|
10
|
|
|
|
|
|
|
* Starlink ANSI C |
|
11
|
|
|
|
|
|
|
|
|
12
|
|
|
|
|
|
|
* Type of Module: |
|
13
|
|
|
|
|
|
|
* Library routine |
|
14
|
|
|
|
|
|
|
|
|
15
|
|
|
|
|
|
|
* Invocation: |
|
16
|
|
|
|
|
|
|
* void palDeuler ( const char *order, double phi, double theta, double psi, |
|
17
|
|
|
|
|
|
|
* double rmat[3][3] ); |
|
18
|
|
|
|
|
|
|
|
|
19
|
|
|
|
|
|
|
* Arguments: |
|
20
|
|
|
|
|
|
|
* order = const char[] (Given) |
|
21
|
|
|
|
|
|
|
* Specifies about which axes the rotation occurs |
|
22
|
|
|
|
|
|
|
* phi = double (Given) |
|
23
|
|
|
|
|
|
|
* 1st rotation (radians) |
|
24
|
|
|
|
|
|
|
* theta = double (Given) |
|
25
|
|
|
|
|
|
|
* 2nd rotation (radians) |
|
26
|
|
|
|
|
|
|
* psi = double (Given) |
|
27
|
|
|
|
|
|
|
* 3rd rotation (radians) |
|
28
|
|
|
|
|
|
|
* rmat = double[3][3] (Given & Returned) |
|
29
|
|
|
|
|
|
|
* Rotation matrix |
|
30
|
|
|
|
|
|
|
|
|
31
|
|
|
|
|
|
|
* Description: |
|
32
|
|
|
|
|
|
|
* A rotation is positive when the reference frame rotates |
|
33
|
|
|
|
|
|
|
* anticlockwise as seen looking towards the origin from the |
|
34
|
|
|
|
|
|
|
* positive region of the specified axis. |
|
35
|
|
|
|
|
|
|
* |
|
36
|
|
|
|
|
|
|
* The characters of ORDER define which axes the three successive |
|
37
|
|
|
|
|
|
|
* rotations are about. A typical value is 'ZXZ', indicating that |
|
38
|
|
|
|
|
|
|
* RMAT is to become the direction cosine matrix corresponding to |
|
39
|
|
|
|
|
|
|
* rotations of the reference frame through PHI radians about the |
|
40
|
|
|
|
|
|
|
* old Z-axis, followed by THETA radians about the resulting X-axis, |
|
41
|
|
|
|
|
|
|
* then PSI radians about the resulting Z-axis. |
|
42
|
|
|
|
|
|
|
* |
|
43
|
|
|
|
|
|
|
* The axis names can be any of the following, in any order or |
|
44
|
|
|
|
|
|
|
* combination: X, Y, Z, uppercase or lowercase, 1, 2, 3. Normal |
|
45
|
|
|
|
|
|
|
* axis labelling/numbering conventions apply; the xyz (=123) |
|
46
|
|
|
|
|
|
|
* triad is right-handed. Thus, the 'ZXZ' example given above |
|
47
|
|
|
|
|
|
|
* could be written 'zxz' or '313' (or even 'ZxZ' or '3xZ'). ORDER |
|
48
|
|
|
|
|
|
|
* is terminated by length or by the first unrecognized character. |
|
49
|
|
|
|
|
|
|
* |
|
50
|
|
|
|
|
|
|
* Fewer than three rotations are acceptable, in which case the later |
|
51
|
|
|
|
|
|
|
* angle arguments are ignored. If all rotations are zero, the |
|
52
|
|
|
|
|
|
|
* identity matrix is produced. |
|
53
|
|
|
|
|
|
|
|
|
54
|
|
|
|
|
|
|
* Authors: |
|
55
|
|
|
|
|
|
|
* PTW: Pat Wallace (STFC) |
|
56
|
|
|
|
|
|
|
* TIMJ: Tim Jenness (JAC, Hawaii) |
|
57
|
|
|
|
|
|
|
* {enter_new_authors_here} |
|
58
|
|
|
|
|
|
|
|
|
59
|
|
|
|
|
|
|
* History: |
|
60
|
|
|
|
|
|
|
* 2012-02-08 (TIMJ): |
|
61
|
|
|
|
|
|
|
* Initial version with documentation taken from Fortran SLA |
|
62
|
|
|
|
|
|
|
* Adapted with permission from the Fortran SLALIB library. |
|
63
|
|
|
|
|
|
|
* {enter_further_changes_here} |
|
64
|
|
|
|
|
|
|
|
|
65
|
|
|
|
|
|
|
* Copyright: |
|
66
|
|
|
|
|
|
|
* Copyright (C) 1997 Rutherford Appleton Laboratory |
|
67
|
|
|
|
|
|
|
* Copyright (C) 2012 Science and Technology Facilities Council. |
|
68
|
|
|
|
|
|
|
* All Rights Reserved. |
|
69
|
|
|
|
|
|
|
|
|
70
|
|
|
|
|
|
|
* Licence: |
|
71
|
|
|
|
|
|
|
* This program is free software: you can redistribute it and/or |
|
72
|
|
|
|
|
|
|
* modify it under the terms of the GNU Lesser General Public |
|
73
|
|
|
|
|
|
|
* License as published by the Free Software Foundation, either |
|
74
|
|
|
|
|
|
|
* version 3 of the License, or (at your option) any later |
|
75
|
|
|
|
|
|
|
* version. |
|
76
|
|
|
|
|
|
|
* |
|
77
|
|
|
|
|
|
|
* This program is distributed in the hope that it will be useful, |
|
78
|
|
|
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
79
|
|
|
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
80
|
|
|
|
|
|
|
* GNU Lesser General Public License for more details. |
|
81
|
|
|
|
|
|
|
* |
|
82
|
|
|
|
|
|
|
* You should have received a copy of the GNU Lesser General |
|
83
|
|
|
|
|
|
|
* License along with this program. If not, see |
|
84
|
|
|
|
|
|
|
* . |
|
85
|
|
|
|
|
|
|
|
|
86
|
|
|
|
|
|
|
* Bugs: |
|
87
|
|
|
|
|
|
|
* {note_any_bugs_here} |
|
88
|
|
|
|
|
|
|
*- |
|
89
|
|
|
|
|
|
|
*/ |
|
90
|
|
|
|
|
|
|
|
|
91
|
|
|
|
|
|
|
#include "pal.h" |
|
92
|
|
|
|
|
|
|
#include "pal1sofa.h" |
|
93
|
|
|
|
|
|
|
|
|
94
|
|
|
|
|
|
|
void |
|
95
|
14
|
|
|
|
|
|
palDeuler( const char *order, double phi, double theta, double psi, |
|
96
|
|
|
|
|
|
|
double rmat[3][3] ) { |
|
97
|
|
|
|
|
|
|
int i = 0; |
|
98
|
|
|
|
|
|
|
double rotations[3]; |
|
99
|
|
|
|
|
|
|
|
|
100
|
|
|
|
|
|
|
/* Initialise rmat */ |
|
101
|
14
|
|
|
|
|
|
eraIr( rmat ); |
|
102
|
|
|
|
|
|
|
|
|
103
|
|
|
|
|
|
|
/* copy the rotations into an array */ |
|
104
|
14
|
|
|
|
|
|
rotations[0] = phi; |
|
105
|
14
|
|
|
|
|
|
rotations[1] = theta; |
|
106
|
14
|
|
|
|
|
|
rotations[2] = psi; |
|
107
|
|
|
|
|
|
|
|
|
108
|
|
|
|
|
|
|
/* maximum three rotations */ |
|
109
|
54
|
100
|
|
|
|
|
while (i < 3 && order[i] != '\0') { |
|
|
|
100
|
|
|
|
|
|
|
110
|
|
|
|
|
|
|
|
|
111
|
40
|
|
|
|
|
|
switch (order[i]) { |
|
112
|
|
|
|
|
|
|
case 'X': |
|
113
|
|
|
|
|
|
|
case 'x': |
|
114
|
|
|
|
|
|
|
case '1': |
|
115
|
21
|
|
|
|
|
|
eraRx( rotations[i], rmat ); |
|
116
|
21
|
|
|
|
|
|
break; |
|
117
|
|
|
|
|
|
|
|
|
118
|
|
|
|
|
|
|
case 'Y': |
|
119
|
|
|
|
|
|
|
case 'y': |
|
120
|
|
|
|
|
|
|
case '2': |
|
121
|
3
|
|
|
|
|
|
eraRy( rotations[i], rmat ); |
|
122
|
3
|
|
|
|
|
|
break; |
|
123
|
|
|
|
|
|
|
|
|
124
|
|
|
|
|
|
|
case 'Z': |
|
125
|
|
|
|
|
|
|
case 'z': |
|
126
|
|
|
|
|
|
|
case '3': |
|
127
|
16
|
|
|
|
|
|
eraRz( rotations[i], rmat ); |
|
128
|
16
|
|
|
|
|
|
break; |
|
129
|
|
|
|
|
|
|
|
|
130
|
|
|
|
|
|
|
default: |
|
131
|
|
|
|
|
|
|
/* break out the loop if we do not recognize something */ |
|
132
|
|
|
|
|
|
|
i = 3; |
|
133
|
|
|
|
|
|
|
|
|
134
|
|
|
|
|
|
|
} |
|
135
|
|
|
|
|
|
|
|
|
136
|
|
|
|
|
|
|
/* Go to the next position */ |
|
137
|
40
|
|
|
|
|
|
i++; |
|
138
|
|
|
|
|
|
|
} |
|
139
|
|
|
|
|
|
|
|
|
140
|
14
|
|
|
|
|
|
return; |
|
141
|
|
|
|
|
|
|
} |