1 | MODULE geometry |
---|
2 | USE field_mod |
---|
3 | |
---|
4 | TYPE t_geometry |
---|
5 | TYPE(t_field),POINTER :: centroid(:) |
---|
6 | TYPE(t_field),POINTER :: xyz_i(:) |
---|
7 | TYPE(t_field),POINTER :: xyz_e(:) |
---|
8 | TYPE(t_field),POINTER :: xyz_v(:) |
---|
9 | TYPE(t_field),POINTER :: lon_i(:) |
---|
10 | TYPE(t_field),POINTER :: lon_e(:) |
---|
11 | TYPE(t_field),POINTER :: lat_i(:) |
---|
12 | TYPE(t_field),POINTER :: lat_e(:) |
---|
13 | TYPE(t_field),POINTER :: ep_e(:) |
---|
14 | TYPE(t_field),POINTER :: et_e(:) |
---|
15 | TYPE(t_field),POINTER :: elon_i(:) |
---|
16 | TYPE(t_field),POINTER :: elat_i(:) |
---|
17 | TYPE(t_field),POINTER :: elon_e(:) |
---|
18 | TYPE(t_field),POINTER :: elat_e(:) |
---|
19 | TYPE(t_field),POINTER :: Ai(:) |
---|
20 | TYPE(t_field),POINTER :: Av(:) |
---|
21 | TYPE(t_field),POINTER :: de(:) |
---|
22 | TYPE(t_field),POINTER :: le(:) |
---|
23 | TYPE(t_field),POINTER :: Riv(:) |
---|
24 | TYPE(t_field),POINTER :: Riv2(:) |
---|
25 | TYPE(t_field),POINTER :: ne(:) |
---|
26 | TYPE(t_field),POINTER :: Wee(:) |
---|
27 | TYPE(t_field),POINTER :: bi(:) |
---|
28 | TYPE(t_field),POINTER :: fv(:) |
---|
29 | END TYPE t_geometry |
---|
30 | |
---|
31 | TYPE(t_geometry),SAVE,TARGET :: geom |
---|
32 | |
---|
33 | |
---|
34 | REAL(rstd),POINTER :: Ai(:) ! area of a cell |
---|
35 | !$OMP THREADPRIVATE(Ai) |
---|
36 | REAL(rstd),POINTER :: centroid(:,:) ! coordinate of the centroid of the cell |
---|
37 | !$OMP THREADPRIVATE(centroid) |
---|
38 | REAL(rstd),POINTER :: xyz_i(:,:) ! coordinate of the center of the cell (voronoi) |
---|
39 | !$OMP THREADPRIVATE(xyz_i) |
---|
40 | REAL(rstd),POINTER :: xyz_e(:,:) ! coordinate of a wind point on the cell on a edge |
---|
41 | !$OMP THREADPRIVATE(xyz_e) |
---|
42 | REAL(rstd),POINTER :: xyz_v(:,:) ! coordinate of a vertex (center of the dual mesh) |
---|
43 | !$OMP THREADPRIVATE(xyz_v) |
---|
44 | REAL(rstd),POINTER :: lon_i(:) ! longitude of the center of the cell (voronoi) |
---|
45 | !$OMP THREADPRIVATE(lon_i) |
---|
46 | REAL(rstd),POINTER :: lon_e(:) ! longitude of a wind point on the cell on a edge |
---|
47 | !$OMP THREADPRIVATE(lon_e) |
---|
48 | REAL(rstd),POINTER :: lat_i(:) ! latitude of the center of the cell (voronoi) |
---|
49 | !$OMP THREADPRIVATE(lat_i) |
---|
50 | REAL(rstd),POINTER :: lat_e(:) ! latitude of a wind point on the cell on a edge |
---|
51 | !$OMP THREADPRIVATE(lat_e) |
---|
52 | REAL(rstd),POINTER :: ep_e(:,:) ! perpendicular unit vector of a edge (outsider) |
---|
53 | !$OMP THREADPRIVATE(ep_e) |
---|
54 | REAL(rstd),POINTER :: et_e(:,:) ! tangeantial unit vector of a edge |
---|
55 | !$OMP THREADPRIVATE(et_e) |
---|
56 | REAL(rstd),POINTER :: elon_i(:,:) ! unit longitude vector on the center |
---|
57 | !$OMP THREADPRIVATE(elon_i) |
---|
58 | REAL(rstd),POINTER :: elat_i(:,:) ! unit latitude vector on the center |
---|
59 | !$OMP THREADPRIVATE(elat_i) |
---|
60 | REAL(rstd),POINTER :: elon_e(:,:) ! unit longitude vector on a wind point |
---|
61 | !$OMP THREADPRIVATE(elon_e) |
---|
62 | REAL(rstd),POINTER :: elat_e(:,:) ! unit latitude vector on a wind point |
---|
63 | !$OMP THREADPRIVATE(elat_e) |
---|
64 | REAL(rstd),POINTER :: Av(:) ! area of dual mesk cell |
---|
65 | !$OMP THREADPRIVATE(Av) |
---|
66 | REAL(rstd),POINTER :: de(:) ! distance from a neighbour == lenght of an edge of the dual mesh |
---|
67 | !$OMP THREADPRIVATE(de) |
---|
68 | REAL(rstd),POINTER :: le(:) ! lenght of a edge |
---|
69 | !$OMP THREADPRIVATE(le) |
---|
70 | REAL(rstd),POINTER :: Riv(:,:) ! weight |
---|
71 | !$OMP THREADPRIVATE(Riv) |
---|
72 | REAL(rstd),POINTER :: Riv2(:,:) ! weight |
---|
73 | !$OMP THREADPRIVATE(Riv2) |
---|
74 | INTEGER,POINTER :: ne(:,:) ! convention for the way on the normal wind on an edge |
---|
75 | !$OMP THREADPRIVATE(ne) |
---|
76 | REAL(rstd),POINTER :: Wee(:,:,:) ! weight |
---|
77 | !$OMP THREADPRIVATE(Wee) |
---|
78 | REAL(rstd),POINTER :: bi(:) ! orographie |
---|
79 | !$OMP THREADPRIVATE(bi) |
---|
80 | REAL(rstd),POINTER :: fv(:) ! coriolis (evaluted on a vertex) |
---|
81 | !$OMP THREADPRIVATE(fv) |
---|
82 | |
---|
83 | |
---|
84 | INTEGER, PARAMETER :: ne_right=1 |
---|
85 | INTEGER, PARAMETER :: ne_rup=-1 |
---|
86 | INTEGER, PARAMETER :: ne_lup=1 |
---|
87 | INTEGER, PARAMETER :: ne_left=-1 |
---|
88 | INTEGER, PARAMETER :: ne_ldown=1 |
---|
89 | INTEGER, PARAMETER :: ne_rdown=-1 |
---|
90 | |
---|
91 | CONTAINS |
---|
92 | |
---|
93 | SUBROUTINE allocate_geometry |
---|
94 | USE field_mod |
---|
95 | IMPLICIT NONE |
---|
96 | |
---|
97 | CALL allocate_field(geom%Ai,field_t,type_real,name='Ai') |
---|
98 | |
---|
99 | CALL allocate_field(geom%xyz_i,field_t,type_real,3) |
---|
100 | CALL allocate_field(geom%lon_i,field_t,type_real) |
---|
101 | CALL allocate_field(geom%lat_i,field_t,type_real) |
---|
102 | CALL allocate_field(geom%elon_i,field_t,type_real,3) |
---|
103 | CALL allocate_field(geom%elat_i,field_t,type_real,3) |
---|
104 | CALL allocate_field(geom%centroid,field_t,type_real,3) |
---|
105 | |
---|
106 | CALL allocate_field(geom%xyz_e,field_u,type_real,3) |
---|
107 | CALL allocate_field(geom%lon_e,field_u,type_real) |
---|
108 | CALL allocate_field(geom%lat_e,field_u,type_real) |
---|
109 | CALL allocate_field(geom%elon_e,field_u,type_real,3) |
---|
110 | CALL allocate_field(geom%elat_e,field_u,type_real,3) |
---|
111 | CALL allocate_field(geom%ep_e,field_u,type_real,3) |
---|
112 | CALL allocate_field(geom%et_e,field_u,type_real,3) |
---|
113 | |
---|
114 | CALL allocate_field(geom%xyz_v,field_z,type_real,3) |
---|
115 | CALL allocate_field(geom%de,field_u,type_real) |
---|
116 | CALL allocate_field(geom%le,field_u,type_real) |
---|
117 | CALL allocate_field(geom%bi,field_t,type_real) |
---|
118 | CALL allocate_field(geom%Av,field_z,type_real) |
---|
119 | CALL allocate_field(geom%Riv,field_t,type_real,6) |
---|
120 | CALL allocate_field(geom%Riv2,field_t,type_real,6) |
---|
121 | CALL allocate_field(geom%ne,field_t,type_integer,6) |
---|
122 | CALL allocate_field(geom%Wee,field_u,type_real,5,2) |
---|
123 | CALL allocate_field(geom%bi,field_t,type_real) |
---|
124 | CALL allocate_field(geom%fv,field_z,type_real) |
---|
125 | |
---|
126 | END SUBROUTINE allocate_geometry |
---|
127 | |
---|
128 | |
---|
129 | SUBROUTINE swap_geometry(ind) |
---|
130 | USE field_mod |
---|
131 | IMPLICIT NONE |
---|
132 | INTEGER,INTENT(IN) :: ind |
---|
133 | !!$OMP MASTER |
---|
134 | Ai=geom%Ai(ind) |
---|
135 | xyz_i=geom%xyz_i(ind) |
---|
136 | centroid=geom%centroid(ind) |
---|
137 | xyz_e=geom%xyz_e(ind) |
---|
138 | ep_e=geom%ep_e(ind) |
---|
139 | et_e=geom%et_e(ind) |
---|
140 | lon_i=geom%lon_i(ind) |
---|
141 | lat_i=geom%lat_i(ind) |
---|
142 | lon_e=geom%lon_e(ind) |
---|
143 | lat_e=geom%lat_e(ind) |
---|
144 | elon_i=geom%elon_i(ind) |
---|
145 | elat_i=geom%elat_i(ind) |
---|
146 | elon_e=geom%elon_e(ind) |
---|
147 | elat_e=geom%elat_e(ind) |
---|
148 | xyz_v=geom%xyz_v(ind) |
---|
149 | de=geom%de(ind) |
---|
150 | le=geom%le(ind) |
---|
151 | Av=geom%Av(ind) |
---|
152 | Riv=geom%Riv(ind) |
---|
153 | Riv2=geom%Riv2(ind) |
---|
154 | ne=geom%ne(ind) |
---|
155 | Wee=geom%Wee(ind) |
---|
156 | bi=geom%bi(ind) |
---|
157 | fv=geom%fv(ind) |
---|
158 | !!$OMP END MASTER |
---|
159 | !!$OMP BARRIER |
---|
160 | END SUBROUTINE swap_geometry |
---|
161 | |
---|
162 | SUBROUTINE update_circumcenters |
---|
163 | USE domain_mod |
---|
164 | USE dimensions |
---|
165 | USE spherical_geom_mod |
---|
166 | USE vector |
---|
167 | USE transfert_mod |
---|
168 | USE omp_para |
---|
169 | |
---|
170 | IMPLICIT NONE |
---|
171 | REAL(rstd) :: x1(3),x2(3) |
---|
172 | REAL(rstd) :: vect(3,6) |
---|
173 | REAL(rstd) :: centr(3) |
---|
174 | INTEGER :: ind,i,j,n,k |
---|
175 | TYPE(t_message),SAVE :: message0, message1 |
---|
176 | LOGICAL, SAVE :: first=.TRUE. |
---|
177 | !$OMP THREADPRIVATE(first) |
---|
178 | |
---|
179 | IF (first) THEN |
---|
180 | CALL init_message(geom%xyz_i, req_i0 ,message0) |
---|
181 | CALL init_message(geom%xyz_i, req_i1 ,message1) |
---|
182 | first=.FALSE. |
---|
183 | ENDIF |
---|
184 | |
---|
185 | CALL transfert_message(geom%xyz_i,message0) |
---|
186 | CALL transfert_message(geom%xyz_i,message1) |
---|
187 | |
---|
188 | DO ind=1,ndomain |
---|
189 | IF (.NOT. assigned_domain(ind) .OR. .NOT. is_omp_level_master) CYCLE |
---|
190 | CALL swap_dimensions(ind) |
---|
191 | CALL swap_geometry(ind) |
---|
192 | DO j=jj_begin,jj_end |
---|
193 | DO i=ii_begin,ii_end |
---|
194 | n=(j-1)*iim+i |
---|
195 | DO k=0,5 |
---|
196 | x1(:) = xyz_i(n+t_pos(k+1),:) |
---|
197 | x2(:) = xyz_i(n+t_pos(MOD(k+1,6)+1),:) |
---|
198 | if (norm(x1-x2)<1e-16) x2(:) = xyz_i(n+t_pos(MOD(k+2,6)+1),:) |
---|
199 | CALL circumcenter(xyz_i(n,:), x1, x2, xyz_v(n+z_pos(k+1),:)) |
---|
200 | ENDDO |
---|
201 | ENDDO |
---|
202 | ENDDO |
---|
203 | ENDDO |
---|
204 | |
---|
205 | END SUBROUTINE update_circumcenters |
---|
206 | |
---|
207 | SUBROUTINE optimize_geometry |
---|
208 | USE metric |
---|
209 | USE spherical_geom_mod |
---|
210 | USE domain_mod |
---|
211 | USE dimensions |
---|
212 | USE transfert_mod |
---|
213 | USE vector |
---|
214 | USE getin_mod |
---|
215 | USE omp_para |
---|
216 | IMPLICIT NONE |
---|
217 | INTEGER :: nb_it=0 |
---|
218 | TYPE(t_domain),POINTER :: d |
---|
219 | INTEGER :: ind,it,i,j,n,k |
---|
220 | REAL(rstd) :: x1(3),x2(3) |
---|
221 | REAL(rstd) :: vect(3,6) |
---|
222 | REAL(rstd) :: centr(3) |
---|
223 | REAL(rstd) :: sum |
---|
224 | LOGICAL :: check |
---|
225 | |
---|
226 | |
---|
227 | CALL getin('optim_it',nb_it) |
---|
228 | |
---|
229 | DO ind=1,ndomain |
---|
230 | IF (.NOT. assigned_domain(ind) .OR. .NOT. is_omp_level_master) CYCLE |
---|
231 | d=>domain(ind) |
---|
232 | CALL swap_dimensions(ind) |
---|
233 | CALL swap_geometry(ind) |
---|
234 | DO j=jj_begin,jj_end |
---|
235 | DO i=ii_begin,ii_end |
---|
236 | n=(j-1)*iim+i |
---|
237 | xyz_i(n,:)=d%xyz(:,i,j) |
---|
238 | ENDDO |
---|
239 | ENDDO |
---|
240 | ENDDO |
---|
241 | |
---|
242 | CALL update_circumcenters |
---|
243 | |
---|
244 | DO ind=1,ndomain |
---|
245 | IF (.NOT. assigned_domain(ind) .OR. .NOT. is_omp_level_master ) CYCLE |
---|
246 | d=>domain(ind) |
---|
247 | CALL swap_dimensions(ind) |
---|
248 | CALL swap_geometry(ind) |
---|
249 | DO j=jj_begin,jj_end |
---|
250 | DO i=ii_begin,ii_end |
---|
251 | n=(j-1)*iim+i |
---|
252 | DO k=0,5 |
---|
253 | x1(:) = xyz_v(n+z_pos(k+1),:) |
---|
254 | x2(:) = d%vertex(:,k,i,j) |
---|
255 | IF (norm(x1-x2)>1e-10) THEN |
---|
256 | PRINT*,"vertex diff ",ind,i,j,k |
---|
257 | PRINT*,x1 |
---|
258 | PRINT*,x2 |
---|
259 | ENDIF |
---|
260 | ENDDO |
---|
261 | ENDDO |
---|
262 | ENDDO |
---|
263 | ENDDO |
---|
264 | |
---|
265 | |
---|
266 | DO it=1,nb_it |
---|
267 | IF (MOD(it,100)==0) THEN |
---|
268 | check=is_master |
---|
269 | ELSE |
---|
270 | check=.FALSE. |
---|
271 | ENDIF |
---|
272 | |
---|
273 | sum=0 |
---|
274 | DO ind=1,ndomain |
---|
275 | IF (.NOT. assigned_domain(ind) .OR. .NOT. is_omp_level_master ) CYCLE |
---|
276 | CALL swap_dimensions(ind) |
---|
277 | CALL swap_geometry(ind) |
---|
278 | DO j=jj_begin,jj_end |
---|
279 | DO i=ii_begin,ii_end |
---|
280 | n=(j-1)*iim+i |
---|
281 | vect(:,1)=xyz_v(n+z_rup,:) |
---|
282 | vect(:,2)=xyz_v(n+z_up,:) |
---|
283 | vect(:,3)=xyz_v(n+z_lup,:) |
---|
284 | vect(:,4)=xyz_v(n+z_ldown,:) |
---|
285 | vect(:,5)=xyz_v(n+z_down,:) |
---|
286 | vect(:,6)=xyz_v(n+z_rdown,:) |
---|
287 | CALL compute_centroid(vect,6,centr) |
---|
288 | IF (check) THEN |
---|
289 | sum=MAX(sum,norm(xyz_i(n,:)-centr(:))) |
---|
290 | ENDIF |
---|
291 | xyz_i(n,:)=centr(:) |
---|
292 | ENDDO |
---|
293 | ENDDO |
---|
294 | |
---|
295 | ENDDO |
---|
296 | |
---|
297 | IF (check) PRINT *,"it = ",it," diff centroid circumcenter ",sum |
---|
298 | |
---|
299 | CALL update_circumcenters |
---|
300 | |
---|
301 | ENDDO |
---|
302 | |
---|
303 | END SUBROUTINE optimize_geometry |
---|
304 | |
---|
305 | SUBROUTINE set_geometry |
---|
306 | USE metric |
---|
307 | USE vector |
---|
308 | USE spherical_geom_mod |
---|
309 | USE domain_mod |
---|
310 | USE dimensions |
---|
311 | USE transfert_mod |
---|
312 | USE getin_mod |
---|
313 | USE omp_para |
---|
314 | IMPLICIT NONE |
---|
315 | |
---|
316 | REAL(rstd) :: surf(6) |
---|
317 | REAL(rstd) :: surf_v(6) |
---|
318 | REAL(rstd) :: vect(3,6) |
---|
319 | REAL(rstd) :: centr(3) |
---|
320 | REAL(rstd) :: vet(3),vep(3), vertex(3) |
---|
321 | INTEGER :: ind,i,j,k,n |
---|
322 | TYPE(t_domain),POINTER :: d |
---|
323 | REAL(rstd) :: S |
---|
324 | REAL(rstd) :: w(6) |
---|
325 | REAL(rstd) :: lon,lat |
---|
326 | INTEGER :: ii_glo,jj_glo |
---|
327 | REAL(rstd) :: S1,S2 |
---|
328 | |
---|
329 | |
---|
330 | CALL optimize_geometry |
---|
331 | |
---|
332 | DO ind=1,ndomain |
---|
333 | IF (.NOT. assigned_domain(ind) .OR. .NOT. is_omp_level_master ) CYCLE |
---|
334 | d=>domain(ind) |
---|
335 | CALL swap_dimensions(ind) |
---|
336 | CALL swap_geometry(ind) |
---|
337 | DO j=jj_begin-1,jj_end+1 |
---|
338 | DO i=ii_begin-1,ii_end+1 |
---|
339 | n=(j-1)*iim+i |
---|
340 | |
---|
341 | DO k=0,5 |
---|
342 | ne(n,k+1)=d%ne(k,i,j) |
---|
343 | ENDDO |
---|
344 | |
---|
345 | vect(:,1)=xyz_v(n+z_rup,:) |
---|
346 | vect(:,2)=xyz_v(n+z_up,:) |
---|
347 | vect(:,3)=xyz_v(n+z_lup,:) |
---|
348 | vect(:,4)=xyz_v(n+z_ldown,:) |
---|
349 | vect(:,5)=xyz_v(n+z_down,:) |
---|
350 | vect(:,6)=xyz_v(n+z_rdown,:) |
---|
351 | CALL compute_centroid(vect,6,centr) |
---|
352 | centroid(n,:)=centr(:) |
---|
353 | |
---|
354 | |
---|
355 | CALL xyz2lonlat(xyz_v(n+z_up,:),lon,lat) |
---|
356 | fv(n+z_up)=2*sin(lat)*omega |
---|
357 | CALL xyz2lonlat(xyz_v(n+z_down,:),lon,lat) |
---|
358 | fv(n+z_down)=2*sin(lat)*omega |
---|
359 | |
---|
360 | bi(n)=0. |
---|
361 | |
---|
362 | CALL dist_cart(xyz_i(n,:),xyz_i(n+t_right,:),de(n+u_right)) |
---|
363 | CALL dist_cart(xyz_i(n,:),xyz_i(n+t_lup,:),de(n+u_lup)) |
---|
364 | CALL dist_cart(xyz_i(n,:),xyz_i(n+t_ldown,:),de(n+u_ldown)) |
---|
365 | |
---|
366 | CALL div_arc_bis(xyz_i(n,:),xyz_i(n+t_right,:),0.5,xyz_e(n+u_right,:)) |
---|
367 | CALL div_arc_bis(xyz_i(n,:),xyz_i(n+t_lup,:),0.5,xyz_e(n+u_lup,:)) |
---|
368 | CALL div_arc_bis(xyz_i(n,:),xyz_i(n+t_ldown,:),0.5,xyz_e(n+u_ldown,:)) |
---|
369 | |
---|
370 | CALL dist_cart(xyz_v(n+z_rdown,:), xyz_v(n+z_rup,:),le(n+u_right)) |
---|
371 | CALL dist_cart(xyz_v(n+z_up,:), xyz_v(n+z_lup,:),le(n+u_lup)) |
---|
372 | CALL dist_cart(xyz_v(n+z_ldown,:), xyz_v(n+z_down,:),le(n+u_ldown)) |
---|
373 | |
---|
374 | Ai(n)=0 |
---|
375 | DO k=0,5 |
---|
376 | CALL surf_triangle(xyz_i(n,:),xyz_i(n+t_pos(k+1),:),xyz_i(n+t_pos(MOD((k+1+6),6)+1),:),surf_v(k+1)) |
---|
377 | CALL surf_triangle(xyz_i(n,:),xyz_v(n+z_pos(MOD((k-1+6),6)+1),:),xyz_v(n+z_pos(k+1),:),surf(k+1)) |
---|
378 | Ai(n)=Ai(n)+surf(k+1) |
---|
379 | IF (i==ii_end .AND. j==jj_begin) THEN |
---|
380 | IF (Ai(n)<1e20) THEN |
---|
381 | ELSE |
---|
382 | PRINT *,"PB !!",Ai(n),k,surf(k+1) |
---|
383 | PRINT*,xyz_i(n,:),xyz_v(n+z_pos(MOD((k-1+6),6)+1),:),xyz_v(n+z_pos(k+1),:) |
---|
384 | ENDIF |
---|
385 | ENDIF |
---|
386 | ENDDO |
---|
387 | |
---|
388 | ! Sign convention : Ringler et al., JCP 2010, eq. 21 p. 3071 |
---|
389 | ! Normal component is along outgoing normal vector if ne=1 |
---|
390 | |
---|
391 | CALL cross_product2(xyz_v(n+z_rdown,:),xyz_v(n+z_rup,:),vep) |
---|
392 | IF (norm(vep)>1e-30) THEN |
---|
393 | vep(:)=vep(:)/norm(vep) ! Inward normal vector |
---|
394 | CALL cross_product2(vep,xyz_e(n+u_right,:),vet) ! Counter-clockwise tangent vector |
---|
395 | vet(:)=vet(:)/norm(vet) |
---|
396 | ep_e(n+u_right,:)=-vep(:)*ne(n,right) |
---|
397 | et_e(n+u_right,:)=vet(:)*ne(n,right) |
---|
398 | ENDIF |
---|
399 | |
---|
400 | CALL cross_product2(xyz_v(n+z_up,:),xyz_v(n+z_lup,:),vep) |
---|
401 | IF (norm(vep)>1e-30) THEN |
---|
402 | vep(:)=vep(:)/norm(vep) |
---|
403 | CALL cross_product2(vep,xyz_e(n+u_lup,:),vet) |
---|
404 | vet(:)=vet(:)/norm(vet) |
---|
405 | ep_e(n+u_lup,:)=-vep(:)*ne(n,lup) |
---|
406 | et_e(n+u_lup,:)=vet(:)*ne(n,lup) |
---|
407 | ENDIF |
---|
408 | |
---|
409 | CALL cross_product2(xyz_v(n+z_ldown,:),xyz_v(n+z_down,:),vep) |
---|
410 | IF (norm(vep)>1e-30) THEN |
---|
411 | vep(:)=vep(:)/norm(vep) |
---|
412 | CALL cross_product2(vep,xyz_e(n+u_ldown,:),vet) |
---|
413 | vet(:)=vet(:)/norm(vet) |
---|
414 | ep_e(n+u_ldown,:)=-vep(:)*ne(n,ldown) |
---|
415 | et_e(n+u_ldown,:)=vet(:)*ne(n,ldown) |
---|
416 | ENDIF |
---|
417 | |
---|
418 | CALL xyz2lonlat(xyz_i(n,:),lon,lat) |
---|
419 | lon_i(n)=lon |
---|
420 | lat_i(n)=lat |
---|
421 | elon_i(n,1) = -sin(lon) |
---|
422 | elon_i(n,2) = cos(lon) |
---|
423 | elon_i(n,3) = 0 |
---|
424 | elat_i(n,1) = -cos(lon)*sin(lat) |
---|
425 | elat_i(n,2) = -sin(lon)*sin(lat) |
---|
426 | elat_i(n,3) = cos(lat) |
---|
427 | |
---|
428 | |
---|
429 | CALL xyz2lonlat(xyz_e(n+u_right,:),lon,lat) |
---|
430 | lon_e(n+u_right)=lon |
---|
431 | lat_e(n+u_right)=lat |
---|
432 | elon_e(n+u_right,1) = -sin(lon) |
---|
433 | elon_e(n+u_right,2) = cos(lon) |
---|
434 | elon_e(n+u_right,3) = 0 |
---|
435 | elat_e(n+u_right,1) = -cos(lon)*sin(lat) |
---|
436 | elat_e(n+u_right,2) = -sin(lon)*sin(lat) |
---|
437 | elat_e(n+u_right,3) = cos(lat) |
---|
438 | |
---|
439 | CALL xyz2lonlat(xyz_e(n+u_lup,:),lon,lat) |
---|
440 | lon_e(n+u_lup)=lon |
---|
441 | lat_e(n+u_lup)=lat |
---|
442 | elon_e(n+u_lup,1) = -sin(lon) |
---|
443 | elon_e(n+u_lup,2) = cos(lon) |
---|
444 | elon_e(n+u_lup,3) = 0 |
---|
445 | elat_e(n+u_lup,1) = -cos(lon)*sin(lat) |
---|
446 | elat_e(n+u_lup,2) = -sin(lon)*sin(lat) |
---|
447 | elat_e(n+u_lup,3) = cos(lat) |
---|
448 | |
---|
449 | CALL xyz2lonlat(xyz_e(n+u_ldown,:),lon,lat) |
---|
450 | lon_e(n+u_ldown)=lon |
---|
451 | lat_e(n+u_ldown)=lat |
---|
452 | elon_e(n+u_ldown,1) = -sin(lon) |
---|
453 | elon_e(n+u_ldown,2) = cos(lon) |
---|
454 | elon_e(n+u_ldown,3) = 0 |
---|
455 | elat_e(n+u_ldown,1) = -cos(lon)*sin(lat) |
---|
456 | elat_e(n+u_ldown,2) = -sin(lon)*sin(lat) |
---|
457 | elat_e(n+u_ldown,3) = cos(lat) |
---|
458 | |
---|
459 | |
---|
460 | DO k=0,5 |
---|
461 | CALL surf_triangle(xyz_i(n,:), xyz_v(n+z_pos(k+1),:), xyz_i(n+t_pos(k+1),:),S1) |
---|
462 | CALL surf_triangle(xyz_i(n,:), xyz_v(n+z_pos(k+1),:), xyz_i(n+t_pos(MOD(k+1+6,6)+1),:),S2) |
---|
463 | Riv(n,k+1)=0.5*(S1+S2)/Ai(n) |
---|
464 | Riv2(n,k+1)=0.5*(S1+S2)/surf_v(k+1) |
---|
465 | ENDDO |
---|
466 | |
---|
467 | DO k=1,6 |
---|
468 | IF (ABS(surf_v(k))<1e-30) THEN |
---|
469 | Riv(n,k)=0. |
---|
470 | ENDIF |
---|
471 | ENDDO |
---|
472 | |
---|
473 | Av(n+z_up)=surf_v(vup)+1e-100 |
---|
474 | Av(n+z_down)=surf_v(vdown)+1e-100 |
---|
475 | |
---|
476 | ENDDO |
---|
477 | ENDDO |
---|
478 | |
---|
479 | DO j=jj_begin,jj_end |
---|
480 | DO i=ii_begin,ii_end |
---|
481 | n=(j-1)*iim+i |
---|
482 | |
---|
483 | CALL compute_wee(n,right,w) |
---|
484 | Wee(n+u_right,:,1)=w(1:5) |
---|
485 | |
---|
486 | CALL compute_wee(n+t_right,left,w) |
---|
487 | Wee(n+u_right,:,2)=w(1:5) |
---|
488 | |
---|
489 | |
---|
490 | CALL compute_wee(n,lup,w) |
---|
491 | Wee(n+u_lup,:,1)=w(1:5) |
---|
492 | |
---|
493 | CALL compute_wee(n+t_lup,rdown,w) |
---|
494 | Wee(n+u_lup,:,2)=w(1:5) |
---|
495 | |
---|
496 | |
---|
497 | CALL compute_wee(n,ldown,w) |
---|
498 | Wee(n+u_ldown,:,1)=w(1:5) |
---|
499 | |
---|
500 | CALL compute_wee(n+t_ldown,rup,w) |
---|
501 | Wee(n+u_ldown,:,2)=w(1:5) |
---|
502 | |
---|
503 | ENDDO |
---|
504 | ENDDO |
---|
505 | |
---|
506 | DO j=jj_begin,jj_end |
---|
507 | DO i=ii_begin,ii_end |
---|
508 | n=(j-1)*iim+i |
---|
509 | ii_glo=d%ii_begin_glo-d%ii_begin+i |
---|
510 | jj_glo=d%jj_begin_glo-d%jj_begin+j |
---|
511 | |
---|
512 | IF (ii_glo==1 .AND. jj_glo==1) THEN |
---|
513 | le(n+u_ldown)=0 |
---|
514 | xyz_v(n+z_ldown,:)=xyz_v(n+z_down,:) |
---|
515 | |
---|
516 | ENDIF |
---|
517 | |
---|
518 | IF (ii_glo==iim_glo .AND. jj_glo==1) THEN |
---|
519 | le(n+u_right)=0 |
---|
520 | xyz_v(n+z_rdown,:)=xyz_v(n+z_rup,:) |
---|
521 | ENDIF |
---|
522 | |
---|
523 | IF (ii_glo==iim_glo .AND. jj_glo==jjm_glo) THEN |
---|
524 | le(n+u_rup)=0 |
---|
525 | xyz_v(n+z_rup,:)=xyz_v(n+z_up,:) |
---|
526 | ENDIF |
---|
527 | |
---|
528 | IF (ii_glo==1 .AND. jj_glo==jjm_glo) THEN |
---|
529 | le(n+u_lup)=0 |
---|
530 | xyz_v(n+z_up,:)=xyz_v(n+z_lup,:) |
---|
531 | ENDIF |
---|
532 | |
---|
533 | ENDDO |
---|
534 | ENDDO |
---|
535 | |
---|
536 | DO j=jj_begin-1,jj_end+1 |
---|
537 | DO i=ii_begin-1,ii_end+1 |
---|
538 | n=(j-1)*iim+i |
---|
539 | xyz_i(n,:)=xyz_i(n,:) * radius |
---|
540 | xyz_v(n+z_up,:)=xyz_v(n+z_up,:) * radius |
---|
541 | xyz_v(n+z_down,:)=xyz_v(n+z_down,:) *radius |
---|
542 | de(n+u_right)=de(n+u_right) * radius |
---|
543 | de(n+u_lup)=de(n+u_lup)*radius |
---|
544 | de(n+u_ldown)=de(n+u_ldown)*radius |
---|
545 | xyz_e(n+u_right,:)=xyz_e(n+u_right,:)*radius |
---|
546 | xyz_e(n+u_lup,:)=xyz_e(n+u_lup,:)*radius |
---|
547 | xyz_e(n+u_ldown,:)=xyz_e(n+u_ldown,:)*radius |
---|
548 | le(n+u_right)=le(n+u_right)*radius |
---|
549 | le(n+u_lup)=le(n+u_lup)*radius |
---|
550 | le(n+u_ldown)=le(n+u_ldown)*radius |
---|
551 | Ai(n)=Ai(n)*radius**2 |
---|
552 | Av(n+z_up)=Av(n+z_up)*radius**2 |
---|
553 | Av(n+z_down)=Av(n+z_down)*radius**2 |
---|
554 | ENDDO |
---|
555 | ENDDO |
---|
556 | |
---|
557 | ENDDO |
---|
558 | |
---|
559 | CALL transfert_request(geom%Ai,req_i1) |
---|
560 | CALL transfert_request(geom%centroid,req_i1) |
---|
561 | |
---|
562 | ! CALL surf_triangle(d%xyz(:,ii_begin,jj_begin),d%xyz(:,ii_begin,jj_end),d%xyz(:,ii_end,jj_begin),S) |
---|
563 | |
---|
564 | END SUBROUTINE set_geometry |
---|
565 | |
---|
566 | SUBROUTINE compute_wee(n,pos,w) |
---|
567 | IMPLICIT NONE |
---|
568 | INTEGER,INTENT(IN) :: n |
---|
569 | INTEGER,INTENT(IN) :: pos |
---|
570 | REAL(rstd),INTENT(OUT) ::w(6) |
---|
571 | |
---|
572 | REAL(rstd) :: ne_(0:5) |
---|
573 | REAL(rstd) :: Riv_(6) |
---|
574 | INTEGER :: k |
---|
575 | |
---|
576 | |
---|
577 | DO k=0,5 |
---|
578 | ne_(k)=ne(n,MOD(pos-1+k+6,6)+1) |
---|
579 | Riv_(k+1)=Riv(n,MOD(pos-1+k+6,6)+1) |
---|
580 | ENDDO |
---|
581 | |
---|
582 | w(1)=-ne_(0)*ne_(1)*(Riv_(1)-0.5) |
---|
583 | w(2)=-ne_(2)*(ne_(0)*Riv_(2)-w(1)*ne_(1)) |
---|
584 | w(3)=-ne_(3)*(ne_(0)*Riv_(3)-w(2)*ne_(2)) |
---|
585 | w(4)=-ne_(4)*(ne_(0)*Riv_(4)-w(3)*ne_(3)) |
---|
586 | w(5)=-ne_(5)*(ne_(0)*Riv_(5)-w(4)*ne_(4)) |
---|
587 | w(6)=ne_(0)*ne_(5)*(Riv_(6)-0.5) |
---|
588 | |
---|
589 | ! IF ( ABS(w(5)-w(6))>1e-20) PRINT *, "pb pour wee : w(5)!=w(6)",sum(Riv_(:)) |
---|
590 | |
---|
591 | END SUBROUTINE compute_wee |
---|
592 | |
---|
593 | |
---|
594 | |
---|
595 | SUBROUTINE compute_geometry |
---|
596 | IMPLICIT NONE |
---|
597 | CALL allocate_geometry |
---|
598 | CALL set_geometry |
---|
599 | |
---|
600 | END SUBROUTINE compute_geometry |
---|
601 | |
---|
602 | END MODULE geometry |
---|