calcds.f
3.94 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
subroutine calcds (np,tr,tthet,tphi,flength,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.06.01 - V 2.0
c*VER 03.01.06 - V 2.1
c*
c*AUT spec. CNES - JC KOSIK - janvier 1991
c*AUT port. CISI
c*
c*ROL Theme : Calculs de geophysique
c*ROL Calcul de la longueur de la ligne de champ.
c*
c*PAR np (I) : nombre de points calcules
c*
c*PAR tr (I) : tableau des distances geocentriques des point de la
c*PAR : ligne de champ
c*PAR tthet (I) : tableau des colatitudes des points calcules de la
c*PAR : ligne de champ
c*PAR tphi (I) : tableau des longitudes des points calcules de la
c*PAR : ligne de champ
c*
c*PAR flength (O) : longueur de la ligne de champ
c*
c*PAR ier (O) : code de retour
c*
c*NOT ier : sans objet
c*
c*INF utilise : sans objet
c*
c*HST version 1.0 - 99.03.31 - creation de la maglib au CDPP
c*HST version 2.0 - 01.06.01 - 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 np
double precision tr(500), tthet(500), tphi(500)
double precision flength
integer ier
c
c ---------------------------------
c*FON Declaration des variables locales
c ---------------------------------
c
integer n
c*LOC n : indice de boucle
c
integer npfin
c*LOC npfin : nombre d'elements du calcul courant
C
double precision rp,thetp,phip
double precision rre,thete,phie
c*LOC coordonnees spheriques intermediaires
c
double precision x,y,z,xp,yp,zp
c*LOC x,y,z,xp,yp,zp : coordonnees cartesiennes intermediaires
c
double precision ds2,dseff
c*LOC ds2,dseff : variables de travail intermediaires
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
flength = 0.d0
c
c ------------------------------
c*FON Calculs pour les points 1 et 4
c ------------------------------
c
do 10 n = 1, 4, 3
c
rp = tr(n)
thetp = tthet(n)
phip = tphi(n)
rre = tr(n+3)
thete = tthet(n+3)
phie = tphi(n+3)
c
xp = rp * sin(thetp) * cos(phip)
yp = rp * sin(thetp) * sin(phip)
zp = rp * cos(thetp)
c
x = rre * sin(thete) * cos(phie)
y = rre * sin(thete) * sin(phie)
z = rre * cos(thete)
c
ds2 = (x - xp)**2 + (y - yp)**2 + (z - zp)**2
dseff = sqrt(ds2)
flength = flength + dseff
10 continue
c
npfin = np - 2
c
c ----------------------------------
c*FON Calculs pour les points 7 a np - 2
c ----------------------------------
c
do 20 n = 7, npfin
rp = tr(n)
thetp = tthet(n)
phip = tphi(n)
rre = tr(n+1)
thete = tthet(n+1)
phie = tphi(n+1)
c
xp = rp * sin(thetp) * cos(phip)
yp = rp * sin(thetp) * sin(phip)
zp = rp * cos(thetp)
c
x = rre * sin(thete) * cos(phie)
y = rre * sin(thete) * sin(phie)
z = rre * cos(thete)
c
ds2 = (x - xp)**2 + (y-yp)**2 + (z - zp)**2
dseff = sqrt(ds2)
flength = flength + dseff
c
20 continue
c
c ****************
c Fin de programme
c ****************
c
return
end