| line |
stmt |
bran |
cond |
sub |
pod |
time |
code |
|
1
|
|
|
|
|
|
|
#include "erfa.h" |
|
2
|
|
|
|
|
|
|
|
|
3
|
1
|
|
|
|
|
|
void eraPv2s(double pv[2][3], |
|
4
|
|
|
|
|
|
|
double *theta, double *phi, double *r, |
|
5
|
|
|
|
|
|
|
double *td, double *pd, double *rd) |
|
6
|
|
|
|
|
|
|
/* |
|
7
|
|
|
|
|
|
|
** - - - - - - - - |
|
8
|
|
|
|
|
|
|
** e r a P v 2 s |
|
9
|
|
|
|
|
|
|
** - - - - - - - - |
|
10
|
|
|
|
|
|
|
** |
|
11
|
|
|
|
|
|
|
** Convert position/velocity from Cartesian to spherical coordinates. |
|
12
|
|
|
|
|
|
|
** |
|
13
|
|
|
|
|
|
|
** Given: |
|
14
|
|
|
|
|
|
|
** pv double[2][3] pv-vector |
|
15
|
|
|
|
|
|
|
** |
|
16
|
|
|
|
|
|
|
** Returned: |
|
17
|
|
|
|
|
|
|
** theta double longitude angle (radians) |
|
18
|
|
|
|
|
|
|
** phi double latitude angle (radians) |
|
19
|
|
|
|
|
|
|
** r double radial distance |
|
20
|
|
|
|
|
|
|
** td double rate of change of theta |
|
21
|
|
|
|
|
|
|
** pd double rate of change of phi |
|
22
|
|
|
|
|
|
|
** rd double rate of change of r |
|
23
|
|
|
|
|
|
|
** |
|
24
|
|
|
|
|
|
|
** Notes: |
|
25
|
|
|
|
|
|
|
** |
|
26
|
|
|
|
|
|
|
** 1) If the position part of pv is null, theta, phi, td and pd |
|
27
|
|
|
|
|
|
|
** are indeterminate. This is handled by extrapolating the |
|
28
|
|
|
|
|
|
|
** position through unit time by using the velocity part of |
|
29
|
|
|
|
|
|
|
** pv. This moves the origin without changing the direction |
|
30
|
|
|
|
|
|
|
** of the velocity component. If the position and velocity |
|
31
|
|
|
|
|
|
|
** components of pv are both null, zeroes are returned for all |
|
32
|
|
|
|
|
|
|
** six results. |
|
33
|
|
|
|
|
|
|
** |
|
34
|
|
|
|
|
|
|
** 2) If the position is a pole, theta, td and pd are indeterminate. |
|
35
|
|
|
|
|
|
|
** In such cases zeroes are returned for all three. |
|
36
|
|
|
|
|
|
|
** |
|
37
|
|
|
|
|
|
|
** Copyright (C) 2013-2019, NumFOCUS Foundation. |
|
38
|
|
|
|
|
|
|
** Derived, with permission, from the SOFA library. See notes at end of file. |
|
39
|
|
|
|
|
|
|
*/ |
|
40
|
|
|
|
|
|
|
{ |
|
41
|
|
|
|
|
|
|
double x, y, z, xd, yd, zd, rxy2, rxy, r2, rtrue, rw, xyp; |
|
42
|
|
|
|
|
|
|
|
|
43
|
|
|
|
|
|
|
|
|
44
|
|
|
|
|
|
|
/* Components of position/velocity vector. */ |
|
45
|
1
|
|
|
|
|
|
x = pv[0][0]; |
|
46
|
1
|
|
|
|
|
|
y = pv[0][1]; |
|
47
|
1
|
|
|
|
|
|
z = pv[0][2]; |
|
48
|
1
|
|
|
|
|
|
xd = pv[1][0]; |
|
49
|
1
|
|
|
|
|
|
yd = pv[1][1]; |
|
50
|
1
|
|
|
|
|
|
zd = pv[1][2]; |
|
51
|
|
|
|
|
|
|
|
|
52
|
|
|
|
|
|
|
/* Component of r in XY plane squared. */ |
|
53
|
1
|
|
|
|
|
|
rxy2 = x*x + y*y; |
|
54
|
|
|
|
|
|
|
|
|
55
|
|
|
|
|
|
|
/* Modulus squared. */ |
|
56
|
1
|
|
|
|
|
|
r2 = rxy2 + z*z; |
|
57
|
|
|
|
|
|
|
|
|
58
|
|
|
|
|
|
|
/* Modulus. */ |
|
59
|
1
|
|
|
|
|
|
rtrue = sqrt(r2); |
|
60
|
|
|
|
|
|
|
|
|
61
|
|
|
|
|
|
|
/* If null vector, move the origin along the direction of movement. */ |
|
62
|
|
|
|
|
|
|
rw = rtrue; |
|
63
|
1
|
50
|
|
|
|
|
if (rtrue == 0.0) { |
|
64
|
|
|
|
|
|
|
x = xd; |
|
65
|
|
|
|
|
|
|
y = yd; |
|
66
|
|
|
|
|
|
|
z = zd; |
|
67
|
0
|
|
|
|
|
|
rxy2 = x*x + y*y; |
|
68
|
0
|
|
|
|
|
|
r2 = rxy2 + z*z; |
|
69
|
0
|
|
|
|
|
|
rw = sqrt(r2); |
|
70
|
|
|
|
|
|
|
} |
|
71
|
|
|
|
|
|
|
|
|
72
|
|
|
|
|
|
|
/* Position and velocity in spherical coordinates. */ |
|
73
|
1
|
|
|
|
|
|
rxy = sqrt(rxy2); |
|
74
|
1
|
|
|
|
|
|
xyp = x*xd + y*yd; |
|
75
|
1
|
50
|
|
|
|
|
if (rxy2 != 0.0) { |
|
76
|
1
|
|
|
|
|
|
*theta = atan2(y, x); |
|
77
|
1
|
|
|
|
|
|
*phi = atan2(z, rxy); |
|
78
|
1
|
|
|
|
|
|
*td = (x*yd - y*xd) / rxy2; |
|
79
|
1
|
|
|
|
|
|
*pd = (zd*rxy2 - z*xyp) / (r2*rxy); |
|
80
|
|
|
|
|
|
|
} else { |
|
81
|
0
|
|
|
|
|
|
*theta = 0.0; |
|
82
|
0
|
0
|
|
|
|
|
*phi = (z != 0.0) ? atan2(z, rxy) : 0.0; |
|
83
|
0
|
|
|
|
|
|
*td = 0.0; |
|
84
|
0
|
|
|
|
|
|
*pd = 0.0; |
|
85
|
|
|
|
|
|
|
} |
|
86
|
1
|
|
|
|
|
|
*r = rtrue; |
|
87
|
1
|
50
|
|
|
|
|
*rd = (rw != 0.0) ? (xyp + z*zd) / rw : 0.0; |
|
88
|
|
|
|
|
|
|
|
|
89
|
1
|
|
|
|
|
|
return; |
|
90
|
|
|
|
|
|
|
|
|
91
|
|
|
|
|
|
|
} |
|
92
|
|
|
|
|
|
|
/*---------------------------------------------------------------------- |
|
93
|
|
|
|
|
|
|
** |
|
94
|
|
|
|
|
|
|
** |
|
95
|
|
|
|
|
|
|
** Copyright (C) 2013-2019, NumFOCUS Foundation. |
|
96
|
|
|
|
|
|
|
** All rights reserved. |
|
97
|
|
|
|
|
|
|
** |
|
98
|
|
|
|
|
|
|
** This library is derived, with permission, from the International |
|
99
|
|
|
|
|
|
|
** Astronomical Union's "Standards of Fundamental Astronomy" library, |
|
100
|
|
|
|
|
|
|
** available from http://www.iausofa.org. |
|
101
|
|
|
|
|
|
|
** |
|
102
|
|
|
|
|
|
|
** The ERFA version is intended to retain identical functionality to |
|
103
|
|
|
|
|
|
|
** the SOFA library, but made distinct through different function and |
|
104
|
|
|
|
|
|
|
** file names, as set out in the SOFA license conditions. The SOFA |
|
105
|
|
|
|
|
|
|
** original has a role as a reference standard for the IAU and IERS, |
|
106
|
|
|
|
|
|
|
** and consequently redistribution is permitted only in its unaltered |
|
107
|
|
|
|
|
|
|
** state. The ERFA version is not subject to this restriction and |
|
108
|
|
|
|
|
|
|
** therefore can be included in distributions which do not support the |
|
109
|
|
|
|
|
|
|
** concept of "read only" software. |
|
110
|
|
|
|
|
|
|
** |
|
111
|
|
|
|
|
|
|
** Although the intent is to replicate the SOFA API (other than |
|
112
|
|
|
|
|
|
|
** replacement of prefix names) and results (with the exception of |
|
113
|
|
|
|
|
|
|
** bugs; any that are discovered will be fixed), SOFA is not |
|
114
|
|
|
|
|
|
|
** responsible for any errors found in this version of the library. |
|
115
|
|
|
|
|
|
|
** |
|
116
|
|
|
|
|
|
|
** If you wish to acknowledge the SOFA heritage, please acknowledge |
|
117
|
|
|
|
|
|
|
** that you are using a library derived from SOFA, rather than SOFA |
|
118
|
|
|
|
|
|
|
** itself. |
|
119
|
|
|
|
|
|
|
** |
|
120
|
|
|
|
|
|
|
** |
|
121
|
|
|
|
|
|
|
** TERMS AND CONDITIONS |
|
122
|
|
|
|
|
|
|
** |
|
123
|
|
|
|
|
|
|
** Redistribution and use in source and binary forms, with or without |
|
124
|
|
|
|
|
|
|
** modification, are permitted provided that the following conditions |
|
125
|
|
|
|
|
|
|
** are met: |
|
126
|
|
|
|
|
|
|
** |
|
127
|
|
|
|
|
|
|
** 1 Redistributions of source code must retain the above copyright |
|
128
|
|
|
|
|
|
|
** notice, this list of conditions and the following disclaimer. |
|
129
|
|
|
|
|
|
|
** |
|
130
|
|
|
|
|
|
|
** 2 Redistributions in binary form must reproduce the above copyright |
|
131
|
|
|
|
|
|
|
** notice, this list of conditions and the following disclaimer in |
|
132
|
|
|
|
|
|
|
** the documentation and/or other materials provided with the |
|
133
|
|
|
|
|
|
|
** distribution. |
|
134
|
|
|
|
|
|
|
** |
|
135
|
|
|
|
|
|
|
** 3 Neither the name of the Standards Of Fundamental Astronomy Board, |
|
136
|
|
|
|
|
|
|
** the International Astronomical Union nor the names of its |
|
137
|
|
|
|
|
|
|
** contributors may be used to endorse or promote products derived |
|
138
|
|
|
|
|
|
|
** from this software without specific prior written permission. |
|
139
|
|
|
|
|
|
|
** |
|
140
|
|
|
|
|
|
|
** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
|
141
|
|
|
|
|
|
|
** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
|
142
|
|
|
|
|
|
|
** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
|
143
|
|
|
|
|
|
|
** FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
|
144
|
|
|
|
|
|
|
** COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
|
145
|
|
|
|
|
|
|
** INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
|
146
|
|
|
|
|
|
|
** BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
|
147
|
|
|
|
|
|
|
** LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
|
148
|
|
|
|
|
|
|
** CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
|
149
|
|
|
|
|
|
|
** LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN |
|
150
|
|
|
|
|
|
|
** ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
|
151
|
|
|
|
|
|
|
** POSSIBILITY OF SUCH DAMAGE. |
|
152
|
|
|
|
|
|
|
** |
|
153
|
|
|
|
|
|
|
*/ |