-
Notifications
You must be signed in to change notification settings - Fork 3
/
Copy pathsgp_time.c
426 lines (338 loc) · 11.2 KB
/
sgp_time.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
/*
* Unit SGP_Time
* Author: Dr TS Kelso
* Original Version: 1992 Jun 02
* Current Revision: 2000 Jan 22
* Modified for Y2K: 1999 Mar 07
* Version: 2.05
* Copyright: 1992-1999, All Rights Reserved
* Version 1.50 added Y2K support. Due to limitations in the current
* format of the NORAD two-line element sets, however, only dates
* through 2056 December 31/2359 UTC are valid.
* Version 1.60 modifies Calendar_Date to ensure date matches time
* resolution and modifies Time_of_Day to make it more robust.
* Version 2.00 adds Julian_Date, Date_Time, and Check_Date to support
* checking for valid date/times, permitting the use of Time_to_UTC and
* Time_from_UTC for UTC/local time conversions.
* Version 2.05 modifies UTC_offset to allow non-integer offsets.
*
* Ported to C by: Neoklis Kyriazis April 9 2001
*/
#define SGP4SDP4_CONSTANTS
#include "sgp4sdp4.h"
/* The function Julian_Date_of_Epoch returns the Julian Date of */
/* an epoch specified in the format used in the NORAD two-line */
/* element sets. It has been modified to support dates beyond */
/* the year 1999 assuming that two-digit years in the range 00-56 */
/* correspond to 2000-2056. Until the two-line element set format */
/* is changed, it is only valid for dates through 2056 December 31. */
double
Julian_Date_of_Epoch(double epoch)
{
double year,day;
/* Modification to support Y2K */
/* Valid 1957 through 2056 */
day = modf(epoch*1E-3, &year)*1E3;
if( year < 57 )
year = year + 2000;
else
year = year + 1900;
/* End modification */
return( Julian_Date_of_Year(year) + day );
} /*Function Julian_Date_of_Epoch*/
/*------------------------------------------------------------------*/
/* Converts a Julian epoch to NORAD TLE epoch format */
double
Epoch_Time(double jd)
{
double yr,time,epoch_time;
struct tm edate;
Calendar_Date(jd, &edate);
yr = edate.tm_year - 100*(edate.tm_year/100) ;
time = Frac(jd + 0.5);
epoch_time = yr*1000
+ DOY(edate.tm_year, edate.tm_mon, edate.tm_mday)
+ time;
return( epoch_time );
} /*Function Epoch_Time*/
/*------------------------------------------------------------------*/
/* The function DOY calculates the day of the year for the specified */
/* date. The calculation uses the rules for the Gregorian calendar */
/* and is valid from the inception of that calendar system. */
int
DOY(int yr, int mo, int dy)
{
const int days[] = {31,28,31,30,31,30,31,31,30,31,30,31};
int i,day;
day = 0;
for( i = 0; i < mo-1; i++ )
day += days[i];
day = day + dy;
/* Leap year correction */
if((yr%4 == 0) && ((yr%100 != 0) || (yr%400 == 0)) && (mo>2) )
day++;
return( day );
} /*Function DOY*/
/*------------------------------------------------------------------*/
/* Fraction_of_Day calculates the fraction of */
/* a day passed at the specified input time. */
double
Fraction_of_Day(int hr,int mi,int se, suseconds_t usec)
{
return( (hr + (mi + (se+usec*1e-6)/60.0)/60.0)/24.0 );
} /*Function Fraction_of_Day*/
/*------------------------------------------------------------------*/
/* The function Calendar_Date converts a Julian Date to a struct tm. */
/* Only the members tm_year, tm_mon and tm_mday are calculated and set */
void
Calendar_Date(double jd, struct tm *cdate)
{
/* Astronomical Formulae for Calculators, Jean Meeus, pages 26-27 */
int Z,month;
double A,B,C,D,E,F,day,year,factor;
factor = 0.5/secday/1000;
F = Frac(jd + 0.5);
if (F + factor >= 1.0)
{
jd = jd + factor;
F = 0.0;
} /*if*/
Z = Round(jd);
if( Z < 2299161 )
A = Z;
else
{
double alpha = Int((Z - 1867216.25)/36524.25);
A = Z + 1 + alpha - Int(alpha/4);
} /*else*/
B = A + 1524;
C = Int((B - 122.1)/365.25);
D = Int(365.25 * C);
E = Int((B - D)/30.6001);
day = B - D - Int(30.6001 * E) + F;
if( E < 13.5 )
month = Round(E - 1);
else
month = Round(E - 13);
if( month > 2.5 )
year = C - 4716;
else
year = C - 4715;
cdate->tm_year = (int)year;
cdate->tm_mon = month;
double fl = floor(day);
cdate->tm_mday = (int)fl;
} /*Function Calendar_Date*/
/*------------------------------------------------------------------*/
/* Time_of_Day takes a Julian Date and calculates the clock time */
/* portion of that date. Only tm_hour, tm_min and tm_sec are set */
void
Time_of_Day(double jd, struct tm *cdate)
{
int hr,mn,sc;
double time;
time = Frac(jd - 0.5)*secday;
time = Round(time);
double h = floor(time/3600.0);
hr = (int)h;
time = time - 3600.0*hr;
if( hr == 24 )
hr = 0;
double m = floor(time/60.0);
mn = (int)m;
sc = (int)(time - 60.0 * (double)mn);
cdate->tm_hour = hr;
cdate->tm_min = mn;
cdate->tm_sec = sc;
} /*Function Time_of_Day*/
/*------------------------------------------------------------------*/
/* The function Julian_Date converts a standard calendar */
/* date and time to a Julian Date. The procedure Date_Time */
/* performs the inverse of this function. */
double
Julian_Date(struct tm *cdate, struct timeval *tv)
{
double julian_date;
suseconds_t usec = 0;
if (tv != NULL)
usec = tv->tv_usec;
julian_date = Julian_Date_of_Year(cdate->tm_year) +
DOY(cdate->tm_year,cdate->tm_mon,cdate->tm_mday) +
Fraction_of_Day(cdate->tm_hour,cdate->tm_min,cdate->tm_sec,usec)
+ 5.787037e-06; /* Round up to nearest 1 sec */
return( julian_date );
} /*Function Julian_Date */
/*------------------------------------------------------------------*/
/* Date_Time()
*
* The function Date_Time() converts a Julian Date to
* standard calendar date and time. The function
* Julian_Date() performs the inverse of this function.
*/
void
Date_Time(double julian_date, struct tm *cdate)
{
time_t jtime;
jtime = (time_t)((julian_date - 2440587.5) * 86400.0);
*cdate = *gmtime( &jtime );
} /* End of Date_Time() */
/*------------------------------------------------------------------*/
/* The procedure Check_Date can be used as a check to see if a calendar */
/* date and time are valid. It works by first converting the calendar */
/* date and time to a Julian Date (which allows for irregularities, such */
/* as a time greater than 24 hours) and then converting back and comparing.*/
int
Check_Date(struct tm *cdate)
{
double jt;
struct tm chkdate;
jt = Julian_Date(cdate, NULL);
Date_Time(jt, &chkdate);
if( (cdate->tm_year == chkdate.tm_year) &&
(cdate->tm_mon == chkdate.tm_mon ) &&
(cdate->tm_mday == chkdate.tm_mday) &&
(cdate->tm_hour == chkdate.tm_hour) &&
(cdate->tm_min == chkdate.tm_min ) &&
(cdate->tm_sec == chkdate.tm_sec ) )
return ( 1 );
else
return( 0 );
} /*Procedure Check_Date*/
/*------------------------------------------------------------------*/
/* Procedures Time_to_UTC and Time_from_UTC are used to */
/* convert 'struct tm' dates between UTC and local time. */
/* The procedures JD_to_UTC and JD_from_UTC are used to */
/* do the same thing working directly with Julian dates. */
struct tm
Time_to_UTC(struct tm *cdate)
{
time_t tdate;
tdate = mktime(cdate);
return( *gmtime(&tdate) );
} /*Procedure Time_to_UTC*/
/*------------------------------------------------------------------*/
struct tm
Time_from_UTC(struct tm *cdate)
{
time_t tdate;
tdate = mktime(cdate);
return( *localtime(&tdate) );
} /*Procedure Time_from_UTC*/
/*------------------------------------------------------------------*/
double
JD_to_UTC(double jt)
{
extern long timezone;
struct tm cdate;
time_t t = 0;
cdate = *localtime( &t );
jt = jt - timezone/secday;
if( cdate.tm_isdst )
jt= jt - 1.0/24.0;
return( jt );
} /*Procedure JD_to_UTC*/
/*------------------------------------------------------------------*/
double
JD_from_UTC(double jt)
{
extern long timezone;
struct tm cdate;
time_t t = 0;
cdate = *localtime( &t );
jt = jt + timezone/secday;
if( cdate.tm_isdst )
jt= jt + 1.0/24.0;
return( jt );
} /*Procedure JD_from_UTC*/
/*------------------------------------------------------------------*/
/* The function Delta_ET has been added to allow calculations on */
/* the position of the sun. It provides the difference between UT */
/* (approximately the same as UTC) and ET (now referred to as TDT).*/
/* This function is based on a least squares fit of data from 1950 */
/* to 1991 and will need to be updated periodically. */
double
Delta_ET(double year)
{
/* Values determined using data from 1950-1991 in the 1990
Astronomical Almanac. See DELTA_ET.WQ1 for details. */
double delta_et;
delta_et = 26.465 + 0.747622*(year - 1950) +
1.886913*sin(twopi*(year - 1975)/33);
return( delta_et );
} /*Function Delta_ET*/
/*------------------------------------------------------------------*/
/* The function Julian_Date_of_Year calculates the Julian Date */
/* of Day 0.0 of {year}. This function is used to calculate the */
/* Julian Date of any date by using Julian_Date_of_Year, DOY, */
/* and Fraction_of_Day. */
double
Julian_Date_of_Year(double year)
{
/* Astronomical Formulae for Calculators, Jean Meeus, */
/* pages 23-25. Calculate Julian Date of 0.0 Jan year */
long A,B,i;
double jdoy;
year = year - 1.0;
i = (long)(year / 100.0);
A = i;
i = A / 4;
B = 2 - A + i;
i = (long)(365.25 * year);
i += (long)(30.6001 * 14.0);
jdoy = (double)(i + 1720994.5 + B);
return (jdoy);
} /*Function Julian_Date_of_Year*/
/*------------------------------------------------------------------*/
/* The function ThetaG calculates the Greenwich Mean Sidereal Time */
/* for an epoch specified in the format used in the NORAD two-line */
/* element sets. It has now been adapted for dates beyond the year */
/* 1999, as described above. The function ThetaG_JD provides the */
/* same calculation except that it is based on an input in the */
/* form of a Julian Date. */
double
ThetaG(double epoch, deep_arg_t *deep_arg)
{
/* Reference: The 1992 Astronomical Almanac, page B6. */
double year,day,UT,jd,ThetaG;
/* Modification to support Y2K */
/* Valid 1957 through 2056 */
day = modf(epoch*1E-3,&year)*1E3;
if(year < 57)
year += 2000;
else
year += 1900;
/* End modification */
UT = modf(day,&day);
jd = Julian_Date_of_Year(year)+day;
deep_arg->ds50 = jd-2433281.5+UT;
ThetaG = FMod2p(6.3003880987*deep_arg->ds50+1.72944494);
return (ThetaG);
} /* Function ThetaG */
/*------------------------------------------------------------------*/
double
ThetaG_JD(double jd)
{
/* Reference: The 1992 Astronomical Almanac, page B6. */
double UT,TU,GMST, ThetaG_JD;
UT = Frac(jd + 0.5);
jd = jd - UT;
TU = (jd - 2451545.0)/36525;
GMST = 24110.54841 + TU * (8640184.812866 + TU * (0.093104 - TU * 6.2E-6));
GMST = Modulus(GMST + secday*omega_E*UT,secday);
ThetaG_JD = twopi * GMST/secday;
return( ThetaG_JD );
} /*Function ThetaG_JD*/
/*------------------------------------------------------------------*/
/* Gets calendar time from time() and produces a UTC calendar date */
void
UTC_Calendar_Now( struct tm *cdate, struct timeval *tv )
{
time_t t;
t = time(0);
*cdate = *gmtime(&t);
cdate->tm_year += 1900;
cdate->tm_mon += 1;
if (tv != NULL)
gettimeofday(tv, NULL);
} /* End UTC_Calendar_Now */
/*------------------------------------------------------------------*/