calpos.f
8.26 KB
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
subroutine calpos (ihour,imin,isec,xikm,yikm,zikm,rig,rgdip,
> rgsm,rggsm,rgse,xi,yi,zi,xg,yg,zg,rre,
> thetr,phir,xlatgm,xlongm,xse,yse,zse,
> xsm,ysm,zsm,xgsm,ygsm,zgsm,
> tglsat,tlsat,xlatse,xlonse,tlose,ier)
c*
c***********************************************************************
c*
c* "Copyright [c] CNES 98 - tous droits reserves"
c* **********************************************
c*
c*PRO MAGLIB
c*
c*VER 99.03.31 - V 1.0
c*VER 01.05.30 - V 2.0
c*VER 03.01.06 - V 2.1
c*
c*AUT spec. CNES - JC KOSIK - juin 1995
c*AUT port. CISI
c*
c*ROL Theme : Calculs de geophysique
c*ROL Calcul des coordonnees du satellite dans le repere
c*ROL inertiel, geographique, solaire ecliptique, solaire
c*ROL magnetique, solaire magnetospherique, les latitudes
c*ROL et longitudes ainsi que le temps geomagnetique local
c*ROL et le temps local a partir de la date du calcul et
c*ROL des coordonnees inertielles du satellite.
c*ROL Les matrices de changement de repere sont passees en
c*ROL parametre.
c*
c*PAR ihour (I) : heures du calcul
c*PAR imin (I) : minutes du calcul
c*PAR isec (I) : secondes du calcul
c*
c*PAR xikm (I) : coordonnee inertielle en x (kilometres)
c*PAR yikm (I) : coordonnee inertielle en y (kilometres)
c*PAR zikm (I) : coordonnee inertielle en z (kilometres)
c*
c*PAR rig (I) : matrice de passage du repere inertiel
c*PAR : au repere geographique
c*PAR rgdip (I) : matrice (3,3) de passage du repere geographique
c*PAR : au repere dipolaire
c*
c*PAR rgsm (I) : matrice de passage du repere geocentrique
c*PAR : au repere solaire magnetique
c*PAR rggs (I) : matrice de passage du repere geocentrique
c*PAR : au repere solaire magnetosph
c*PAR rgse (I) : matrice de passage du repere geocentrique
c*PAR : au repere solaire ecliptique
c*
c*PAR xi (O) : coordonnee inertielle en x (rayons terrestres)
c*PAR yi (O) : coordonnee inertielle en y (rayons terrestres)
c*PAR zi (O) : coordonnee inertielle en z (rayons terrestres)
c*
c*PAR xg (O) : coordonnee geographique en x (rayons terrestres)
c*PAR yg (O) : coordonnee geographique en y (rayons terrestres)
c*PAR zg (O) : coordonnee geographique en z (rayons terrestres)
c*
c*PAR rre (O) : distance radiale geocentrique (rayons terrestres)
c*PAR thetr (O) : colatitude geocentrique (radians)
c*PAR phir (O) : longitude geocentrique (radians)
c*
c*PAR xlatgm (O) : latitude geomagnetique (radians)
c*PAR xlongm (O) : longitude geomagnetique (radians)
c*
c*PAR xse (O) : coordonnee solaire ecliptique en x (rayons terrestres)
c*PAR yse (O) : coordonnee solaire ecliptique en y (rayons terrestres)
c*PAR zse (O) : coordonnee solaire ecliptique en z (rayons terrestres)
c*
c*PAR xsm (O) : coordonnee solaire magnetique en x (rayons terrestres)
c*PAR ysm (O) : coordonnee solaire magnetique en y (rayons terrestres)
c*PAR zsm (O) : coordonnee solaire magnetique en z (rayons terrestres)
c*
c*PAR xgsm (O) : coordonnee solaire magnetospherique en x (rayons terrestres)
c*PAR ygsm (O) : coordonnee solaire magnetospherique en y (rayons terrestres)
c*PAR zgsm (O) : coordonnee solaire magnetospherique en z (rayons terrestres)
c*
c*PAR tglsa (O) : temps geomagnetique local (heures fractionaires)
c*PAR tlsat (O) : temps local du satellite (heures fractionaires)
c*
c*PAR xlats (O) : latitude dans le systeme solaire ecliptique (radians)
c*PAR xlons (O) : longitude dans le systeme solaire ecliptique (radians)
c*
c*PAR tlose (O) : temps local en gse (heures fractionaires)
c*
c*PAR ier (O) : code de retour
c*
c*NOT ier : sans objet
c*
c*NOT common : util
c*
c*INF utilise : promal, carsp, angleg, ggeom, tgml, tlocal
c*
c*HST version 1.0 - 99.03.31 - creation de la maglib au CDPP
c*HST version 2.0 - 01.05.30 - correction de commentaires de code
c*HST version 2.1 - 03.01.06 - corrections en compilation avec g77
c*
c***********************************************************************
c*
implicit none
c
c ---------------------------------
c*FON Declaration identificateur rcs_id
c ---------------------------------
c
character rcs_id*100
c
c --------------------------
c*FON Declaration des parametres
c --------------------------
c
integer ihour,imin,isec
double precision xikm,yikm,zikm
double precision rig(3,3),rgdip(3,3)
double precision rgsm(3,3),rggsm(3,3),rgse(3,3)
double precision xi,yi,zi
double precision xg,yg,zg
double precision rre,thetr,phir
double precision xlatgm,xlongm
double precision xse,yse,zse
double precision xsm,ysm,zsm
double precision xgsm,ygsm,zgsm
double precision tglsat,tlsat
double precision xlatse,xlonse
double precision tlose
integer ier
c
c ----------------------------------
c*FON Declaration des variables communes
c ----------------------------------
c
double precision pi,dpi,rad,deg,pid,xmu,rayt
c
c*COM pi : constante pi (obtenue a partir de acos(-1.))
c*COM dpi : constante 2 * pi
c*COM pid : constante pi / 2
c*COM rad : facteur de conversion degres ----> radians
c*COM deg : facteur de conversion radians ----> degres
c*COM xmu : constante de gravitation terrestre (km**3/sec**2)
c*COM rayt : rayon equatorial terrestre (km)
c
common/util/pi,dpi,rad,deg,pid,xmu,rayt
c
c ----------------------------------
c*FON Declaration des fonctions externes
c ----------------------------------
c
external angleg
double precision angleg
c
SAVE
c
c ---------------------------------
c*FON Affectation identificateur rcs_id
c ---------------------------------
c
data rcs_id /"
>$Id$"/
c
c ******************
c Debut de programme
c ******************
c
ier = 0
c
c ---------------------------------------------------------
c*FON Calcul des coordonnees geographiques du satellite en r.e.
c ---------------------------------------------------------
c
xi = xikm / rayt
yi = yikm / rayt
zi = zikm / rayt
c
call promal(rig,xi,yi,zi,xg,yg,zg,ier)
c
c ------------------------------------------------------
c*FON Calcul des coordonnees spheriques en rayons terrestres
c ------------------------------------------------------
c
call carsp(xg,yg,zg,rre,thetr,phir,ier)
c
c ----------------------------------------
c*FON Calcul des positions dans le systeme gse
c ----------------------------------------
c
call promal(rgse,xg,yg,zg,xse,yse,zse,ier)
c
c -----------------------------------------------------------
c*FON Calcul de latitude de la longitude et du temps local en gse
c -----------------------------------------------------------
c
xlatse = asin(zse / rre)
c
xlonse = angleg(xse,yse,ier)
c
c ---------------------------------------------------------------
c*FON On adopte une definition similaire a celle du temps geom. local
c*FON pour le calcul du temps local en gse
c ---------------------------------------------------------------
c
tlose = (xlonse / 15.d0) + 12.d0
c
tlose = dmod(tlose,24.d0)
c
c --------------------------------------
c*FON Calcul des positions dans le repere sm
c --------------------------------------
c
call promal(rgsm,xg,yg,zg,xsm,ysm,zsm,ier)
c
c ---------------------------------------
c*FON Calcul des positions dans le repere gsm
c ---------------------------------------
c
call promal(rggsm,xg,yg,zg,xgsm,ygsm,zgsm,ier)
c
c --------------------------------------------------
c*FON Calcul des coordonnees geomagnetiques du satellite
c --------------------------------------------------
c
call ggeom(rgdip,thetr,phir,xlatgm,xlongm,ier)
c
c -------------------------------------------------
c*FON Calcul du temps geomagnetique du satellite tglsat
c -------------------------------------------------
c
call tgml(rgsm,thetr,phir,tglsat,ier)
c
c ----------------------------------------
c*FON Calcul du temps local du satellite tlsat
c ----------------------------------------
c
call tlocal(ihour,imin,isec,phir,tlsat,ier)
c
c ****************
c Fin de programme
c ****************
c
return
end